JPH11353024A - 自動走行式連結車両 - Google Patents
自動走行式連結車両Info
- Publication number
- JPH11353024A JPH11353024A JP10160324A JP16032498A JPH11353024A JP H11353024 A JPH11353024 A JP H11353024A JP 10160324 A JP10160324 A JP 10160324A JP 16032498 A JP16032498 A JP 16032498A JP H11353024 A JPH11353024 A JP H11353024A
- Authority
- JP
- Japan
- Prior art keywords
- vehicle
- trailer
- semi
- traveling route
- traveling
- 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
- 238000010586 diagram Methods 0.000 description 14
- 238000013459 approach Methods 0.000 description 5
- 238000000034 method Methods 0.000 description 5
- 238000006243 chemical reaction Methods 0.000 description 2
- 230000004907 flux Effects 0.000 description 2
Landscapes
- Steering Control In Accordance With Driving Conditions (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
(57)【要約】
【課題】 AGV11の後ろにセミトレーラ16を連結し、
走行ルート線20に沿って走行する自動走行式連結車両10
において、走行ルート線20の直線部を後進するときの自
動走行制御を確立する。 【解決手段】 F:後進時にAGV11からキングピン17
を介してセミトレーラ16へ作用する推進力の方向、δ:
走行ルート線20の後方へ向かって走行ルート線20に対す
るAGV左右中心線22の角度。α:AGV左右中心線22
の後方へ向かってAGV左右中心線22に対するFの角
度。γ:走行ルート線20の後方へ向かって走行ルート線
20に対するセミトレーラ左右中心線23の角度。θ:=α
+δ−γ。x:走行ルート線20に対する左右方向左右車
輪中心24の偏倚量。これら各記号において、基準側の線
に対して左側を正とする。θがxと同一符号となるよう
に、後輪13の操舵角を制御する。制御原理が単純とな
る。
走行ルート線20に沿って走行する自動走行式連結車両10
において、走行ルート線20の直線部を後進するときの自
動走行制御を確立する。 【解決手段】 F:後進時にAGV11からキングピン17
を介してセミトレーラ16へ作用する推進力の方向、δ:
走行ルート線20の後方へ向かって走行ルート線20に対す
るAGV左右中心線22の角度。α:AGV左右中心線22
の後方へ向かってAGV左右中心線22に対するFの角
度。γ:走行ルート線20の後方へ向かって走行ルート線
20に対するセミトレーラ左右中心線23の角度。θ:=α
+δ−γ。x:走行ルート線20に対する左右方向左右車
輪中心24の偏倚量。これら各記号において、基準側の線
に対して左側を正とする。θがxと同一符号となるよう
に、後輪13の操舵角を制御する。制御原理が単純とな
る。
Description
【0001】
【発明の属する技術分野】この発明は、所定の走行ルー
ト線に沿って自動走行する自動走行車を含む自動走行式
連結車両に係り、詳しくは自動走行車及びそれに連結ピ
ンを介して連結されるセミトレーラを含む自動走行式連
結車両に関するものである。
ト線に沿って自動走行する自動走行車を含む自動走行式
連結車両に係り、詳しくは自動走行車及びそれに連結ピ
ンを介して連結されるセミトレーラを含む自動走行式連
結車両に関するものである。
【0002】
【従来の技術】自動走行車に連結ピンを介してセミトレ
ーラを連結し、自動走行車が、セミトレーラを牽引しつ
つ、走行ルート線に沿って自動的に前進走行することは
すでに行われていることである。
ーラを連結し、自動走行車が、セミトレーラを牽引しつ
つ、走行ルート線に沿って自動的に前進走行することは
すでに行われていることである。
【0003】
【発明が解決しようとする課題】自動走行車が連結ピン
を介してセミトレーラを連結されているとき、前進時の
走行制御は確立されているが、後進時の走行制御はいま
だ確立されていない。
を介してセミトレーラを連結されているとき、前進時の
走行制御は確立されているが、後進時の走行制御はいま
だ確立されていない。
【0004】この発明の目的は、自動走行車とそれに連
結ピンを介して連結されているセミトレーラとを含む自
動走行式連結車両において、走行ルート直線に沿って後
進する場合の自動走行制御を確立することである。
結ピンを介して連結されているセミトレーラとを含む自
動走行式連結車両において、走行ルート直線に沿って後
進する場合の自動走行制御を確立することである。
【0005】
【課題を解決するための手段】この発明の自動走行式連
結車両(10)によれば、自動走行車(11)が、連結ピン(17)
を介して後ろ側にセミトレーラ(16)を連結されている。
各記号を下記のように定義する。 F:後進時の連結ピン(17)における自動走行車(11)から
セミトレーラ(16)への推進力の方向。 δ:後方へ向かって走行ルート直線(20)に対する自動走
行車左右中心線(22)の角度。ただし、走行ルート直線(2
0)に対して左右方向の一方の側を正とする。 α:後方へ向かって自動走行車左右中心線(22)に対する
Fの角度。ただし、自動走行車左右中心線(22)に対して
左右方向の一方の側を正とする。 γ:後方へ向かって走行ルート直線(20)に対するセミト
レーラ左右中心線(23)の角度。ただし、走行ルート直線
(20)に対して左右方向の一方の側を正とする。 θ:=α+δ−γ。 x:走行ルート直線(20)に対するセミトレーラ(16)のの
左右方向左右車輪中心(24)の偏倚量。ただし、走行ルー
ト直線(20)に対して左右方向の一方の側を正とする。 そして、後進時では、後輪(13)を操舵自在とするととも
に、θがxと同符号になるように、自動走行車(11)の後
輪(13)を操舵する。
結車両(10)によれば、自動走行車(11)が、連結ピン(17)
を介して後ろ側にセミトレーラ(16)を連結されている。
各記号を下記のように定義する。 F:後進時の連結ピン(17)における自動走行車(11)から
セミトレーラ(16)への推進力の方向。 δ:後方へ向かって走行ルート直線(20)に対する自動走
行車左右中心線(22)の角度。ただし、走行ルート直線(2
0)に対して左右方向の一方の側を正とする。 α:後方へ向かって自動走行車左右中心線(22)に対する
Fの角度。ただし、自動走行車左右中心線(22)に対して
左右方向の一方の側を正とする。 γ:後方へ向かって走行ルート直線(20)に対するセミト
レーラ左右中心線(23)の角度。ただし、走行ルート直線
(20)に対して左右方向の一方の側を正とする。 θ:=α+δ−γ。 x:走行ルート直線(20)に対するセミトレーラ(16)のの
左右方向左右車輪中心(24)の偏倚量。ただし、走行ルー
ト直線(20)に対して左右方向の一方の側を正とする。 そして、後進時では、後輪(13)を操舵自在とするととも
に、θがxと同符号になるように、自動走行車(11)の後
輪(13)を操舵する。
【0006】自動走行車(11)において、後輪(13)が、前
後方向へ連結ピン(17)と同一位置あり、かつ前輪(12)を
直進固定、後輪(13)を操舵輪として後進する場合は、F
の向きは、後輪(13)の向きに一致する。また、自動走行
車(11)は、通常、前輪(12)及び後輪(13)が2輪ずつであ
るが、一方を一輪として三輪タイプも含むものとする。
後方向へ連結ピン(17)と同一位置あり、かつ前輪(12)を
直進固定、後輪(13)を操舵輪として後進する場合は、F
の向きは、後輪(13)の向きに一致する。また、自動走行
車(11)は、通常、前輪(12)及び後輪(13)が2輪ずつであ
るが、一方を一輪として三輪タイプも含むものとする。
【0007】説明を具体化して、分かり易くするため
に、一方の側及び他方の側を自動走行式連結車両(10)の
左側及び右側に対応させる。なお、自動走行式連結車両
(10)の左側及び右側とは、自動走行式連結車両(10)の前
方へ向かって左側及び右側となる側である。xが正のと
きは、セミトレーラ(16)の後端は走行ルート直線(20)に
対して左側に位置する。したがって、θを正にすること
により、自動走行車(11)は、セミトレーラ(16)の前端を
後端に対して左へ押し出し、セミトレーラ(16)の後端
は、前端に対して右へ旋回して、走行ルート直線(20)へ
接近する。xが負のときも同様である。このように、θ
の符号をxの符号に一致させる簡単な制御原理で、自動
走行式連結車両(10)を走行ルート直線(20)に沿って後進
させることが可能になる。
に、一方の側及び他方の側を自動走行式連結車両(10)の
左側及び右側に対応させる。なお、自動走行式連結車両
(10)の左側及び右側とは、自動走行式連結車両(10)の前
方へ向かって左側及び右側となる側である。xが正のと
きは、セミトレーラ(16)の後端は走行ルート直線(20)に
対して左側に位置する。したがって、θを正にすること
により、自動走行車(11)は、セミトレーラ(16)の前端を
後端に対して左へ押し出し、セミトレーラ(16)の後端
は、前端に対して右へ旋回して、走行ルート直線(20)へ
接近する。xが負のときも同様である。このように、θ
の符号をxの符号に一致させる簡単な制御原理で、自動
走行式連結車両(10)を走行ルート直線(20)に沿って後進
させることが可能になる。
【0008】この発明の自動走行式連結車両(10)によれ
ば、xがほぼ0の場合は、θがγと同符号になるよう
に、自動走行車(11)の後輪(13)を操舵する。
ば、xがほぼ0の場合は、θがγと同符号になるよう
に、自動走行車(11)の後輪(13)を操舵する。
【0009】xがほぼ0であるとは、セミトレーラ(16)
の左右方向左右車輪中心(24)が走行ルート直線(20)上に
ある状態である。この状態でγが正のときは、セミトレ
ーラ(16)の後端は前端に対して斜め左方へ向いている。
したがって、θの符号を、γの符号と同じく、正にする
ことにより、自動走行車(11)は、セミトレーラ(16)の前
端を後端に対して左へ押し出し、セミトレーラ(16)は、
走行ルート直線(20)に沿う方向になろうとする。γが負
のときも同様である。
の左右方向左右車輪中心(24)が走行ルート直線(20)上に
ある状態である。この状態でγが正のときは、セミトレ
ーラ(16)の後端は前端に対して斜め左方へ向いている。
したがって、θの符号を、γの符号と同じく、正にする
ことにより、自動走行車(11)は、セミトレーラ(16)の前
端を後端に対して左へ押し出し、セミトレーラ(16)は、
走行ルート直線(20)に沿う方向になろうとする。γが負
のときも同様である。
【0010】この発明の自動走行式連結車両(10)によれ
ば、θの絶対値を、x及びγの符号が同一の場合は、x
及びγの一方がほぼ0の場合よりも、大きい値に設定す
る。
ば、θの絶対値を、x及びγの符号が同一の場合は、x
及びγの一方がほぼ0の場合よりも、大きい値に設定す
る。
【0011】x及びγが共に正であるとは、自動走行式
連結車両(10)の後進中、セミトレーラ(16)の後端が走行
ルート直線(20)より左にあり、かつセミトレーラ(16)の
後端が前端に対して斜め左後方へ向いているということ
である。セミトレーラ(16)のこの姿勢のまま後方へ推進
していけば、セミトレーラ(16)は走行ルート直線(20)か
らますます遠ざかってしまうので、θを大きくして、こ
れを回避する。x及びγが共に負であるときも同様であ
る。これに対して、x及びγの一方がほぼ0であると
は、セミトレーラ(16)の左右方向左右車輪中心(24)が走
行ルート直線(20)上にあるか、セミトレーラ左右中心線
(23)が走行ルート直線(20)に平行になっているかという
ことであり、セミトレーラ(16)は走行ルート直線(20)に
十分に接近している。したがって、θは、x又はγと同
符号にするものの、その絶対値は、x及びγが共に正で
あるときよりも小さくする。
連結車両(10)の後進中、セミトレーラ(16)の後端が走行
ルート直線(20)より左にあり、かつセミトレーラ(16)の
後端が前端に対して斜め左後方へ向いているということ
である。セミトレーラ(16)のこの姿勢のまま後方へ推進
していけば、セミトレーラ(16)は走行ルート直線(20)か
らますます遠ざかってしまうので、θを大きくして、こ
れを回避する。x及びγが共に負であるときも同様であ
る。これに対して、x及びγの一方がほぼ0であると
は、セミトレーラ(16)の左右方向左右車輪中心(24)が走
行ルート直線(20)上にあるか、セミトレーラ左右中心線
(23)が走行ルート直線(20)に平行になっているかという
ことであり、セミトレーラ(16)は走行ルート直線(20)に
十分に接近している。したがって、θは、x又はγと同
符号にするものの、その絶対値は、x及びγが共に正で
あるときよりも小さくする。
【0012】この発明の自動走行式連結車両(10)によれ
ば、x及びγの両方が0の場合は、θの絶対値を0とす
る。
ば、x及びγの両方が0の場合は、θの絶対値を0とす
る。
【0013】x及びθの両方が0の場合とは、自動走行
車(11)の左右方向左右車輪中心(24)及びセミトレーラ(1
6)のセミトレーラ左右中心線(23)が共に走行ルート直線
(20)上にあることであるので、この場合は、θを0にし
て、自動走行車(11)及びセミトレーラ(16)の姿勢をこの
まま維持する。
車(11)の左右方向左右車輪中心(24)及びセミトレーラ(1
6)のセミトレーラ左右中心線(23)が共に走行ルート直線
(20)上にあることであるので、この場合は、θを0にし
て、自動走行車(11)及びセミトレーラ(16)の姿勢をこの
まま維持する。
【0014】
【発明の実施の形態】以下、発明の実施の形態について
図面を参照して説明する。図1は自動走行式連結車両10
の後進時の各記号の定義を示している。AGV(Aut
omatic Guided Vehicle)11は前
輪12及び後輪13を左右にもつ。前輪12及び後輪13は共に
操舵自在であり、前進時では、前輪12が操舵輪とされる
とともに、後輪13が直進固定され、また、後進時では、
前輪12が直進固定されるとともに、後輪13が操舵輪とさ
れる。自動走行式連結車両10は、前輪12及び後輪13の一
方のみが駆動輪である二輪駆動であっても、両方が駆動
輪である全輪駆動であってもよい。全輪駆動には、四輪
駆動だけでなく、AGV11が三輪タイプの場合の、三輪
駆動も含む。すなわち、駆動タイプは、1輪駆動以上全
輪駆動以下まで、何でもよい。セミトレーラ16は、前部
においてカプラを介してキングピン17の周りに回転自在
にAGV11の後部に支持、及び連結され、後部には左右
に車輪18を備えている。キングピン17はAGV左右中心
線22上でかつセミトレーラ左右中心線23上に存在する。
この自動走行式連結車両10では、キングピン17は、作用
説明の便宜のために、左右の後輪13の中心点を通る直線
上に位置している。キングピン17は、AGV11の前後方
向へ後輪13とは異なる位置、通常は後方側にあり、その
ような場合の図1の状態への換算方法は、図4で後述す
る。走行ルート線20には、磁石が連続して埋設されてお
り、AGV11は、走行中、その磁石に因る磁界から走行
ルート線20に対する左右方向偏倚を検出し、偏倚をなく
す方向へ操舵を行い、これにより、走行ルート線20に沿
う自動的な前進走行を実現する。図1では、走行ルート
線20は直線となっている。後述の後進制御は、このよう
な直線の走行ルート線20におけるものとなっている。左
右方向左右車輪中心24は、左右の車輪18の中心を結ぶ直
線ととしての左右車輪軸線25とセミトレーラ左右中心線
23との交点となる。
図面を参照して説明する。図1は自動走行式連結車両10
の後進時の各記号の定義を示している。AGV(Aut
omatic Guided Vehicle)11は前
輪12及び後輪13を左右にもつ。前輪12及び後輪13は共に
操舵自在であり、前進時では、前輪12が操舵輪とされる
とともに、後輪13が直進固定され、また、後進時では、
前輪12が直進固定されるとともに、後輪13が操舵輪とさ
れる。自動走行式連結車両10は、前輪12及び後輪13の一
方のみが駆動輪である二輪駆動であっても、両方が駆動
輪である全輪駆動であってもよい。全輪駆動には、四輪
駆動だけでなく、AGV11が三輪タイプの場合の、三輪
駆動も含む。すなわち、駆動タイプは、1輪駆動以上全
輪駆動以下まで、何でもよい。セミトレーラ16は、前部
においてカプラを介してキングピン17の周りに回転自在
にAGV11の後部に支持、及び連結され、後部には左右
に車輪18を備えている。キングピン17はAGV左右中心
線22上でかつセミトレーラ左右中心線23上に存在する。
この自動走行式連結車両10では、キングピン17は、作用
説明の便宜のために、左右の後輪13の中心点を通る直線
上に位置している。キングピン17は、AGV11の前後方
向へ後輪13とは異なる位置、通常は後方側にあり、その
ような場合の図1の状態への換算方法は、図4で後述す
る。走行ルート線20には、磁石が連続して埋設されてお
り、AGV11は、走行中、その磁石に因る磁界から走行
ルート線20に対する左右方向偏倚を検出し、偏倚をなく
す方向へ操舵を行い、これにより、走行ルート線20に沿
う自動的な前進走行を実現する。図1では、走行ルート
線20は直線となっている。後述の後進制御は、このよう
な直線の走行ルート線20におけるものとなっている。左
右方向左右車輪中心24は、左右の車輪18の中心を結ぶ直
線ととしての左右車輪軸線25とセミトレーラ左右中心線
23との交点となる。
【0015】図1の各記号の定義は次のとおりである。
なお、図1の上下左右をそれぞれ自動走行式連結車両10
の前後左右とする。 F:自動走行式連結車両10の後進時にキングピン17を介
してAGV11からセミトレーラ16へ作用する推進力の方
向 δ:走行ルート線20の後方へ向かって走行ルート線20に
対するAGV左右中心線22の角度。走行ルート線20に対
して左側を正とする。 α:AGV左右中心線22の後方へ向かってAGV左右中
心線22に対するFの角度。AGV左右中心線22の左側を
正とする。αは後輪13の操舵角に一致する。 γ:走行ルート線20の後方へ向かって走行ルート線20に
対するセミトレーラ左右中心線23の角度。走行ルート線
20の左側を正とする。 θ:=α+δ−γ x:走行ルート線20からの左右方向左右車輪中心24の偏
倚量。走行ルート線20の左側を正とする。 L:セミトレーラ左右中心線23上のキングピン17と左右
方向左右車輪中心24との距離
なお、図1の上下左右をそれぞれ自動走行式連結車両10
の前後左右とする。 F:自動走行式連結車両10の後進時にキングピン17を介
してAGV11からセミトレーラ16へ作用する推進力の方
向 δ:走行ルート線20の後方へ向かって走行ルート線20に
対するAGV左右中心線22の角度。走行ルート線20に対
して左側を正とする。 α:AGV左右中心線22の後方へ向かってAGV左右中
心線22に対するFの角度。AGV左右中心線22の左側を
正とする。αは後輪13の操舵角に一致する。 γ:走行ルート線20の後方へ向かって走行ルート線20に
対するセミトレーラ左右中心線23の角度。走行ルート線
20の左側を正とする。 θ:=α+δ−γ x:走行ルート線20からの左右方向左右車輪中心24の偏
倚量。走行ルート線20の左側を正とする。 L:セミトレーラ左右中心線23上のキングピン17と左右
方向左右車輪中心24との距離
【0016】図2は図1のδを求める説明図である。前
側磁気センサ列34及び後ろ側磁気センサ列35は、AGV
左右中心線22上に離れた2個所においてAGV11の左右
方向へ直線で延びている。前側磁気センサ列34及び後ろ
側磁気センサ列35には、磁気センサが等間隔で配列され
ており、各磁気センサは、走行ルート線20上の磁石から
の磁束を検出して、走行ルート線20に対して左側にある
か、右側にあるか、ほぼ真上にあるかを検出できる。各
前側磁気センサ列34及び後ろ側磁気センサ列35におい
て、走行ルート線20のほぼ真上にある磁気センサがどれ
かを検出することにより、その真上に位置する磁気セン
サから、すなわち走行ルート線20から各前側磁気センサ
列34及び後ろ側磁気センサ列35における左右中心までの
距離d1,d2を検出することができる。また、AGV
左右中心線22上の前側磁気センサ列34及び後ろ側磁気セ
ンサ列35の距離をwとし、走行ルート線20に対する左側
へのずれを正とすると、tanδ=(d2−d1)/w
となり、δを求めることができる。
側磁気センサ列34及び後ろ側磁気センサ列35は、AGV
左右中心線22上に離れた2個所においてAGV11の左右
方向へ直線で延びている。前側磁気センサ列34及び後ろ
側磁気センサ列35には、磁気センサが等間隔で配列され
ており、各磁気センサは、走行ルート線20上の磁石から
の磁束を検出して、走行ルート線20に対して左側にある
か、右側にあるか、ほぼ真上にあるかを検出できる。各
前側磁気センサ列34及び後ろ側磁気センサ列35におい
て、走行ルート線20のほぼ真上にある磁気センサがどれ
かを検出することにより、その真上に位置する磁気セン
サから、すなわち走行ルート線20から各前側磁気センサ
列34及び後ろ側磁気センサ列35における左右中心までの
距離d1,d2を検出することができる。また、AGV
左右中心線22上の前側磁気センサ列34及び後ろ側磁気セ
ンサ列35の距離をwとし、走行ルート線20に対する左側
へのずれを正とすると、tanδ=(d2−d1)/w
となり、δを求めることができる。
【0017】αは後輪13の操舵角から検出できる。γ
は、キングピン17におけるAGV左右中心線22とセミト
レーラ左右中心線23との相対回転角β(セミトレーラ左
右中心線23に対して左側を正とする。)を検出し、γ=
δ−βより求めることができる。xは、AGV11におい
て、走行ルート線20に対するキングピン17の横偏倚量d
3(走行ルート線20に対して左側を正とする。)を検出
し、x=d3+L・sinγから求めることができる。
なお、d3は、例えば、図2のように、後ろ側磁気セン
サ列35を、その中心がキングピン17の位置になるよう
に、配置し、d3=d2×cosδから導く。
は、キングピン17におけるAGV左右中心線22とセミト
レーラ左右中心線23との相対回転角β(セミトレーラ左
右中心線23に対して左側を正とする。)を検出し、γ=
δ−βより求めることができる。xは、AGV11におい
て、走行ルート線20に対するキングピン17の横偏倚量d
3(走行ルート線20に対して左側を正とする。)を検出
し、x=d3+L・sinγから求めることができる。
なお、d3は、例えば、図2のように、後ろ側磁気セン
サ列35を、その中心がキングピン17の位置になるよう
に、配置し、d3=d2×cosδから導く。
【0018】図3はx及びγに対するθの制御量を示し
ている。すなわち、自動走行式連結車両10の後進制御で
は、x及びγを検出し、検出したx及びγに対して、そ
れらに対応するθの制御量を図3の表から求め、その制
御量に現実のθがなるように、後輪13の操舵角を変更す
る。θは、x<0の場合は、γ<0,=ほぼ0、及び>
0に対してぞれぞれ絶対値の大きい負の値、絶対値の小
さい負の値、及び0とされる。x=ほぼ0の場合は、γ
<0,=ほぼ0、及び>0に対してぞれぞれ絶対値の小
さい負の値、0、及び絶対値の小さい正の値とされる。
x>0の場合は、γ<0,=ほぼ0、及び>0に対して
ぞれぞれ0、小さい正の値、及び大きい正の値とされ
る。
ている。すなわち、自動走行式連結車両10の後進制御で
は、x及びγを検出し、検出したx及びγに対して、そ
れらに対応するθの制御量を図3の表から求め、その制
御量に現実のθがなるように、後輪13の操舵角を変更す
る。θは、x<0の場合は、γ<0,=ほぼ0、及び>
0に対してぞれぞれ絶対値の大きい負の値、絶対値の小
さい負の値、及び0とされる。x=ほぼ0の場合は、γ
<0,=ほぼ0、及び>0に対してぞれぞれ絶対値の小
さい負の値、0、及び絶対値の小さい正の値とされる。
x>0の場合は、γ<0,=ほぼ0、及び>0に対して
ぞれぞれ0、小さい正の値、及び大きい正の値とされ
る。
【0019】こうして、走行ルート線20の直線部に沿っ
て自動走行式連結車両10を後進する場合は、xがほぼ0
でないときは、θがxと同符号となるように、後輪13の
操舵角が制御される。すなわちxが正のときは、セミト
レーラ16の後端が走行ルート線20に対してAGV11の左
側にあるということであり、θを正にすることにより、
セミトレーラ16は、Fにより前端を後端に対して左方へ
相対移動され、セミトレーラ16の後端は左側から走行ル
ート線20の方へ近づく。x>0で、γ>0のときは、セ
ミトレーラ16の後端が走行ルート線20に対してAGV11
の左側にあり、かつセミトレーラ16の後端が前端に対し
て斜め左方へ向いているということであり、すなわち、
セミトレーラ16は、そのままの向きで後進を続けると、
走行ルート線20からますます離れていってしまうので、
θの絶対値を大きくなるようにして、速やかにセミトレ
ーラ16の後端が前端に対して走行ルート線20の方へ向く
ようにする。x>0で、γ=ほぽ0の場合は、セミトレ
ーラ16の後端が走行ルート線20に対してAGV11の左側
にあるが、セミトレーラ左右中心線23が走行ルート線20
に対して平行であるということであり、セミトレーラ16
は、そのままの向きは維持しつつ、右の走行ルート線20
の方へ寄せるのが好ましいので、θの絶対値が小さくな
るように、後輪13の操舵角を制御する。x>0で、γ<
0の場合は、セミトレーラ16の後端が走行ルート線20に
対してAGV11の左側にあるが、セミトレーラ16の後端
が前端に対して斜め右方へ向いているということであ
り、それ以上、右の方へ向けると、セミトレーラ16は走
行ルート線20を大きく越えてしまうので、θを0にす
る。x<0の場合も同様である。
て自動走行式連結車両10を後進する場合は、xがほぼ0
でないときは、θがxと同符号となるように、後輪13の
操舵角が制御される。すなわちxが正のときは、セミト
レーラ16の後端が走行ルート線20に対してAGV11の左
側にあるということであり、θを正にすることにより、
セミトレーラ16は、Fにより前端を後端に対して左方へ
相対移動され、セミトレーラ16の後端は左側から走行ル
ート線20の方へ近づく。x>0で、γ>0のときは、セ
ミトレーラ16の後端が走行ルート線20に対してAGV11
の左側にあり、かつセミトレーラ16の後端が前端に対し
て斜め左方へ向いているということであり、すなわち、
セミトレーラ16は、そのままの向きで後進を続けると、
走行ルート線20からますます離れていってしまうので、
θの絶対値を大きくなるようにして、速やかにセミトレ
ーラ16の後端が前端に対して走行ルート線20の方へ向く
ようにする。x>0で、γ=ほぽ0の場合は、セミトレ
ーラ16の後端が走行ルート線20に対してAGV11の左側
にあるが、セミトレーラ左右中心線23が走行ルート線20
に対して平行であるということであり、セミトレーラ16
は、そのままの向きは維持しつつ、右の走行ルート線20
の方へ寄せるのが好ましいので、θの絶対値が小さくな
るように、後輪13の操舵角を制御する。x>0で、γ<
0の場合は、セミトレーラ16の後端が走行ルート線20に
対してAGV11の左側にあるが、セミトレーラ16の後端
が前端に対して斜め右方へ向いているということであ
り、それ以上、右の方へ向けると、セミトレーラ16は走
行ルート線20を大きく越えてしまうので、θを0にす
る。x<0の場合も同様である。
【0020】x=ほぽ0のときは、左右方向左右車輪中
心24が走行ルート線20上に位置しているということであ
り、θは絶対値の小さい値に設定し、かつθの符号はγ
の符号に一致させて、xが大きく変動しないようにしつ
つ、γを0へもって行くようにする。xがほぼ0で、か
つγもほぼ0であるときは、セミトレーラ16がそのセミ
トレーラ左右中心線23を走行ルート線20に重ねていると
いうことてあり、その状態を維持するように、θは0と
される。
心24が走行ルート線20上に位置しているということであ
り、θは絶対値の小さい値に設定し、かつθの符号はγ
の符号に一致させて、xが大きく変動しないようにしつ
つ、γを0へもって行くようにする。xがほぼ0で、か
つγもほぼ0であるときは、セミトレーラ16がそのセミ
トレーラ左右中心線23を走行ルート線20に重ねていると
いうことてあり、その状態を維持するように、θは0と
される。
【0021】図4はキングピン17がAGV11の前後方向
へ後輪31に対してずれている場合のαを演算する説明図
である。さらに、注釈すると、前輪12が直進固定である
ときに限定される。前輪12も操舵されるときは、前輪12
の向きの直角方位と、後輪13の直角方位との交点を改め
てo’として、図4相当の作図を作ってαを得る。AG
V11は通常前輪及び後輪を2個ずつの計4輪、装備する
が、図4では、説明の便宜上、前後1輪ずつの2輪モデ
ルとなっている。前輪及び後輪が左右対称に配置される
ときは、それらを前輪30及び後輪31に置き換えて、後進
時の状況を説明できる。各記号の定義は次のとおりであ
る。 o:AGV11の後進中の旋回中心 R:oから前輪30の中心までの距離 α’:AGV11の後進時の後輪31の操舵角 a:AGV左右中心線22上における前輪30と後輪31との
中心距離 b:AGV左右中心線22上における後輪31とキングピン
17との中心距離。後輪31の中心より後方を正にする。
へ後輪31に対してずれている場合のαを演算する説明図
である。さらに、注釈すると、前輪12が直進固定である
ときに限定される。前輪12も操舵されるときは、前輪12
の向きの直角方位と、後輪13の直角方位との交点を改め
てo’として、図4相当の作図を作ってαを得る。AG
V11は通常前輪及び後輪を2個ずつの計4輪、装備する
が、図4では、説明の便宜上、前後1輪ずつの2輪モデ
ルとなっている。前輪及び後輪が左右対称に配置される
ときは、それらを前輪30及び後輪31に置き換えて、後進
時の状況を説明できる。各記号の定義は次のとおりであ
る。 o:AGV11の後進中の旋回中心 R:oから前輪30の中心までの距離 α’:AGV11の後進時の後輪31の操舵角 a:AGV左右中心線22上における前輪30と後輪31との
中心距離 b:AGV左右中心線22上における後輪31とキングピン
17との中心距離。後輪31の中心より後方を正にする。
【0022】図5は図4の各記号間の関係式を示してい
る。前輪30の中心点とoと後輪31の中心点とを頂点とす
る三角形について、(1)式が成立する。(1)式からか
ら(2)式が導かれる。一方、(3)式が成立する。
(3)式から(4)式が導かれれる。(2)式及び
(4)式から(5)式が導かれる。こうして、α’から
αを求めることができる。
る。前輪30の中心点とoと後輪31の中心点とを頂点とす
る三角形について、(1)式が成立する。(1)式からか
ら(2)式が導かれる。一方、(3)式が成立する。
(3)式から(4)式が導かれれる。(2)式及び
(4)式から(5)式が導かれる。こうして、α’から
αを求めることができる。
【図1】自動走行式連結車両の後進時の各記号の定義を
示す図である。
示す図である。
【図2】図1のδを求める説明図である。
【図3】x及びγに対するθの制御量を示す図である。
【図4】キングピンがAGVの前後方向へ後輪に対して
ずれている場合のαを演算する説明図である。
ずれている場合のαを演算する説明図である。
【図5】図4の各記号間の関係式を示す図である。
10 自動走行式連結車両(自動走行式連結車両) 11 AGV(自動走行車) 12 前輪 13 後輪 16 セミトレーラ 17 キングピン(連結ピン) 20 走行ルート線(走行ルート直線) 22 AGV左右中心線(自動走行車左右中心線) 23 セミトレーラ左右中心線 24 左右方向左右車輪中心
【手続補正書】
【提出日】平成11年4月1日
【手続補正1】
【補正対象書類名】明細書
【補正対象項目名】全文
【補正方法】変更
【補正内容】
【書類名】 明細書
【発明の名称】 自動走行式連結車両
【特許請求の範囲】
【発明の詳細な説明】
【0001】
【発明の属する技術分野】この発明は、所定の走行ルー
ト線に沿って自動走行する自動走行車を含む自動走行式
連結車両に係り、詳しくは自動走行車及びそれに連結ピ
ンを介して連結されるセミトレーラを含む自動走行式連
結車両に関するものである。
ト線に沿って自動走行する自動走行車を含む自動走行式
連結車両に係り、詳しくは自動走行車及びそれに連結ピ
ンを介して連結されるセミトレーラを含む自動走行式連
結車両に関するものである。
【0002】
【従来の技術】自動走行車に連結ピンを介してセミトレ
ーラを連結し、自動走行車が、セミトレーラを牽引しつ
つ、走行ルート線に沿って自動的に前進走行することは
すでに行われていることである。
ーラを連結し、自動走行車が、セミトレーラを牽引しつ
つ、走行ルート線に沿って自動的に前進走行することは
すでに行われていることである。
【0003】
【発明が解決しようとする課題】自動走行車が連結ピン
を介してセミトレーラを連結されているとき、前進時の
走行制御は確立されているが、後進時の走行制御はいま
だ確立されていない。
を介してセミトレーラを連結されているとき、前進時の
走行制御は確立されているが、後進時の走行制御はいま
だ確立されていない。
【0004】この発明の目的は、自動走行車とそれに連
結ピンを介して連結されているセミトレーラとを含む自
動走行式連結車両において、走行ルート直線に沿って後
進する場合の自動走行制御を確立することである。
結ピンを介して連結されているセミトレーラとを含む自
動走行式連結車両において、走行ルート直線に沿って後
進する場合の自動走行制御を確立することである。
【0005】
【課題を解決するための手段】この発明の自動走行式連
結車両(10)によれば、自動走行車(11)が、連結ピン(17)
を介して後ろ側にセミトレーラ(16)を連結されている。
各記号を下記のように定義し(なお、下記の定義におい
て各線に対して左右方向の一方の側及び他方の側をそれ
ぞれ第1の側及び第2の側と定義している。)、 F:後進時の連結ピン(17)における自動走行車(11)から
セミトレーラ(16)への推進力の方向。 δ:後方へ向かって走行ルート直線(20)に対する自動走
行車左右中心線(22)の角度。ただし、走行ルート直線(2
0)に対して第1の側を正とする。 α:後方へ向かって自動走行車左右中心線(22)に対する
Fの角度。ただし、自動走行車左右中心線(22)に対して
第1の側を正とする。 γ:後方へ向かって走行ルート直線(20)に対するセミト
レーラ左右中心線(23)の角度。ただし、走行ルート直線
(20)に対して第1の側を正とする。 θ:=α+δ−γ。 x:走行ルート直線(20)に対するセミトレーラ(16)の左
右方向左右車輪中心(24)の偏倚量。ただし、走行ルート
直線(20)に対して第1の側を正とする。 後進時では、後輪(13)を操舵自在とするとともに、θが
xと同符号になるように、自動走行車(11)の後輪(13)を
操舵する。
結車両(10)によれば、自動走行車(11)が、連結ピン(17)
を介して後ろ側にセミトレーラ(16)を連結されている。
各記号を下記のように定義し(なお、下記の定義におい
て各線に対して左右方向の一方の側及び他方の側をそれ
ぞれ第1の側及び第2の側と定義している。)、 F:後進時の連結ピン(17)における自動走行車(11)から
セミトレーラ(16)への推進力の方向。 δ:後方へ向かって走行ルート直線(20)に対する自動走
行車左右中心線(22)の角度。ただし、走行ルート直線(2
0)に対して第1の側を正とする。 α:後方へ向かって自動走行車左右中心線(22)に対する
Fの角度。ただし、自動走行車左右中心線(22)に対して
第1の側を正とする。 γ:後方へ向かって走行ルート直線(20)に対するセミト
レーラ左右中心線(23)の角度。ただし、走行ルート直線
(20)に対して第1の側を正とする。 θ:=α+δ−γ。 x:走行ルート直線(20)に対するセミトレーラ(16)の左
右方向左右車輪中心(24)の偏倚量。ただし、走行ルート
直線(20)に対して第1の側を正とする。 後進時では、後輪(13)を操舵自在とするとともに、θが
xと同符号になるように、自動走行車(11)の後輪(13)を
操舵する。
【0006】自動走行車(11)において、後輪(13)が、前
後方向へ連結ピン(17)と同一位置にあり、かつ前輪(12)
を直進固定、後輪(13)を操舵輪として後進する場合は、
Fの向きは、後輪(13)の向きに一致する。また、自動走
行車(11)は、通常、前輪(12)及び後輪(13)が2輪ずつで
あるが、一方を一輪として三輪タイプも含むものとす
る。
後方向へ連結ピン(17)と同一位置にあり、かつ前輪(12)
を直進固定、後輪(13)を操舵輪として後進する場合は、
Fの向きは、後輪(13)の向きに一致する。また、自動走
行車(11)は、通常、前輪(12)及び後輪(13)が2輪ずつで
あるが、一方を一輪として三輪タイプも含むものとす
る。
【0007】説明を具体化して、分かり易くするため
に、第1の側及び第2の側を自動走行式連結車両(10)の
左側及び右側に対応させる。なお、自動走行式連結車両
(10)の左側及び右側とは、自動走行式連結車両(10)の前
方へ向かって左側及び右側となる側である。xが正のと
きは、セミトレーラ(16)の後端は走行ルート直線(20)に
対して左側に位置する。したがって、θを正にすること
により、自動走行車(11)は、セミトレーラ(16)の前端を
後端に対して左へ押し出し、セミトレーラ(16)の後端
は、前端に対して右へ旋回して、走行ルート直線(20)へ
接近する。xが負のときも同様である。このように、θ
の符号をxの符号に一致させる簡単な制御原理で、自動
走行式連結車両(10)を走行ルート直線(20)に沿って後進
させることが可能になる。
に、第1の側及び第2の側を自動走行式連結車両(10)の
左側及び右側に対応させる。なお、自動走行式連結車両
(10)の左側及び右側とは、自動走行式連結車両(10)の前
方へ向かって左側及び右側となる側である。xが正のと
きは、セミトレーラ(16)の後端は走行ルート直線(20)に
対して左側に位置する。したがって、θを正にすること
により、自動走行車(11)は、セミトレーラ(16)の前端を
後端に対して左へ押し出し、セミトレーラ(16)の後端
は、前端に対して右へ旋回して、走行ルート直線(20)へ
接近する。xが負のときも同様である。このように、θ
の符号をxの符号に一致させる簡単な制御原理で、自動
走行式連結車両(10)を走行ルート直線(20)に沿って後進
させることが可能になる。
【0008】この発明の自動走行式連結車両(10)によれ
ば、xがほぼ0の場合は、θがγと同符号になるよう
に、自動走行車(11)の後輪(13)を操舵する。
ば、xがほぼ0の場合は、θがγと同符号になるよう
に、自動走行車(11)の後輪(13)を操舵する。
【0009】xがほぼ0であるとは、セミトレーラ(16)
の左右方向左右車輪中心(24)が走行ルート直線(20)上に
ある状態である。この状態でγが正のときは、セミトレ
ーラ(16)の後端は前端に対して斜め左方へ向いている。
したがって、θの符号を、γの符号と同じく、正にする
ことにより、自動走行車(11)は、セミトレーラ(16)の前
端を後端に対して左へ押し出し、セミトレーラ(16)は、
走行ルート直線(20)に沿う方向になろうとする。γが負
のときも同様である。
の左右方向左右車輪中心(24)が走行ルート直線(20)上に
ある状態である。この状態でγが正のときは、セミトレ
ーラ(16)の後端は前端に対して斜め左方へ向いている。
したがって、θの符号を、γの符号と同じく、正にする
ことにより、自動走行車(11)は、セミトレーラ(16)の前
端を後端に対して左へ押し出し、セミトレーラ(16)は、
走行ルート直線(20)に沿う方向になろうとする。γが負
のときも同様である。
【0010】この発明の自動走行式連結車両(10)によれ
ば、θの絶対値を、x及びγの符号が同一の場合は、x
及びγの一方がほぼ0の場合よりも、大きい値に設定す
る。
ば、θの絶対値を、x及びγの符号が同一の場合は、x
及びγの一方がほぼ0の場合よりも、大きい値に設定す
る。
【0011】x及びγが共に正であるとは、自動走行式
連結車両(10)の後進中、セミトレーラ(16)の後端が走行
ルート直線(20)より左にあり、かつセミトレーラ(16)の
後端が前端に対して斜め左後方へ向いているということ
である。セミトレーラ(16)のこの姿勢のまま後方へ推進
していけば、セミトレーラ(16)は走行ルート直線(20)か
らますます遠ざかってしまうので、θを大きくして、こ
れを回避する。x及びγが共に負であるときも同様であ
る。これに対して、x及びγの一方がほぼ0であると
は、セミトレーラ(16)の左右方向左右車輪中心(24)が走
行ルート直線(20)上にあるか、セミトレーラ左右中心線
(23)が走行ルート直線(20)に平行になっているかという
ことであり、セミトレーラ(16)は走行ルート直線(20)に
十分に接近している。したがって、θは、x又はγと同
符号にするものの、その絶対値は、x及びγが共に正で
あるときよりも小さくする。
連結車両(10)の後進中、セミトレーラ(16)の後端が走行
ルート直線(20)より左にあり、かつセミトレーラ(16)の
後端が前端に対して斜め左後方へ向いているということ
である。セミトレーラ(16)のこの姿勢のまま後方へ推進
していけば、セミトレーラ(16)は走行ルート直線(20)か
らますます遠ざかってしまうので、θを大きくして、こ
れを回避する。x及びγが共に負であるときも同様であ
る。これに対して、x及びγの一方がほぼ0であると
は、セミトレーラ(16)の左右方向左右車輪中心(24)が走
行ルート直線(20)上にあるか、セミトレーラ左右中心線
(23)が走行ルート直線(20)に平行になっているかという
ことであり、セミトレーラ(16)は走行ルート直線(20)に
十分に接近している。したがって、θは、x又はγと同
符号にするものの、その絶対値は、x及びγが共に正で
あるときよりも小さくする。
【0012】この発明の自動走行式連結車両(10)によれ
ば、x及びγの両方が0の場合は、θの絶対値を0とす
る。
ば、x及びγの両方が0の場合は、θの絶対値を0とす
る。
【0013】x及びγの両方が0の場合とは、自動走行
車(11)の左右方向左右車輪中心(24)及びセミトレーラ(1
6)のセミトレーラ左右中心線(23)が共に走行ルート直線
(20)上にあることであるので、この場合は、θを0にし
て、自動走行車(11)及びセミトレーラ(16)の姿勢をこの
まま維持する。
車(11)の左右方向左右車輪中心(24)及びセミトレーラ(1
6)のセミトレーラ左右中心線(23)が共に走行ルート直線
(20)上にあることであるので、この場合は、θを0にし
て、自動走行車(11)及びセミトレーラ(16)の姿勢をこの
まま維持する。
【0014】
【発明の実施の形態】以下、発明の実施の形態について
図面を参照して説明する。図1は自動走行式連結車両10
の後進時の各記号の定義を示している。AGV(Aut
omatic Guided Vehicle)11は前
輪12及び後輪13を左右にもつ。前輪12及び後輪13は共に
操舵自在であり、前進時では、前輪12が操舵輪とされる
とともに、後輪13が直進固定され、また、後進時では、
前輪12が直進固定されるとともに、後輪13が操舵輪とさ
れる。自動走行式連結車両10は、前輪12及び後輪13の一
方のみが駆動輪である二輪駆動であっても、両方が駆動
輪である全輪駆動であってもよい。全輪駆動には、四輪
駆動だけでなく、AGV11が三輪タイプの場合の、三輪
駆動も含む。すなわち、駆動タイプは、1輪駆動以上全
輪駆動以下まで、何でもよい。セミトレーラ16は、前部
においてカプラを介してキングピン17の周りに回転自在
にAGV11の後部に支持、及び連結され、後部には左右
に車輪18を備えている。キングピン17はAGV左右中心
線22上でかつセミトレーラ左右中心線23上に存在する。
この自動走行式連結車両10では、キングピン17は、作用
説明の便宜のために、左右の後輪13の中心点を通る直線
上に位置している。キングピン17は、AGV11の前後方
向へ後輪13とは異なる位置、通常は後方側にあり、その
ような場合の図1の状態への換算方法は、図4で後述す
る。走行ルート線20には、磁石が連続して埋設されてお
り、AGV11は、走行中、その磁石に因る磁界から走行
ルート線20に対する左右方向偏倚を検出し、偏倚をなく
す方向へ操舵を行い、これにより、走行ルート線20に沿
う自動的な前進走行を実現する。図1では、走行ルート
線20は直線となっている。後述の後進制御は、このよう
な直線の走行ルート線20におけるものとなっている。左
右方向左右車輪中心24は、左右の車輪18の中心を結ぶ直
線ととしての左右車輪軸線25とセミトレーラ左右中心線
23との交点となる。
図面を参照して説明する。図1は自動走行式連結車両10
の後進時の各記号の定義を示している。AGV(Aut
omatic Guided Vehicle)11は前
輪12及び後輪13を左右にもつ。前輪12及び後輪13は共に
操舵自在であり、前進時では、前輪12が操舵輪とされる
とともに、後輪13が直進固定され、また、後進時では、
前輪12が直進固定されるとともに、後輪13が操舵輪とさ
れる。自動走行式連結車両10は、前輪12及び後輪13の一
方のみが駆動輪である二輪駆動であっても、両方が駆動
輪である全輪駆動であってもよい。全輪駆動には、四輪
駆動だけでなく、AGV11が三輪タイプの場合の、三輪
駆動も含む。すなわち、駆動タイプは、1輪駆動以上全
輪駆動以下まで、何でもよい。セミトレーラ16は、前部
においてカプラを介してキングピン17の周りに回転自在
にAGV11の後部に支持、及び連結され、後部には左右
に車輪18を備えている。キングピン17はAGV左右中心
線22上でかつセミトレーラ左右中心線23上に存在する。
この自動走行式連結車両10では、キングピン17は、作用
説明の便宜のために、左右の後輪13の中心点を通る直線
上に位置している。キングピン17は、AGV11の前後方
向へ後輪13とは異なる位置、通常は後方側にあり、その
ような場合の図1の状態への換算方法は、図4で後述す
る。走行ルート線20には、磁石が連続して埋設されてお
り、AGV11は、走行中、その磁石に因る磁界から走行
ルート線20に対する左右方向偏倚を検出し、偏倚をなく
す方向へ操舵を行い、これにより、走行ルート線20に沿
う自動的な前進走行を実現する。図1では、走行ルート
線20は直線となっている。後述の後進制御は、このよう
な直線の走行ルート線20におけるものとなっている。左
右方向左右車輪中心24は、左右の車輪18の中心を結ぶ直
線ととしての左右車輪軸線25とセミトレーラ左右中心線
23との交点となる。
【0015】図1の各記号の定義は次のとおりである。
なお、図1の上下左右をそれぞれ自動走行式連結車両10
の前後左右とする。 F:自動走行式連結車両10の後進時にキングピン17を介
してAGV11からセミトレーラ16へ作用する推進力の方
向 δ:走行ルート線20の後方へ向かって走行ルート線20に
対するAGV左右中心線22の角度。走行ルート線20に対
して左側を正とする。 α:AGV左右中心線22の後方へ向かってAGV左右中
心線22に対するFの角度。AGV左右中心線22の左側を
正とする。αは後輪13の操舵角に一致する。 γ:走行ルート線20の後方へ向かって走行ルート線20に
対するセミトレーラ左右中心線23の角度。走行ルート線
20の左側を正とする。 θ:=α+δ−γ x:走行ルート線20からの左右方向左右車輪中心24の偏
倚量。走行ルート線20の左側を正とする。 L:セミトレーラ左右中心線23上のキングピン17と左右
方向左右車輪中心24との距離
なお、図1の上下左右をそれぞれ自動走行式連結車両10
の前後左右とする。 F:自動走行式連結車両10の後進時にキングピン17を介
してAGV11からセミトレーラ16へ作用する推進力の方
向 δ:走行ルート線20の後方へ向かって走行ルート線20に
対するAGV左右中心線22の角度。走行ルート線20に対
して左側を正とする。 α:AGV左右中心線22の後方へ向かってAGV左右中
心線22に対するFの角度。AGV左右中心線22の左側を
正とする。αは後輪13の操舵角に一致する。 γ:走行ルート線20の後方へ向かって走行ルート線20に
対するセミトレーラ左右中心線23の角度。走行ルート線
20の左側を正とする。 θ:=α+δ−γ x:走行ルート線20からの左右方向左右車輪中心24の偏
倚量。走行ルート線20の左側を正とする。 L:セミトレーラ左右中心線23上のキングピン17と左右
方向左右車輪中心24との距離
【0016】図2は図1のδを求める説明図である。前
側磁気センサ列34及び後ろ側磁気センサ列35は、AGV
左右中心線22上に離れた2個所においてAGV11の左右
方向へ直線で延びている。前側磁気センサ列34及び後ろ
側磁気センサ列35には、磁気センサが等間隔で配列され
ており、各磁気センサは、走行ルート線20上の磁石から
の磁束を検出して、走行ルート線20に対して左側にある
か、右側にあるか、ほぼ真上にあるかを検出できる。各
前側磁気センサ列34及び後ろ側磁気センサ列35におい
て、走行ルート線20のほぼ真上にある磁気センサがどれ
かを検出することにより、その真上に位置する磁気セン
サから、すなわち走行ルート線20から各前側磁気センサ
列34及び後ろ側磁気センサ列35における左右中心までの
距離d1,d2を検出することができる。また、AGV
左右中心線22上の前側磁気センサ列34及び後ろ側磁気セ
ンサ列35の距離をwとし、走行ルート線20に対する左側
へのずれを正とすると、tanδ=(d2−d1)/w
となり、δを求めることができる。
側磁気センサ列34及び後ろ側磁気センサ列35は、AGV
左右中心線22上に離れた2個所においてAGV11の左右
方向へ直線で延びている。前側磁気センサ列34及び後ろ
側磁気センサ列35には、磁気センサが等間隔で配列され
ており、各磁気センサは、走行ルート線20上の磁石から
の磁束を検出して、走行ルート線20に対して左側にある
か、右側にあるか、ほぼ真上にあるかを検出できる。各
前側磁気センサ列34及び後ろ側磁気センサ列35におい
て、走行ルート線20のほぼ真上にある磁気センサがどれ
かを検出することにより、その真上に位置する磁気セン
サから、すなわち走行ルート線20から各前側磁気センサ
列34及び後ろ側磁気センサ列35における左右中心までの
距離d1,d2を検出することができる。また、AGV
左右中心線22上の前側磁気センサ列34及び後ろ側磁気セ
ンサ列35の距離をwとし、走行ルート線20に対する左側
へのずれを正とすると、tanδ=(d2−d1)/w
となり、δを求めることができる。
【0017】αは後輪13の操舵角から検出できる。γ
は、キングピン17におけるAGV左右中心線22とセミト
レーラ左右中心線23との相対回転角β(セミトレーラ左
右中心線23に対して左側を正とする。)を検出し、γ=
δ−βより求めることができる。xは、AGV11におい
て、走行ルート線20に対するキングピン17の横偏倚量d
3(走行ルート線20に対して左側を正とする。)を検出
し、x=d3+L・sinγから求めることができる。
なお、d3は、例えば、図2のように、後ろ側磁気セン
サ列35を、その中心がキングピン17の位置になるよう
に、配置し、d3=d2×cosδから導く。
は、キングピン17におけるAGV左右中心線22とセミト
レーラ左右中心線23との相対回転角β(セミトレーラ左
右中心線23に対して左側を正とする。)を検出し、γ=
δ−βより求めることができる。xは、AGV11におい
て、走行ルート線20に対するキングピン17の横偏倚量d
3(走行ルート線20に対して左側を正とする。)を検出
し、x=d3+L・sinγから求めることができる。
なお、d3は、例えば、図2のように、後ろ側磁気セン
サ列35を、その中心がキングピン17の位置になるよう
に、配置し、d3=d2×cosδから導く。
【0018】図3はx及びγに対するθの制御量を示し
ている。すなわち、自動走行式連結車両10の後進制御で
は、x及びγを検出し、検出したx及びγに対して、そ
れらに対応するθの制御量を図3の表から求め、その制
御量に現実のθがなるように、後輪13の操舵角を変更す
る。θは、x<0の場合は、γ<0,=ほぼ0、及び>
0に対してそれぞれ絶対値の大きい負の値、絶対値の小
さい負の値、及び0とされる。x=ほぼ0の場合は、γ
<0,=ほぼ0、及び>0に対してぞれぞれ絶対値の小
さい負の値、0、及び絶対値の小さい正の値とされる。
x>0の場合は、γ<0,=ほぼ0、及び>0に対して
ぞれぞれ0、小さい正の値、及び大きい正の値とされ
る。
ている。すなわち、自動走行式連結車両10の後進制御で
は、x及びγを検出し、検出したx及びγに対して、そ
れらに対応するθの制御量を図3の表から求め、その制
御量に現実のθがなるように、後輪13の操舵角を変更す
る。θは、x<0の場合は、γ<0,=ほぼ0、及び>
0に対してそれぞれ絶対値の大きい負の値、絶対値の小
さい負の値、及び0とされる。x=ほぼ0の場合は、γ
<0,=ほぼ0、及び>0に対してぞれぞれ絶対値の小
さい負の値、0、及び絶対値の小さい正の値とされる。
x>0の場合は、γ<0,=ほぼ0、及び>0に対して
ぞれぞれ0、小さい正の値、及び大きい正の値とされ
る。
【0019】こうして、走行ルート線20の直線部に沿っ
て自動走行式連結車両10を後進する場合は、xがほぼ0
でないときは、θがxと同符号となるように、後輪13の
操舵角が制御される。すなわちxが正のときは、セミト
レーラ16の後端が走行ルート線20に対して左側にあると
いうことであり、θを正にすることにより、セミトレー
ラ16は、Fにより前端を後端に対して左方へ相対移動さ
れ、セミトレーラ16の後端は左側から走行ルート線20の
方へ近づく。x>0で、γ>0のときは、セミトレーラ
16の後端が走行ルート線20に対して左側にあり、かつセ
ミトレーラ16の後端が前端に対して斜め左方へ向いてい
るということであり、すなわち、セミトレーラ16は、そ
のままの向きで後進を続けると、走行ルート線20からま
すます離れていってしまうので、θの絶対値を大きくな
るようにして、速やかにセミトレーラ16の後端が前端に
対して走行ルート線20の方へ向くようにする。x>0
で、γ=ほぼ0の場合は、セミトレーラ16の後端が走行
ルート線20に対して左側にあるが、セミトレーラ左右中
心線23が走行ルート線20に対して平行であるということ
であり、セミトレーラ16は、そのままの向きは維持しつ
つ、右の走行ルート線20の方へ寄せるのが好ましいの
で、θの絶対値が小さくなるように、後輪13の操舵角を
制御する。x>0で、γ<0の場合は、セミトレーラ16
の後端が走行ルート線20に対して左側にあるが、セミト
レーラ16の後端が前端に対して斜め右方へ向いていると
いうことであり、それ以上、右の方へ向けると、セミト
レーラ16は走行ルート線20を大きく越えてしまうので、
θを0にする。x<0の場合も同様である。
て自動走行式連結車両10を後進する場合は、xがほぼ0
でないときは、θがxと同符号となるように、後輪13の
操舵角が制御される。すなわちxが正のときは、セミト
レーラ16の後端が走行ルート線20に対して左側にあると
いうことであり、θを正にすることにより、セミトレー
ラ16は、Fにより前端を後端に対して左方へ相対移動さ
れ、セミトレーラ16の後端は左側から走行ルート線20の
方へ近づく。x>0で、γ>0のときは、セミトレーラ
16の後端が走行ルート線20に対して左側にあり、かつセ
ミトレーラ16の後端が前端に対して斜め左方へ向いてい
るということであり、すなわち、セミトレーラ16は、そ
のままの向きで後進を続けると、走行ルート線20からま
すます離れていってしまうので、θの絶対値を大きくな
るようにして、速やかにセミトレーラ16の後端が前端に
対して走行ルート線20の方へ向くようにする。x>0
で、γ=ほぼ0の場合は、セミトレーラ16の後端が走行
ルート線20に対して左側にあるが、セミトレーラ左右中
心線23が走行ルート線20に対して平行であるということ
であり、セミトレーラ16は、そのままの向きは維持しつ
つ、右の走行ルート線20の方へ寄せるのが好ましいの
で、θの絶対値が小さくなるように、後輪13の操舵角を
制御する。x>0で、γ<0の場合は、セミトレーラ16
の後端が走行ルート線20に対して左側にあるが、セミト
レーラ16の後端が前端に対して斜め右方へ向いていると
いうことであり、それ以上、右の方へ向けると、セミト
レーラ16は走行ルート線20を大きく越えてしまうので、
θを0にする。x<0の場合も同様である。
【0020】x=ほぼ0のときは、左右方向左右車輪中
心24が走行ルート線20上に位置しているということであ
り、θは絶対値の小さい値に設定し、かつθの符号はγ
の符号に一致させて、xが大きく変動しないようにしつ
つ、γを0へもって行くようにする。xがほぼ0で、か
つγもほぼ0であるときは、セミトレーラ16がそのセミ
トレーラ左右中心線23を走行ルート線20に重ねていると
いうことであり、その状態を維持するように、θは0と
される。
心24が走行ルート線20上に位置しているということであ
り、θは絶対値の小さい値に設定し、かつθの符号はγ
の符号に一致させて、xが大きく変動しないようにしつ
つ、γを0へもって行くようにする。xがほぼ0で、か
つγもほぼ0であるときは、セミトレーラ16がそのセミ
トレーラ左右中心線23を走行ルート線20に重ねていると
いうことであり、その状態を維持するように、θは0と
される。
【0021】図4はキングピン17がAGV11の前後方向
へ後輪31に対してずれている場合のαを演算する説明図
である。さらに、注釈すると、前輪12が直進固定である
ときに限定される。前輪12も操舵されるときは、前輪12
の向きの直角方位と、後輪13の直角方位との交点を改め
てo’として、図4相当の作図を作ってαを得る。AG
V11は通常前輪及び後輪を2個ずつの計4輪、装備する
が、図4では、説明の便宜上、前後1輪ずつの2輪モデ
ルとなっている。前輪及び後輪が左右対称に配置される
ときは、それらを前輪30及び後輪31に置き換えて、後進
時の状況を説明できる。各記号の定義は次のとおりであ
る。 o:AGV11の後進中の旋回中心 R:oから前輪30の中心までの距離 α’:AGV11の後進時の後輪31の操舵角 a:AGV左右中心線22上における前輪30と後輪31との
中心距離 b:AGV左右中心線22上における後輪31とキングピン
17との中心距離。後輪31の中心より後方を正にする。
へ後輪31に対してずれている場合のαを演算する説明図
である。さらに、注釈すると、前輪12が直進固定である
ときに限定される。前輪12も操舵されるときは、前輪12
の向きの直角方位と、後輪13の直角方位との交点を改め
てo’として、図4相当の作図を作ってαを得る。AG
V11は通常前輪及び後輪を2個ずつの計4輪、装備する
が、図4では、説明の便宜上、前後1輪ずつの2輪モデ
ルとなっている。前輪及び後輪が左右対称に配置される
ときは、それらを前輪30及び後輪31に置き換えて、後進
時の状況を説明できる。各記号の定義は次のとおりであ
る。 o:AGV11の後進中の旋回中心 R:oから前輪30の中心までの距離 α’:AGV11の後進時の後輪31の操舵角 a:AGV左右中心線22上における前輪30と後輪31との
中心距離 b:AGV左右中心線22上における後輪31とキングピン
17との中心距離。後輪31の中心より後方を正にする。
【0022】図5は図4の各記号間の関係式を示してい
る。前輪30の中心点とoと後輪31の中心点とを頂点とす
る三角形について、(1)式が成立する。(1)式から
(2)式が導かれる。一方、(3)式が成立する。(3)
式から(4)式が導かれれる。(2)式及び(4)式か
ら(5)式が導かれる。こうして、α’からαを求める
ことができる。
る。前輪30の中心点とoと後輪31の中心点とを頂点とす
る三角形について、(1)式が成立する。(1)式から
(2)式が導かれる。一方、(3)式が成立する。(3)
式から(4)式が導かれれる。(2)式及び(4)式か
ら(5)式が導かれる。こうして、α’からαを求める
ことができる。
【図面の簡単な説明】
【図1】自動走行式連結車両の後進時の各記号の定義を
示す図である。
示す図である。
【図2】図1のδを求める説明図である。
【図3】x及びγに対するθの制御量を示す図である。
【図4】キングピンがAGVの前後方向へ後輪に対して
ずれている場合のαを演算する説明図である。
ずれている場合のαを演算する説明図である。
【図5】図4の各記号間の関係式を示す図である。
【符号の説明】 10 自動走行式連結車両(自動走行式連結車両) 11 AGV(自動走行車) 12 前輪 13 後輪 16 セミトレーラ 17 キングピン(連結ピン) 20 走行ルート線(走行ルート直線) 22 AGV左右中心線(自動走行車左右中心線) 23 セミトレーラ左右中心線 24 左右方向左右車輪中心
Claims (4)
- 【請求項1】 自動走行車(11)が、連結ピン(17)を介し
て後ろ側にセミトレーラ(16)を連結されている自動走行
式連結車両(10)において、各記号を下記のように定義
し、 F:後進時の連結ピン(17)における自動走行車(11)から
セミトレーラ(16)への推進力の方向。 δ:後方へ向かって走行ルート直線(20)に対する自動走
行車左右中心線(22)の角度。ただし、走行ルート直線(2
0)に対して左右方向の一方の側を正とする。 α:後方へ向かって自動走行車左右中心線(22)に対する
Fの角度。ただし、自動走行車左右中心線(22)に対して
左右方向の一方の側を正とする。 γ:後方へ向かって走行ルート直線(20)に対するセミト
レーラ左右中心線(23)の角度。ただし、走行ルート直線
(20)に対して左右方向の一方の側を正とする。 θ:=α+δ−γ。 x:走行ルート直線(20)に対するセミトレーラ(16)のの
左右方向左右車輪中心(24)の偏倚量。ただし、走行ルー
ト直線(20)に対して左右方向の一方の側を正とする。 後進時では、後輪(13)を操舵自在とするとともに、θが
xと同符号になるように、自動走行車(11)の後輪(13)を
操舵することを特徴とする自動走行式連結車両。 - 【請求項2】 xがほぼ0の場合は、θがγと同符号に
なるように、前記自動走行車(11)の後輪(13)を操舵する
ことを特徴とする請求項1記載の自動走行式連結車両。 - 【請求項3】 θの絶対値を、x及びγの符号が同一の
場合は、x及びγの一方がほぼ0の場合よりも、大きい
値に設定することを特徴とする請求項1又は2記載の自
動走行式連結車両。 - 【請求項4】 x及びγの両方が0の場合は、θの絶対
値を0とすることを特徴とする請求項1〜3のいずれか
に記載の自動走行式連結車両。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP10160324A JP2956012B1 (ja) | 1998-06-09 | 1998-06-09 | 自動走行式連結車両 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP10160324A JP2956012B1 (ja) | 1998-06-09 | 1998-06-09 | 自動走行式連結車両 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2956012B1 JP2956012B1 (ja) | 1999-10-04 |
JPH11353024A true JPH11353024A (ja) | 1999-12-24 |
Family
ID=15712508
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP10160324A Expired - Fee Related JP2956012B1 (ja) | 1998-06-09 | 1998-06-09 | 自動走行式連結車両 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP2956012B1 (ja) |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2012122250A (ja) * | 2010-12-08 | 2012-06-28 | Ihi Transport Machinery Co Ltd | 車両移動装置の運転方法 |
JP2017228198A (ja) * | 2016-06-24 | 2017-12-28 | 株式会社Ihiエアロスペース | 半自動トレーラとコンテナターミナルシステム |
JP2018188299A (ja) * | 2017-05-12 | 2018-11-29 | 株式会社Ihiエアロスペース | コンテナターミナルシステムとその制御方法 |
CN110901630A (zh) * | 2019-11-26 | 2020-03-24 | 东风商用车有限公司 | 一种半挂汽车列车横向稳定性控制方法及*** |
JP2022553418A (ja) * | 2019-10-25 | 2022-12-22 | コンチネンタル オートノマス モビリティ ユーエス,エルエルシー | トレーラの直線後退中のずれを安定化するためのシステムおよび車両のための方法ならびトレーラ後退支援システム |
WO2023180476A1 (en) * | 2022-03-23 | 2023-09-28 | X-Drive Robots Aps | An autonomous driving system for navigating a tool-carrying trailer |
-
1998
- 1998-06-09 JP JP10160324A patent/JP2956012B1/ja not_active Expired - Fee Related
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2012122250A (ja) * | 2010-12-08 | 2012-06-28 | Ihi Transport Machinery Co Ltd | 車両移動装置の運転方法 |
JP2017228198A (ja) * | 2016-06-24 | 2017-12-28 | 株式会社Ihiエアロスペース | 半自動トレーラとコンテナターミナルシステム |
JP2018188299A (ja) * | 2017-05-12 | 2018-11-29 | 株式会社Ihiエアロスペース | コンテナターミナルシステムとその制御方法 |
JP2022553418A (ja) * | 2019-10-25 | 2022-12-22 | コンチネンタル オートノマス モビリティ ユーエス,エルエルシー | トレーラの直線後退中のずれを安定化するためのシステムおよび車両のための方法ならびトレーラ後退支援システム |
CN110901630A (zh) * | 2019-11-26 | 2020-03-24 | 东风商用车有限公司 | 一种半挂汽车列车横向稳定性控制方法及*** |
WO2023180476A1 (en) * | 2022-03-23 | 2023-09-28 | X-Drive Robots Aps | An autonomous driving system for navigating a tool-carrying trailer |
Also Published As
Publication number | Publication date |
---|---|
JP2956012B1 (ja) | 1999-10-04 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP2985774B2 (ja) | 連結車両の操舵装置 | |
US8469125B2 (en) | System and method for controlling a trailer connected to a vehicle | |
JP2003034261A (ja) | 連結車両の後退制御装置及びその後退制御方法 | |
US20070152424A1 (en) | Vehicle-trailer low-speed offtracking control | |
Singh et al. | Study of 4 wheel steering systems to reduce turning radius and increase stability | |
Sundar et al. | Review of Design and Fabrication of four wheel Steering system | |
JP2956012B1 (ja) | 自動走行式連結車両 | |
CN102470892A (zh) | 电动汽车的车辆构造 | |
JP3334513B2 (ja) | 牽引車両の後輪操舵制御方法および四輪操舵機構 | |
WO2022270322A1 (ja) | 連結車両の後退制御装置、連結車両の後退制御プログラムを記憶したコンピュータ可読媒体、および連結車両の後退制御方法 | |
JPS5926366A (ja) | 車両の操舵装置 | |
JP2007161148A (ja) | 連結車両における後方車両の駆動制御装置 | |
JPH11240461A (ja) | トレーラの操縦装置 | |
Tirumala et al. | Analysis of a four-wheeled steering mechanism for automobiles | |
JP2515731Y2 (ja) | ステアブルトレーラ | |
JPH10157652A (ja) | トレーラの操縦装置 | |
JPH0728046Y2 (ja) | 列車式搬送車 | |
JP3306353B2 (ja) | リーチ型フォークリフト | |
JPH05278418A (ja) | 牽引車と被牽引車の連結装置 | |
JPH0769742B2 (ja) | 無人搬送車 | |
JPH05333928A (ja) | 無人搬送車の後進走行制御方法 | |
JP3166418B2 (ja) | 無人搬送車の操舵制御方法 | |
Spark et al. | Integrated mechatronics solution to maximise tractability and efficiency of wheeled vehicles | |
KR102620426B1 (ko) | 조향 장치 | |
JPH0891238A (ja) | 後輪操舵装置の制御方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20080723 Year of fee payment: 9 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20090723 Year of fee payment: 10 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20090723 Year of fee payment: 10 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20100723 Year of fee payment: 11 |
|
LAPS | Cancellation because of no payment of annual fees |