JP2003208225A - 横速度を利用した車両方位制御装置、車両方位制御方法および車両方位制御プログラム - Google Patents
横速度を利用した車両方位制御装置、車両方位制御方法および車両方位制御プログラムInfo
- Publication number
- JP2003208225A JP2003208225A JP2002005650A JP2002005650A JP2003208225A JP 2003208225 A JP2003208225 A JP 2003208225A JP 2002005650 A JP2002005650 A JP 2002005650A JP 2002005650 A JP2002005650 A JP 2002005650A JP 2003208225 A JP2003208225 A JP 2003208225A
- Authority
- JP
- Japan
- Prior art keywords
- vehicle
- uδψ
- lateral
- azimuth
- speed
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
- 238000000034 method Methods 0.000 title description 7
- 230000007423 decrease Effects 0.000 claims description 6
- 230000010354 integration Effects 0.000 claims description 5
- 230000006870 function Effects 0.000 claims description 4
- 238000012545 processing Methods 0.000 abstract description 13
- 238000004364 calculation method Methods 0.000 abstract description 10
- 230000004043 responsiveness Effects 0.000 abstract description 4
- 230000001747 exhibiting effect Effects 0.000 abstract description 2
- 238000010586 diagram Methods 0.000 description 14
- 238000012546 transfer Methods 0.000 description 9
- 230000007246 mechanism Effects 0.000 description 6
- 230000004044 response Effects 0.000 description 6
- 241000209094 Oryza Species 0.000 description 5
- 235000007164 Oryza sativa Nutrition 0.000 description 5
- 235000009566 rice Nutrition 0.000 description 5
- 238000011160 research Methods 0.000 description 3
- 230000003321 amplification Effects 0.000 description 2
- 230000008859 change Effects 0.000 description 2
- 238000001514 detection method Methods 0.000 description 2
- 238000003199 nucleic acid amplification method Methods 0.000 description 2
- 230000005540 biological transmission Effects 0.000 description 1
- 238000004590 computer program Methods 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 230000008569 process Effects 0.000 description 1
- 238000012549 training Methods 0.000 description 1
Landscapes
- Steering Control In Accordance With Driving Conditions (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Guiding Agricultural Machines (AREA)
Abstract
(57)【要約】
【課題】広い範囲の車両速度において目標方位に正確に
追随でき、人の操縦に近い態様の乗り心地のよい応答性
を示す車両方位制御装置の提供。 【解決手段】車両の方位角ψ1を検出する方位センサ
と、該車両の速度ｕを検出する速度計と、車両方位角ψ
1と目標方位角ψ2と車両速度ｕとから車両の操舵指令Ｄ
を生成する演算処理部とを備える。演算処理部は、ψ2
−ψ1＝Δψとするとき、ｕΔψなる計算式で表される
横速度誤差の演算と、Ｋ1ｕΔψなる計算式で表される
横速度制御量の演算（Ｋ1は乗数）と、Ｋ2ｕΔψ／ｓな
る計算式（Ｋ2は乗数、ｓはラプラス演算子）で表され
る横位置制御量の演算と、該横速度制御量および該横位
置制御量を加算する和演算とを行い、該和演算で得た加
算値〔Ｋ1ｕΔψ＋Ｋ2ｕΔψ／ｓ〕を操舵指令Ｄとして
出力する。
追随でき、人の操縦に近い態様の乗り心地のよい応答性
を示す車両方位制御装置の提供。 【解決手段】車両の方位角ψ1を検出する方位センサ
と、該車両の速度ｕを検出する速度計と、車両方位角ψ
1と目標方位角ψ2と車両速度ｕとから車両の操舵指令Ｄ
を生成する演算処理部とを備える。演算処理部は、ψ2
−ψ1＝Δψとするとき、ｕΔψなる計算式で表される
横速度誤差の演算と、Ｋ1ｕΔψなる計算式で表される
横速度制御量の演算（Ｋ1は乗数）と、Ｋ2ｕΔψ／ｓな
る計算式（Ｋ2は乗数、ｓはラプラス演算子）で表され
る横位置制御量の演算と、該横速度制御量および該横位
置制御量を加算する和演算とを行い、該和演算で得た加
算値〔Ｋ1ｕΔψ＋Ｋ2ｕΔψ／ｓ〕を操舵指令Ｄとして
出力する。
Description
【０００１】
【発明の属する技術分野】本発明は、農業用車両などの
車両に搭載され、車両の進行方位を制御する車両方位制
御装置、方法およびプログラムに関する。
車両に搭載され、車両の進行方位を制御する車両方位制
御装置、方法およびプログラムに関する。
【０００２】
【従来の技術】図４は従来の車両方位制御装置の一例を
表すブロック線図、図５は図４の車両方位制御装置の構
成を示す図である。この車両方位制御装置は、自動田植
機などの車両に搭載され、該車両を目標方位に自動的に
直進走行させる。この従来の車両方位制御装置では、演
算処理部１５は、車両方位角ψ１を方位センサ１から受
け、例えばメモリに記憶された目標方位角ψ２との差Δ
ψ（＝ψ２ーψ１）を方位角誤差として演算し、その方
位角誤差Δψに比例ゲインＫ1を乗じた値Ｋ1Δψを方位
角誤差比例値として演算し、また方位角誤差Δψに積分
ゲインＫ2を乗じた値Ｋ2Δψの時間積分値Ｋ2Δψ／ｓ
を方位角誤差積分値として演算し、方位角誤差比例値Ｋ
1Δψおよび方位角誤差積分値Ｋ2Δψ／ｓの和（Ｋ1Δ
ψ＋Ｋ2Δψ／ｓ）を演算し、この和の値を操舵指令Ｄ
として操舵部４へ供給する。操舵部４は、操舵指令Ｄに
応じて車両の舵角θを制御し、方位角誤差Δψがゼロに
なる方向に車両の操舵系を制御している。ここで、舵角
θは車両の操舵機構における機械的な操舵角度である。
表すブロック線図、図５は図４の車両方位制御装置の構
成を示す図である。この車両方位制御装置は、自動田植
機などの車両に搭載され、該車両を目標方位に自動的に
直進走行させる。この従来の車両方位制御装置では、演
算処理部１５は、車両方位角ψ１を方位センサ１から受
け、例えばメモリに記憶された目標方位角ψ２との差Δ
ψ（＝ψ２ーψ１）を方位角誤差として演算し、その方
位角誤差Δψに比例ゲインＫ1を乗じた値Ｋ1Δψを方位
角誤差比例値として演算し、また方位角誤差Δψに積分
ゲインＫ2を乗じた値Ｋ2Δψの時間積分値Ｋ2Δψ／ｓ
を方位角誤差積分値として演算し、方位角誤差比例値Ｋ
1Δψおよび方位角誤差積分値Ｋ2Δψ／ｓの和（Ｋ1Δ
ψ＋Ｋ2Δψ／ｓ）を演算し、この和の値を操舵指令Ｄ
として操舵部４へ供給する。操舵部４は、操舵指令Ｄに
応じて車両の舵角θを制御し、方位角誤差Δψがゼロに
なる方向に車両の操舵系を制御している。ここで、舵角
θは車両の操舵機構における機械的な操舵角度である。
【０００３】特開平０８−１３７５４９号公報には、別
の従来の車両方位制御装置が開示されている。特開平０
８−１３７５４９号公報の装置は、車両進行方向に垂直
な方向における車両位置のずれ量と、速度検出手段で検
出された走行速度に基づいて、ずれ量がゼロになるよう
に車両操舵角を制御している。この車両方位制御では、
車両の走行速度が大きいほど車両の操舵角を小さくして
いる。
の従来の車両方位制御装置が開示されている。特開平０
８−１３７５４９号公報の装置は、車両進行方向に垂直
な方向における車両位置のずれ量と、速度検出手段で検
出された走行速度に基づいて、ずれ量がゼロになるよう
に車両操舵角を制御している。この車両方位制御では、
車両の走行速度が大きいほど車両の操舵角を小さくして
いる。
【０００４】また、特開平０７−１１０７１２号公報に
は、さらに別の従来の車両方位制御装置が開示されてい
る。特開平０７−１１０７１２号公報の装置は、車両が
走行する走行路における基準線からの横方向の位置偏差
量およびその横偏差量の時間微分値にゲインを掛けたも
のを加算し、加算値を操舵指令とする。
は、さらに別の従来の車両方位制御装置が開示されてい
る。特開平０７−１１０７１２号公報の装置は、車両が
走行する走行路における基準線からの横方向の位置偏差
量およびその横偏差量の時間微分値にゲインを掛けたも
のを加算し、加算値を操舵指令とする。
【０００５】
【発明が解決しようとする課題】図４及び図５に示した
従来の装置では、目標方位角ψ2からの車両方位角ψ1の
ずれ量である方位角誤差Δψを演算し、その方位角誤差
Δψに比例ゲインＫ1を乗じた値Ｋ1Δψを方位角誤差比
例値として演算し、また方位角誤差Δψに積分ゲインＫ
2を乗じた値Ｋ2Δψの時間積分値Ｋ2Δψ／ｓを方位角
誤差積分値として演算し、方位角誤差比例値Ｋ1Δψお
よび方位角誤差積分値Ｋ2Δψ／ｓの和（Ｋ1Δψ＋Ｋ2
Δψ／ｓ）を演算し、この和の値を操舵指令Ｄとして操
舵部４へ供給する。このように、方位角誤差比例値Ｋ1
Δψと方位角誤差積分値Ｋ2Δψ／ｓとの和（Ｋ1Δψ＋
Ｋ2Δψ／ｓ）を操舵指令Ｄとする従来の装置では、目
標方位角ψ２に対する車両方位角ψ１の比、即ちこの制
御系の伝達特性は、 となる。
従来の装置では、目標方位角ψ2からの車両方位角ψ1の
ずれ量である方位角誤差Δψを演算し、その方位角誤差
Δψに比例ゲインＫ1を乗じた値Ｋ1Δψを方位角誤差比
例値として演算し、また方位角誤差Δψに積分ゲインＫ
2を乗じた値Ｋ2Δψの時間積分値Ｋ2Δψ／ｓを方位角
誤差積分値として演算し、方位角誤差比例値Ｋ1Δψお
よび方位角誤差積分値Ｋ2Δψ／ｓの和（Ｋ1Δψ＋Ｋ2
Δψ／ｓ）を演算し、この和の値を操舵指令Ｄとして操
舵部４へ供給する。このように、方位角誤差比例値Ｋ1
Δψと方位角誤差積分値Ｋ2Δψ／ｓとの和（Ｋ1Δψ＋
Ｋ2Δψ／ｓ）を操舵指令Ｄとする従来の装置では、目
標方位角ψ２に対する車両方位角ψ１の比、即ちこの制
御系の伝達特性は、 となる。
【０００６】式（１）におけるＫ1及びＫ2は定数である
から、従来の車両方位制御装置の伝達特性には、車両の
直進方向の速度、即ち車両速度ｕに関する項が含まれて
いない。即ち、式（１）の伝達特性は、車両速度ｕに拘
わらず一定である。したがって、式（１）の伝達特性で
制御される装置では、ある１つの計画車両速度ｕ0で最
適な応答性を示す制御系を設計したとしても、その制御
系は計画車両速度ｕ0から離れた車両速度ｕでは最適特
性からずれた特性でしか応答できない。式（１）の伝達
特性の制御系で操舵指令Ｄを生成する従来の車両方位制
御装置は、車両速度ｕが計画車両速度ｕ0より速いとき
は制御系の応答遅れにより、車両方位ψ1が目標方位角
ψ2からずれる量（方位角誤差Δψ）が大きくなり、ひ
いては車両の走行径路と設定径路との誤差が大きくな
る。また、車両速度ｕが計画車両速度ｕ0より遅いとき
は、操舵系が不必要に頻繁に舵角θを変動させることと
なり、車両の乗り心地が悪い。このように、図４及び図
５に示した従来の装置では、車両速度ｕが遅いときには
ゆっくりと操舵をし、車両速度ｕが速いときには素早く
操舵をするという人の操舵態様から大きく乖離した操舵
態様とならざるを得ない。
から、従来の車両方位制御装置の伝達特性には、車両の
直進方向の速度、即ち車両速度ｕに関する項が含まれて
いない。即ち、式（１）の伝達特性は、車両速度ｕに拘
わらず一定である。したがって、式（１）の伝達特性で
制御される装置では、ある１つの計画車両速度ｕ0で最
適な応答性を示す制御系を設計したとしても、その制御
系は計画車両速度ｕ0から離れた車両速度ｕでは最適特
性からずれた特性でしか応答できない。式（１）の伝達
特性の制御系で操舵指令Ｄを生成する従来の車両方位制
御装置は、車両速度ｕが計画車両速度ｕ0より速いとき
は制御系の応答遅れにより、車両方位ψ1が目標方位角
ψ2からずれる量（方位角誤差Δψ）が大きくなり、ひ
いては車両の走行径路と設定径路との誤差が大きくな
る。また、車両速度ｕが計画車両速度ｕ0より遅いとき
は、操舵系が不必要に頻繁に舵角θを変動させることと
なり、車両の乗り心地が悪い。このように、図４及び図
５に示した従来の装置では、車両速度ｕが遅いときには
ゆっくりと操舵をし、車両速度ｕが速いときには素早く
操舵をするという人の操舵態様から大きく乖離した操舵
態様とならざるを得ない。
【０００７】また、特開平０８−１３７５４９号公報の
車両方位制御装置では、進行方向の速度を制御系に使用
してはいるが、旋回角速度を一定することを目的として
おり、目標方位角ψ2に車両方位ψ1を正確に追随させる
には向いていない。前述の特開平０７−１１０７１２号
公報の装置は、横偏差および横速度に加えて、道路曲率
を参照して車両の方位を制御する方式であり、構成が複
雑である。
車両方位制御装置では、進行方向の速度を制御系に使用
してはいるが、旋回角速度を一定することを目的として
おり、目標方位角ψ2に車両方位ψ1を正確に追随させる
には向いていない。前述の特開平０７−１１０７１２号
公報の装置は、横偏差および横速度に加えて、道路曲率
を参照して車両の方位を制御する方式であり、構成が複
雑である。
【０００８】本発明は、前述の点に鑑みてなされたもの
であり、広い範囲の車両速度において目標方位に正確に
追随でき、人の操縦に近い態様の乗り心地のよい応答性
を示し、しかも構成が単純な車両方位制御装置、車両方
位制御方法および車両方位制御プログラムを提供するこ
とを目的とする。
であり、広い範囲の車両速度において目標方位に正確に
追随でき、人の操縦に近い態様の乗り心地のよい応答性
を示し、しかも構成が単純な車両方位制御装置、車両方
位制御方法および車両方位制御プログラムを提供するこ
とを目的とする。
【０００９】
【課題を解決するための手段】前述の課題を解決するた
めに本発明は次の手段を提供する。
めに本発明は次の手段を提供する。
【００１０】[１]車両の横方向速度および横方向偏移量
に応じ操舵指令を生成することを特徴とする車両方位制
御装置。
に応じ操舵指令を生成することを特徴とする車両方位制
御装置。
【００１１】[２]目標方位角ψ2及び車両方位角ψ1の差
Δψ（＝ψ2−ψ1）と車両の進行方向の速度である車両
速度ｕとを乗じた横速度誤差ｕΔψに基づき前記横方向
速度の成分を演算し、該横速度誤差ｕΔψの時間積分に
基づき前記横方向偏移量の成分を演算することを特徴と
する前記[１]に記載の車両方位制御装置。
Δψ（＝ψ2−ψ1）と車両の進行方向の速度である車両
速度ｕとを乗じた横速度誤差ｕΔψに基づき前記横方向
速度の成分を演算し、該横速度誤差ｕΔψの時間積分に
基づき前記横方向偏移量の成分を演算することを特徴と
する前記[１]に記載の車両方位制御装置。
【００１２】[３]前記横速度誤差ｕΔψと乗数Ｋ1との
積Ｋ1ｕΔψを前記横方向速度成分である横速度制御量
とし、該横速度誤差ｕΔψの時間積分と乗数Ｋ2との積
Ｋ2ｕΔψ／ｓ（ｓはラプラス演算子）を前記横方向偏
移量成分である横位置制御量とし、該横速度制御量およ
び該横位置制御量の和に基づき前記操舵指令を演算する
ことを特徴とする前記[２]に記載の車両方位制御装置。
積Ｋ1ｕΔψを前記横方向速度成分である横速度制御量
とし、該横速度誤差ｕΔψの時間積分と乗数Ｋ2との積
Ｋ2ｕΔψ／ｓ（ｓはラプラス演算子）を前記横方向偏
移量成分である横位置制御量とし、該横速度制御量およ
び該横位置制御量の和に基づき前記操舵指令を演算する
ことを特徴とする前記[２]に記載の車両方位制御装置。
【００１３】[４]方位センサで検出された車両方位角ψ
1および目標方位角ψ2に基づき車両の操舵指令を生成す
る操舵指令生成手段を備え、該車両の操舵系に該操舵指
令を供給することにより、該車両の方位を制御する車両
方位制御装置において、前記車両の進行方向の速度を車
両速度ｕとして検出する速度計を備え、前記操舵指令生
成手段は、ψ2−ψ1＝Δψとするとき、ｕΔψに比例す
る横速度制御量とｕΔψの時間積分値に比例する横位置
制御量との和に基づき前記操舵指令を生成することを特
徴とする車両方位制御装置。
1および目標方位角ψ2に基づき車両の操舵指令を生成す
る操舵指令生成手段を備え、該車両の操舵系に該操舵指
令を供給することにより、該車両の方位を制御する車両
方位制御装置において、前記車両の進行方向の速度を車
両速度ｕとして検出する速度計を備え、前記操舵指令生
成手段は、ψ2−ψ1＝Δψとするとき、ｕΔψに比例す
る横速度制御量とｕΔψの時間積分値に比例する横位置
制御量との和に基づき前記操舵指令を生成することを特
徴とする車両方位制御装置。
【００１４】[５]車両の方位角ψ1を検出する方位セン
サと、該車両の進行方向の速度を車両速度ｕとして検出
する速度計と、該車両方位角ψ1と目標方位角ψ2と該車
両速度ｕとから該車両の操舵指令を生成する操舵指令生
成手段とを有し、前記操舵指令生成手段は、ψ2−ψ1＝
Δψとするとき、ｕΔψなる計算式で表される横速度誤
差の演算と、Ｋ1ｕΔψなる計算式で表される横速度制
御量の演算（Ｋ1は乗数）と、Ｋ2ｕΔψ／ｓなる計算式
（Ｋ2は乗数、ｓはラプラス演算子）で表される横位置
制御量の演算と、該横速度制御量および該横位置制御量
を加算する和演算とを行い、該和演算で得た加算値〔Ｋ
1ｕΔψ＋Ｋ2ｕΔψ／ｓ〕を前記操舵指令として出力す
ることを特徴とする車両方位制御装置。
サと、該車両の進行方向の速度を車両速度ｕとして検出
する速度計と、該車両方位角ψ1と目標方位角ψ2と該車
両速度ｕとから該車両の操舵指令を生成する操舵指令生
成手段とを有し、前記操舵指令生成手段は、ψ2−ψ1＝
Δψとするとき、ｕΔψなる計算式で表される横速度誤
差の演算と、Ｋ1ｕΔψなる計算式で表される横速度制
御量の演算（Ｋ1は乗数）と、Ｋ2ｕΔψ／ｓなる計算式
（Ｋ2は乗数、ｓはラプラス演算子）で表される横位置
制御量の演算と、該横速度制御量および該横位置制御量
を加算する和演算とを行い、該和演算で得た加算値〔Ｋ
1ｕΔψ＋Ｋ2ｕΔψ／ｓ〕を前記操舵指令として出力す
ることを特徴とする車両方位制御装置。
【００１５】[６]前記乗数Ｋ1及びＫ2は、前記車両速度
ｕの関数であり、該車両速度ｕの増減に応じて増減する
ことを特徴とする前記[３]乃至[５]に記載の車両方位制
御装置。
ｕの関数であり、該車両速度ｕの増減に応じて増減する
ことを特徴とする前記[３]乃至[５]に記載の車両方位制
御装置。
【００１６】[７]方位センサで検出された車両方位角ψ
1と目標方位角ψ2との差（ψ2−ψ1）を方位角誤差Δψ
として算出するステップと、速度計で検出された車両進
行方向の速度である車両速度ｕと前記方位角誤差Δψと
から横速度誤差ｕΔψを算出するステップと、前記横速
度誤差ｕΔψと乗数Ｋ1とから横速度制御量Ｋ1ｕΔψを
算出するステップと、前記横速度誤差ｕΔψと乗数Ｋ2
とから横位置制御量Ｋ2ｕΔψ／ｓを算出するステップ
（ｓはラプラス演算子）と、前記横速度制御量Ｋ1ｕΔ
ψと前記横位置制御量Ｋ2ｕΔψ／ｓとの和演算から操
舵指令〔Ｋ1ｕΔψ＋Ｋ2ｕΔψ／ｓ〕を算出するステッ
プとを有することを特徴とする車両方位制御方法。
1と目標方位角ψ2との差（ψ2−ψ1）を方位角誤差Δψ
として算出するステップと、速度計で検出された車両進
行方向の速度である車両速度ｕと前記方位角誤差Δψと
から横速度誤差ｕΔψを算出するステップと、前記横速
度誤差ｕΔψと乗数Ｋ1とから横速度制御量Ｋ1ｕΔψを
算出するステップと、前記横速度誤差ｕΔψと乗数Ｋ2
とから横位置制御量Ｋ2ｕΔψ／ｓを算出するステップ
（ｓはラプラス演算子）と、前記横速度制御量Ｋ1ｕΔ
ψと前記横位置制御量Ｋ2ｕΔψ／ｓとの和演算から操
舵指令〔Ｋ1ｕΔψ＋Ｋ2ｕΔψ／ｓ〕を算出するステッ
プとを有することを特徴とする車両方位制御方法。
【００１７】[８]方位センサで検出された車両方位角ψ
1と目標方位角ψ2との差（ψ2−ψ1）を方位角誤差Δψ
として算出するステップと、速度計で検出された車両進
行方向の速度である車両速度ｕと前記方位角誤差Δψと
から横速度誤差ｕΔψを算出するステップと、前記横速
度誤差ｕΔψと乗数Ｋ1とから横速度制御量Ｋ1ｕΔψを
算出するステップと、前記横速度誤差ｕΔψと乗数Ｋ2
とから横位置制御量Ｋ2ｕΔψ／ｓを算出するステップ
（ｓはラプラス演算子）と、前記横速度制御量Ｋ1ｕΔ
ψと前記横位置制御量Ｋ2ｕΔψ／ｓとの和演算から操
舵指令〔Ｋ1ｕΔψ＋Ｋ2ｕΔψ／ｓ〕を算出するステッ
プとをコンピュータに実行させるための車両方位制御用
プログラム。
1と目標方位角ψ2との差（ψ2−ψ1）を方位角誤差Δψ
として算出するステップと、速度計で検出された車両進
行方向の速度である車両速度ｕと前記方位角誤差Δψと
から横速度誤差ｕΔψを算出するステップと、前記横速
度誤差ｕΔψと乗数Ｋ1とから横速度制御量Ｋ1ｕΔψを
算出するステップと、前記横速度誤差ｕΔψと乗数Ｋ2
とから横位置制御量Ｋ2ｕΔψ／ｓを算出するステップ
（ｓはラプラス演算子）と、前記横速度制御量Ｋ1ｕΔ
ψと前記横位置制御量Ｋ2ｕΔψ／ｓとの和演算から操
舵指令〔Ｋ1ｕΔψ＋Ｋ2ｕΔψ／ｓ〕を算出するステッ
プとをコンピュータに実行させるための車両方位制御用
プログラム。
【００１８】
【発明の実施の形態】次に、本発明の実施の形態につい
て図面を参照して説明する。
て図面を参照して説明する。
【００１９】図１は、本発明になる車両方位制御装置の
一実施の形態を表すブロック線図である。また、図２
は、本発明になる車両方位制御装置の別の実施の形態を
表すブロック線図である。図２のブロック線図は、制御
理論上図１のブロック線図に等価である。図３は、図１
に示した車両方位制御装置の構成を示す図である。図２
の実施の形態は図１の実施の形態に制御理論上は等価で
あるから、以下では図１及び図３を参照して本発明の一
実施の形態を説明する。
一実施の形態を表すブロック線図である。また、図２
は、本発明になる車両方位制御装置の別の実施の形態を
表すブロック線図である。図２のブロック線図は、制御
理論上図１のブロック線図に等価である。図３は、図１
に示した車両方位制御装置の構成を示す図である。図２
の実施の形態は図１の実施の形態に制御理論上は等価で
あるから、以下では図１及び図３を参照して本発明の一
実施の形態を説明する。
【００２０】図３に示すように、本実施の形態の車両方
位制御装置は、方位センサ１、速度計３、操舵部４およ
び演算処理部５を含んで構成されている。この車両方位
制御装置は、自動田植機などの如くの農業作業車に搭載
されて好適である。自動田植機の使用形態では、予め設
定した目標方位に直進するように自動操向させることが
多い。目標方位角ψ2としては、たとえば、自動田植機
の教習行程で取得した方位角を演算処理部５のメモリＲ
ＡＭに格納したものを用いてもよい。
位制御装置は、方位センサ１、速度計３、操舵部４およ
び演算処理部５を含んで構成されている。この車両方位
制御装置は、自動田植機などの如くの農業作業車に搭載
されて好適である。自動田植機の使用形態では、予め設
定した目標方位に直進するように自動操向させることが
多い。目標方位角ψ2としては、たとえば、自動田植機
の教習行程で取得した方位角を演算処理部５のメモリＲ
ＡＭに格納したものを用いてもよい。
【００２１】操舵部４は増幅部とアクチュエータと操舵
機構とからなる。増幅部は、電気信号である操舵指令Ｄ
を増幅する。アクチュエータは、増幅された操舵指令Ｄ
を受け、操舵指令Ｄに応じて操舵機構を駆動する。操舵
機構は、車輪と、アクチュエータの出力を車輪に伝える
伝達機構とでなる。舵角θは、操舵機構の機械的な角度
であり、ここでは車輪の角度である。速度計３は、車両
の進行方向の速度を車両速度ｕとして検出する。
機構とからなる。増幅部は、電気信号である操舵指令Ｄ
を増幅する。アクチュエータは、増幅された操舵指令Ｄ
を受け、操舵指令Ｄに応じて操舵機構を駆動する。操舵
機構は、車輪と、アクチュエータの出力を車輪に伝える
伝達機構とでなる。舵角θは、操舵機構の機械的な角度
であり、ここでは車輪の角度である。速度計３は、車両
の進行方向の速度を車両速度ｕとして検出する。
【００２２】演算処理部５は、前述の操舵指令生成手段
に相当し、中央処理部ＣＰＵ、メモリＲＯＭ、メモリＲ
ＡＭ、入出力インターフェイス等で構成されている。中
央処理部ＣＰＵは、方位センサ１および速度計３から入
出力インターフェイスを介して入力された検出値につき
演算をし、演算の結果を入出力インターフェイスを介し
て操舵部４へ出力する。メモリＲＯＭは主に演算用プロ
グラム等を格納する。メモリＲＡＭは、各種検出・計測
・設定データを格納する。
に相当し、中央処理部ＣＰＵ、メモリＲＯＭ、メモリＲ
ＡＭ、入出力インターフェイス等で構成されている。中
央処理部ＣＰＵは、方位センサ１および速度計３から入
出力インターフェイスを介して入力された検出値につき
演算をし、演算の結果を入出力インターフェイスを介し
て操舵部４へ出力する。メモリＲＯＭは主に演算用プロ
グラム等を格納する。メモリＲＡＭは、各種検出・計測
・設定データを格納する。
【００２３】この車両方位制御装置における車両方位制
御方法について、図１のブロック線図及び図3の構成図
を参照して説明する。演算処理部５は、方位センサ１で
検出した車両方位角ψ1、速度計３で検出した車両速度
ｕを入力する。演算処理部５において、たとえばメモリ
ＲＡＭに記憶された目標方位角ψ２と検出した車両方位
角ψ１の差Δψ（＝ψ２ーψ１）を方位角誤差として演
算し、方位角誤差Δψに車両速度ｕを乗じる演算により
横速度誤差ｕΔψを生成する。さらに、演算処理部５に
おいて、横速度誤差ｕΔψに比例ゲインＫ1を乗じる演
算により横速度制御量Ｋ1ｕΔψを生成し、また横速度
誤差ｕΔψに積分ゲインＫ2を乗じるとともに時間積分
を施す演算により、横位置制御量Ｋ2ｕΔψ／ｓを生成
する。ここで、ｓはラプラス演算子を表し、１／ｓは時
間積分の演算を表す。横位置制御量は、車両の横方向の
ずれ量を表し、請求項１及び課題を解決するための手段
の欄[１]おける横方向偏移量に相当する。さらに、演算
処理部５において、横速度制御量Ｋ1ｕΔψ及び横位置
制御量Ｋ2ｕΔψ／ｓの和を演算することにより、操舵
指令Ｄを生成する。Ｄ＝Ｋ1ｕΔψ＋Ｋ2ｕΔψ／ｓであ
る。
御方法について、図１のブロック線図及び図3の構成図
を参照して説明する。演算処理部５は、方位センサ１で
検出した車両方位角ψ1、速度計３で検出した車両速度
ｕを入力する。演算処理部５において、たとえばメモリ
ＲＡＭに記憶された目標方位角ψ２と検出した車両方位
角ψ１の差Δψ（＝ψ２ーψ１）を方位角誤差として演
算し、方位角誤差Δψに車両速度ｕを乗じる演算により
横速度誤差ｕΔψを生成する。さらに、演算処理部５に
おいて、横速度誤差ｕΔψに比例ゲインＫ1を乗じる演
算により横速度制御量Ｋ1ｕΔψを生成し、また横速度
誤差ｕΔψに積分ゲインＫ2を乗じるとともに時間積分
を施す演算により、横位置制御量Ｋ2ｕΔψ／ｓを生成
する。ここで、ｓはラプラス演算子を表し、１／ｓは時
間積分の演算を表す。横位置制御量は、車両の横方向の
ずれ量を表し、請求項１及び課題を解決するための手段
の欄[１]おける横方向偏移量に相当する。さらに、演算
処理部５において、横速度制御量Ｋ1ｕΔψ及び横位置
制御量Ｋ2ｕΔψ／ｓの和を演算することにより、操舵
指令Ｄを生成する。Ｄ＝Ｋ1ｕΔψ＋Ｋ2ｕΔψ／ｓであ
る。
【００２４】この図１に示したブロック線図による制御
系では、目標方位角ψ２に対する車両方位角ψ１の比、
即ちこの制御系の伝達特性は、 となる。
系では、目標方位角ψ２に対する車両方位角ψ１の比、
即ちこの制御系の伝達特性は、 となる。
【００２５】式（２）におけるＫ1及びＫ2は定数である
が、この車両方位制御装置の伝達特性は、車両の直進方
向の速度、即ち車両速度ｕに関する項を含んでおり、車
両速度ｕが増大すると制御系のゲインが増大し、応答速
度が増大する。式（２）を式（１）と対比して明らかな
ように、式（２）におけるｕＫ1は式（１）における比
例ゲインＫ1に対応し、式（２）におけるｕＫ２は式
（１）における積分ゲインＫ２に対応する。即ち本実施
の形態では、比例ゲインをｕＫ1とし、積分ゲインをｕ
Ｋ２とした図４の従来の装置に等価である。
が、この車両方位制御装置の伝達特性は、車両の直進方
向の速度、即ち車両速度ｕに関する項を含んでおり、車
両速度ｕが増大すると制御系のゲインが増大し、応答速
度が増大する。式（２）を式（１）と対比して明らかな
ように、式（２）におけるｕＫ1は式（１）における比
例ゲインＫ1に対応し、式（２）におけるｕＫ２は式
（１）における積分ゲインＫ２に対応する。即ち本実施
の形態では、比例ゲインをｕＫ1とし、積分ゲインをｕ
Ｋ２とした図４の従来の装置に等価である。
【００２６】したがって、式（２）の伝達特性で制御さ
れる装置では、広い範囲の比例ゲイン車両速度ｕで好適
な応答性を示す制御系を設計できる。そこで、この制御
系は広い範囲の車両速度ｕで最適特性に近い特性で応答
できる。式（２）の伝達特性の制御系で操舵指令Ｄを生
成するこの車両方位制御装置は、車両速度ｕが大きいと
き、制御系のゲインが大きくなるから、大きい車両速度
ｕにおいて応答遅れが人の運転に近い程度に小さく、車
両方位ψ1が目標方位角ψ2からずれる量（方位角誤差Δ
ψ）が小さく、ひいては車両の走行径路と設定径路との
誤差は小さいものとなる。また、車両速度ｕが遅いとき
は、制御系のゲインが小さくなるから、操舵系は不必要
に頻繁に舵角θを変動させることがなく、低速における
車両の乗り心地がよい。このように、図１に示した装置
では、車両速度ｕが遅いときにはゆっくりと操舵をし、
車両速度ｕが速いときには素早く操舵をするという人の
操舵態様に近い操舵態様で車両を操舵でき、車両速度ｕ
に拘わらず安定に目標方位に直進できる。
れる装置では、広い範囲の比例ゲイン車両速度ｕで好適
な応答性を示す制御系を設計できる。そこで、この制御
系は広い範囲の車両速度ｕで最適特性に近い特性で応答
できる。式（２）の伝達特性の制御系で操舵指令Ｄを生
成するこの車両方位制御装置は、車両速度ｕが大きいと
き、制御系のゲインが大きくなるから、大きい車両速度
ｕにおいて応答遅れが人の運転に近い程度に小さく、車
両方位ψ1が目標方位角ψ2からずれる量（方位角誤差Δ
ψ）が小さく、ひいては車両の走行径路と設定径路との
誤差は小さいものとなる。また、車両速度ｕが遅いとき
は、制御系のゲインが小さくなるから、操舵系は不必要
に頻繁に舵角θを変動させることがなく、低速における
車両の乗り心地がよい。このように、図１に示した装置
では、車両速度ｕが遅いときにはゆっくりと操舵をし、
車両速度ｕが速いときには素早く操舵をするという人の
操舵態様に近い操舵態様で車両を操舵でき、車両速度ｕ
に拘わらず安定に目標方位に直進できる。
【００２７】なお、図１乃至図３の実施形態に関する以
上の説明では、比例ゲインＫ1及び積分ゲインＫ2は一定
値とした。しかしながら、比例ゲインＫ1及び積分ゲイ
ンＫ 2は必ずしも一定値である必要はなく、車両速度ｕ
の関数としても差し支えない。車両速度ｕの増大および
減少に対応してそれぞれ増大および減少をする関数の採
用により、本発明の車両方位制御装置の応答性を一層向
上できる。また、上述の車両方位制御方法は、ＲＯＭメ
モリなどに記憶したコンピュータプログラムで実行させ
ることができる。
上の説明では、比例ゲインＫ1及び積分ゲインＫ2は一定
値とした。しかしながら、比例ゲインＫ1及び積分ゲイ
ンＫ 2は必ずしも一定値である必要はなく、車両速度ｕ
の関数としても差し支えない。車両速度ｕの増大および
減少に対応してそれぞれ増大および減少をする関数の採
用により、本発明の車両方位制御装置の応答性を一層向
上できる。また、上述の車両方位制御方法は、ＲＯＭメ
モリなどに記憶したコンピュータプログラムで実行させ
ることができる。
【００２８】
【発明の効果】上述のように、本発明によれば、広い範
囲の車両速度において目標方位に正確に追随でき、人の
操縦に近い態様の乗り心地のよい応答性を示し、しかも
構成が単純な車両方位制御装置、車両方位制御方法およ
び車両方位制御プログラムを提供できる。
囲の車両速度において目標方位に正確に追随でき、人の
操縦に近い態様の乗り心地のよい応答性を示し、しかも
構成が単純な車両方位制御装置、車両方位制御方法およ
び車両方位制御プログラムを提供できる。
【図１】本発明になる車両方位制御装置の一実施の形態
を表すブロック線図である。
を表すブロック線図である。
【図２】本発明になる車両方位制御装置の別の実施の形
態を表すブロック線図である。
態を表すブロック線図である。
【図３】図１に示した車両方位制御装置の構成を示す図
である。
である。
【図４】従来の車両方位制御装置の一例を表すブロック
線図である。
線図である。
【図５】図４に示した従来の車両方位制御装置の構成を
示す図である。
示す図である。
１：方位角センサ
３：速度計
４：操舵部
５，１５：演算処理部
Ｄ：操舵指令
Ｋ1：比例ゲイン
Ｋ2：積分ゲイン
ｓ：ラプラス演算子
ｕ：車両速度
ψ1：車両方位角
ψ2：目標方位角
─────────────────────────────────────────────────────
フロントページの続き
(72)発明者 松尾 陽介
埼玉県さいたま市日進町１丁目40番地２
生物系特定産業技術研究推進機構内
(72)発明者 山本 聡史
埼玉県さいたま市日進町１丁目40番地２
生物系特定産業技術研究推進機構内
(72)発明者 行本 修
茨城県つくば市観音台３−１−１ 独立行
政法人農業技術研究機構 中央農業総合研
究センター内
Ｆターム(参考） 2B043 AA04 AB02 AB06 BA02 BB01
BB06 EA06 EA13 EB05 EB10
EC02 EC12 EC13 EC14 EC19
ED02 ED03
3D032 CC50 DA21 DA23 DA27 EB01
EB04 EB15 GG11
5H301 AA03 BB01 CC03 CC06 HH16
Claims (4)
- 【請求項１】方位センサで検出された車両方位角ψ1お
よび目標方位角ψ2に基づき、車両の操舵指令を生成
し、該操舵指令を操舵系に出力することにより車両の方
位を制御する車両方位制御装置において、 車両方位角ψ1と目標方位角ψ２との差△ψに車両速度
ｕを乗じて横速度誤差ｕ△ψを算出し、さらに横速度誤
差ｕ△ψと定数Ｋ1との積Ｋ1ｕ△ψを車両の横方向速度
成分である横速度制御量とし、横速度誤差ｕΔψの時間
積分と定数Ｋ２との積Ｋ２ｕΔψ／ｓ（ｓはラプラス演
算子）を車両の横方向偏移量成分である横位置制御量と
して、該横速度制御量および該横位置制御量の和に基づ
き前記操舵指令を演算することを特徴とする車両方位制
御装置。 - 【請求項２】前記定数Ｋ1及びＫ2は、車両速度ｕの関数
であり、車両速度ｕの増減に応じて増減することを特徴
とする請求項１に記載の車両方位制御装置。 - 【請求項３】方位センサで検出された車両方位角ψ1と
目標方位角ψ2との差をΔψとするとき、車両速度ｕと
該差Δψとから横速度誤差ｕΔψを算出するステップ
と、 横速度誤差ｕΔψと定数Ｋ1とから横速度制御量Ｋ1ｕΔ
ψを算出するステップと、 横速度誤差ｕΔψと定数Ｋ2とから横位置制御量Ｋ2ｕΔ
ψ／ｓを算出するステップ（ｓはラプラス演算子）と、 横速度制御量Ｋ1ｕΔψと前記横位置制御量Ｋ2ｕΔψ／
ｓとの和演算から操舵指令〔Ｋ1ｕΔψ＋Ｋ2ｕΔψ／
ｓ〕を算出するステップとを有することを特徴とする車
両方位制御方法。 - 【請求項４】方位センサで検出された車両方位角ψ1と
目標方位角ψ2との差をΔψとするとき、車両速度ｕと
該差Δψとから横速度誤差ｕΔψを算出するステップ
と、 横速度誤差ｕΔψと定数Ｋ1とから横速度制御量Ｋ1ｕΔ
ψを算出するステップと、 横速度誤差ｕΔψと定数Ｋ2とから横位置制御量Ｋ2ｕΔ
ψ／ｓを算出するステップ（ｓはラプラス演算子）と、 横速度制御量Ｋ1ｕΔψと前記横位置制御量Ｋ2ｕΔψ／
ｓとの和演算から操舵指令〔Ｋ1ｕΔψ＋Ｋ2ｕΔψ／
ｓ〕を算出するステップとをコンピュータに実行させる
ための車両方位制御用プログラム。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2002005650A JP3718721B2 (ja) | 2002-01-15 | 2002-01-15 | 横速度を利用した車両方位制御装置、車両方位制御方法および車両方位制御プログラム |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2002005650A JP3718721B2 (ja) | 2002-01-15 | 2002-01-15 | 横速度を利用した車両方位制御装置、車両方位制御方法および車両方位制御プログラム |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2003208225A true JP2003208225A (ja) | 2003-07-25 |
| JP3718721B2 JP3718721B2 (ja) | 2005-11-24 |
Family
ID=27644638
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2002005650A Expired - Fee Related JP3718721B2 (ja) | 2002-01-15 | 2002-01-15 | 横速度を利用した車両方位制御装置、車両方位制御方法および車両方位制御プログラム |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP3718721B2 (ja) |
Cited By (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2009517284A (ja) * | 2005-12-01 | 2009-04-30 | トヨタ自動車株式会社 | 運転支援システムおよび運転支援方法 |
| JP2019170199A (ja) * | 2018-03-27 | 2019-10-10 | ヤンマー株式会社 | 自律操舵装置 |
| JP2020135711A (ja) * | 2019-02-25 | 2020-08-31 | 三菱重工エンジニアリング株式会社 | 制御装置、移動体および制御方法 |
-
2002
- 2002-01-15 JP JP2002005650A patent/JP3718721B2/ja not_active Expired - Fee Related
Cited By (7)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2009517284A (ja) * | 2005-12-01 | 2009-04-30 | トヨタ自動車株式会社 | 運転支援システムおよび運転支援方法 |
| JP4816732B2 (ja) * | 2005-12-01 | 2011-11-16 | トヨタ自動車株式会社 | 運転支援システムおよび運転支援方法 |
| US8150581B2 (en) | 2005-12-01 | 2012-04-03 | Toyota Jidosha Kabushiki Kaisha | Driving assistance system and driving assistance method |
| JP2019170199A (ja) * | 2018-03-27 | 2019-10-10 | ヤンマー株式会社 | 自律操舵装置 |
| JP2020135711A (ja) * | 2019-02-25 | 2020-08-31 | 三菱重工エンジニアリング株式会社 | 制御装置、移動体および制御方法 |
| WO2020175313A1 (ja) * | 2019-02-25 | 2020-09-03 | 三菱重工エンジニアリング株式会社 | 制御装置、移動体および制御方法 |
| JP7179644B2 (ja) | 2019-02-25 | 2022-11-29 | 三菱重工エンジニアリング株式会社 | 制御装置、移動体および制御方法 |
Also Published As
| Publication number | Publication date |
|---|---|
| JP3718721B2 (ja) | 2005-11-24 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| US5528497A (en) | Vehicle steering control system | |
| US6886656B2 (en) | Electric power steering apparatus | |
| JP5170496B2 (ja) | 電動パワーステアリング装置 | |
| WO2017221325A1 (ja) | 車両運転支援装置および車両運転支援方法 | |
| CN106458254B (zh) | 电动助力转向装置 | |
| JP2002087309A (ja) | 自動車の電動パワーステアリング装置 | |
| EP1447308B1 (en) | Vehicle steering apparatus | |
| JP2005008007A (ja) | 車両用操舵装置 | |
| CN105980237B (zh) | 电动助力转向装置 | |
| JP4082860B2 (ja) | 電動パワーステアリング装置 | |
| JP4456018B2 (ja) | 車両の操舵装置 | |
| JP2005335495A (ja) | 車両の操舵装置 | |
| JP3714269B2 (ja) | 自動操舵装置 | |
| JP2005041386A (ja) | 車両の操舵制御装置 | |
| JPH07242179A (ja) | 車輪操舵角制御装置 | |
| JP3889916B2 (ja) | 操舵装置および操舵反力設定方法 | |
| JP2003208225A (ja) | 横速度を利用した車両方位制御装置、車両方位制御方法および車両方位制御プログラム | |
| JP2001334949A (ja) | 後輪操舵制御装置 | |
| JP4280669B2 (ja) | 車両の操舵装置 | |
| JP2010195084A (ja) | 車両の操舵制御装置 | |
| JP3182972B2 (ja) | 車両の後輪操舵制御装置 | |
| JPH0725318B2 (ja) | 車両用実舵角制御装置 | |
| JP2003081118A (ja) | 自動車の電動パワーステアリング装置 | |
| JPH05229443A (ja) | 車両の補助操舵装置 | |
| JP2003205847A (ja) | 車両方位制御装置、車両方位制御方法および車両方位制御プログラム |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20050627 |
|
| TRDD | Decision of grant or rejection written | ||
| A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20050726 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20050812 |
|
| R150 | Certificate of patent or registration of utility model |
Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
| R154 | Certificate of patent or utility model (reissue) |
Free format text: JAPANESE INTERMEDIATE CODE: R154 |
|
| S533 | Written request for registration of change of name |
Free format text: JAPANESE INTERMEDIATE CODE: R313533 |
|
| R350 | Written notification of registration of transfer |
Free format text: JAPANESE INTERMEDIATE CODE: R350 |
|
| LAPS | Cancellation because of no payment of annual fees |