JP2003344226A - Device, method and program for outputting locus, and recording medium - Google Patents

Device, method and program for outputting locus, and recording medium

Info

Publication number
JP2003344226A
JP2003344226A JP2002148095A JP2002148095A JP2003344226A JP 2003344226 A JP2003344226 A JP 2003344226A JP 2002148095 A JP2002148095 A JP 2002148095A JP 2002148095 A JP2002148095 A JP 2002148095A JP 2003344226 A JP2003344226 A JP 2003344226A
Authority
JP
Japan
Prior art keywords
vehicle
steering
pattern
change pattern
trajectory
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
Application number
JP2002148095A
Other languages
Japanese (ja)
Other versions
JP3906109B2 (en
Inventor
Kenji Asada
謙二 浅田
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Tokyu Car Corp
Original Assignee
Tokyu Car Corp
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Tokyu Car Corp filed Critical Tokyu Car Corp
Priority to JP2002148095A priority Critical patent/JP3906109B2/en
Publication of JP2003344226A publication Critical patent/JP2003344226A/en
Application granted granted Critical
Publication of JP3906109B2 publication Critical patent/JP3906109B2/en
Anticipated expiration legal-status Critical
Expired - Fee Related legal-status Critical Current

Links

Abstract

<P>PROBLEM TO BE SOLVED: To provide information as to the propriety of turning for a combination vehicle including a tractor having a steering wheel, and a following vehicle having a steering wheel and towed by the tractor. <P>SOLUTION: This locus output device is provided with a tractor steering pattern storage means 4 for storing a change pattern of a steering quantity of the tractor, a following vehicle steering pattern storage means 6 for storing a change pattern of a steering quantity of the following vehicle, a locus acquiring means 18 for obtaining a locus of the combination vehicle when the combination vehicle travels while the steering wheels of the tractor and the following vehicle are steered in response to the change patterns stored in the tractor steering pattern storage means 4 and the following vehicle steering pattern storage means 6, and an output means 20 for outputting the locus. The locus of the combination vehicle is thereby acquired and output when an imaginary combination vehicle including the following vehicle having the steering wheel travels within a virtual area while the steering wheels of the tractor and the following vehicle are steered respectively at prescribed steering level of change patterns. <P>COPYRIGHT: (C)2004,JPO

Description

【発明の詳細な説明】Detailed Description of the Invention

【0001】[0001]

【発明の属する技術分野】本発明は、操舵輪を有する牽
引車と、操舵輪を有し前記牽引車に牽引される追従車と
を含む連結車両が走行する際の旋回可否に関する情報を
提供するための軌跡出力装置、軌跡出力方法、軌跡出力
プログラム及び記憶媒体に関する。
BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention provides information on the propriety of turning when a connected vehicle including a towing vehicle having steered wheels and a follower vehicle having steered wheels towed by the tow vehicle travels. And a trajectory output method, a trajectory output program, and a storage medium.

【0002】[0002]

【従来の技術】従来より、例えば、特開平11−211
626号公報に開示されているように、コンピュータ上
で、操舵輪のないセミトレーラ等を所定の条件の下でト
ラクタにより牽引走行させる際の走行軌跡を、クロソイ
ド曲線等により取得しディスプレイ等に表示する軌跡出
力装置が知られている。
2. Description of the Related Art Conventionally, for example, Japanese Unexamined Patent Application Publication No. 11-212
As disclosed in Japanese Laid-Open Patent Publication No. 626, on a computer, a travel locus when a semi-trailer without steered wheels is towed by a tractor under predetermined conditions is acquired by a clothoid curve or the like and displayed on a display or the like. A trajectory output device is known.

【0003】[0003]

【発明が解決しようとする課題】近年、長大な物体を輸
送すべく、操舵輪を一つ以上有する長尺な追従車をトラ
クタ等の牽引車が牽引する場合や、さらには、操舵輪を
有する複数の追従車を牽引車が牽引する例が増えてい
る。このような操舵輪付きの追従車を含む連結車両が旋
回する際の走行軌跡は、牽引車の操舵だけでなく追従車
の操舵によっても影響を受けて複雑なものとなり、実走
行前の旋回可否の検討が欠かせないものとなる。しかし
ながら、上述のような軌跡出力装置では、操舵輪を有す
る追従車の旋回可否の検討は困難であった。
In recent years, a long trailing vehicle having one or more steered wheels is towed by a towing vehicle such as a tractor in order to transport a long object, and further, a steered wheel is provided. The number of cases where a towing vehicle pulls multiple following vehicles is increasing. The traveling path when a connected vehicle including a follower vehicle with steered wheels makes a turn and is complicated not only by the steering of the towing vehicle but also by the steering of the follower vehicle. Will be essential. However, with the trajectory output device as described above, it is difficult to examine whether or not the following vehicle having steered wheels can turn.

【0004】本発明は、上記課題に鑑みてなされたもの
であり、操舵輪を有する牽引車と、操舵輪を有し前記牽
引車に牽引される追従車とを含む連結車両の旋回可否に
関する情報の提供を可能とする軌跡出力装置を提供する
ことを目的とする。
The present invention has been made in view of the above problems, and is information on whether or not a connected vehicle including a towing vehicle having steered wheels and a follower vehicle having the steered wheels towed by the towing vehicle can turn. It is an object of the present invention to provide a trajectory output device that enables the provision of

【0005】[0005]

【課題を解決するための手段】本発明に係る軌跡出力装
置は、仮想領域内で、操舵輪を有する牽引車と操舵輪を
有し牽引車に牽引される追従車とを含む仮想の連結車両
を走行させる際の軌跡を取得し出力装置に出力する軌跡
出力装置であって、走行の際に牽引車の操舵輪及び追従
車の操舵輪は、各々に対して定められた操舵量の変化パ
ターンに応じて各々操舵されるものとされ、牽引車の操
舵輪を操舵させるべき操舵量の変化パターンが格納され
る牽引車操舵パターン格納手段と、牽引車操舵パターン
格納手段に牽引車の操舵量の変化パターンを入力する牽
引車操舵パターン入力手段と、追従車の操舵輪を操舵さ
せるべき操舵量の変化パターンが格納される追従車操舵
パターン格納手段と、追従車操舵パターン格納手段に追
従車の操舵量の変化パターンを入力する追従車操舵パタ
ーン入力手段と、牽引車の操舵輪が牽引車操舵パターン
格納手段に格納された操舵量の変化パターンに応じて操
舵され、追従車の操舵輪が追従車操舵パターン格納手段
に格納された操舵量の変化パターンに応じて操舵され
て、連結車両が走行する際の連結車両の軌跡を取得する
軌跡取得手段と、軌跡を出力装置に出力させる出力手段
と、を備えることを特徴とする。
A locus output device according to the present invention is a virtual connected vehicle including a towing vehicle having steered wheels and a follower vehicle having the steered wheels and being pulled by the tow vehicle in a virtual region. A trajectory output device that acquires a trajectory when the vehicle is traveling and outputs the trajectory to an output device. The steering wheel of the towing vehicle and the steering wheel of the following vehicle during traveling are the variation patterns of the steering amount determined for each. The traction vehicle steering pattern storage means stores a change pattern of the steering amount for steering the steered wheels of the traction vehicle, and the traction vehicle steering pattern storage means stores the steering amount of the traction vehicle. A towing vehicle steering pattern input means for inputting a change pattern, a follower vehicle steering pattern storage means for storing a change pattern of a steering amount for steering the steered wheels of a follower vehicle, and a follower vehicle steering for the follower vehicle steering pattern storage means. Change in quantity The following vehicle steering pattern input means for inputting a pattern and the steered wheels of the towing vehicle are steered according to the change pattern of the steering amount stored in the towing vehicle steering pattern storage means, and the steered wheels of the following vehicle are stored as the following vehicle steering pattern. A trajectory acquisition means for acquiring the trajectory of the connected vehicle when the combined vehicle is traveling by being steered according to the change pattern of the steering amount stored in the means; and an output means for outputting the trajectory to an output device. Is characterized by.

【0006】本発明に係る軌跡出力方法は、仮想領域内
で、操舵輪を有する牽引車と操舵輪を有し牽引車に牽引
される追従車とを含む仮想の連結車両を走行させる際の
軌跡を取得し出力装置に出力する軌跡出力方法であっ
て、走行の際に牽引車の操舵輪及び追従車の操舵輪は、
各々に対して定められた操舵量の変化パターンに応じて
各々操舵されるものとされ、牽引車の操舵輪を操舵させ
るべき操舵量の変化パターンを入力する牽引車操舵パタ
ーン入力ステップと、追従車の操舵輪を操舵させるべき
操舵量の変化パターンを入力する追従車操舵パターン入
力ステップと、牽引車の操舵輪が牽引車の操舵量の変化
パターンに応じて操舵され、追従車の操舵輪が追従車の
操舵量の変化パターンに応じて操舵されて、連結車両が
走行する際の連結車両の軌跡を取得する軌跡取得ステッ
プと、軌跡を出力装置に出力させる軌跡出力ステップ
と、を含むことを特徴とする。
A trajectory output method according to the present invention is a trajectory when a virtual connected vehicle including a towing vehicle having steered wheels and a following vehicle towed by the towing vehicle having steered wheels is run in a virtual region. Is a trajectory output method for acquiring and outputting to the output device, the steering wheel of the towing vehicle and the steering wheel of the following vehicle during traveling are:
A steering vehicle steering pattern input step for inputting a steering amount change pattern for steering the steered wheels of the towing vehicle, and a following vehicle Of the following vehicle steering pattern input step for inputting the change pattern of the steering amount to steer the steering wheel of the vehicle, the steered wheel of the towing vehicle is steered according to the change pattern of the steering amount of the towing vehicle, and the steered wheel of the following vehicle follows. A trajectory acquisition step of acquiring a trajectory of the connected vehicle when the connected vehicle is driven by being steered according to a change pattern of a steering amount of the vehicle, and a trajectory output step of causing the output device to output the trajectory. And

【0007】本発明に係る軌跡出力プログラムは、仮想
領域内で、操舵輪を有する牽引車と操舵輪を有し牽引車
に牽引される追従車とを含む仮想の連結車両を走行させ
る際の軌跡を取得し出力装置に出力する軌跡出力方法で
あって、走行の際に牽引車の操舵輪及び追従車の操舵輪
は、各々に対して定められた操舵量の変化パターンに応
じて各々操舵されるものとされ、コンピュータに、牽引
車の操舵輪を操舵させるべき操舵量の変化パターンを入
力する牽引車操舵パターン入力ステップと、追従車の操
舵輪を操舵させるべき操舵量の変化パターンを入力する
追従車操舵パターン入力ステップと、牽引車の操舵輪が
牽引車の操舵量の変化パターンに応じて操舵され、追従
車の操舵輪が追従車の操舵量の変化パターンに応じて操
舵されて、連結車両が走行する際の連結車両の軌跡を取
得する軌跡取得ステップと、軌跡を出力装置に出力させ
る軌跡出力ステップと、を実行させることを特徴とす
る。
The trajectory output program according to the present invention is a trajectory when a virtual connected vehicle including a towing vehicle having steered wheels and a follower vehicle having the steered wheels and being driven by the towing vehicle is run in a virtual region. Is obtained and output to the output device, the steered wheels of the towing vehicle and the steered wheels of the following vehicle are steered according to the change pattern of the steering amount set for each during traveling. The steering wheel steering pattern input step of inputting a change pattern of the steering amount to steer the steered wheels of the towing vehicle and the change pattern of the steering amount to steer the steered wheels of the following vehicle are input to the computer. The step of inputting the following vehicle steering pattern, the steered wheels of the towing vehicle are steered according to the change pattern of the steering amount of the towing vehicle, and the steered wheels of the following vehicle are steered according to the change pattern of the steering amount of the following vehicle, and are connected. car There wherein the executing a track acquiring step of acquiring the trajectory of the articulated vehicle when traveling, the locus output step of outputting to an output device locus, the.

【0008】本発明の軌跡出力装置、軌跡出力方法、軌
跡出力プログラムによれば、仮想領域内で、操舵輪を有
する追従車を含む仮想の連結車両が、牽引車及び追従車
の操舵輪が所定の操舵量の変化パターンで各々操舵され
て走行する際の連結車両の軌跡が取得され出力される。
これにより、ユーザ等が、操舵輪を有する追従車を含む
実際の連結車両に対応する条件を入力することにより、
実際の連結車両が走行する際の軌跡を取得でき、当該連
結車両の旋回可否の判断等が好適に行える。
According to the trajectory output device, the trajectory output method, and the trajectory output program of the present invention, the virtual connected vehicle including the follower vehicle having the steered wheels and the steered wheels of the towing vehicle and the follower vehicle are predetermined in the virtual region. The trajectories of the connected vehicles as they are steered and traveled according to the change pattern of the steering amount are acquired and output.
This allows the user or the like to input conditions corresponding to an actual connected vehicle including a follower vehicle having steered wheels,
It is possible to acquire the trajectory when the actual connected vehicle travels, and it is possible to suitably determine whether or not the connected vehicle can turn.

【0009】ここで、上記軌跡出力装置において、追従
車の操舵量の変化パターンに対する修正要求を入力する
追従車操舵パターン修正要求入力手段と、追従車の操舵
量の変化パターンに対する修正要求に応じて追従車操舵
パターン格納手段に格納された操舵量の変化パターンを
修正する追従車操舵パターン修正手段と、を備えること
が好ましい。
In the trajectory output device, the following vehicle steering pattern correction request input means for inputting a correction request for the change pattern of the steering amount of the following vehicle and the correction request for the change pattern of the steering amount of the following vehicle. Preferably, the following vehicle steering pattern correction means for correcting the change pattern of the steering amount stored in the following vehicle steering pattern storage means.

【0010】ここで、上記軌跡出力方法において、追従
車の操舵量の変化パターンに対する修正要求を入力する
追従車操舵パターン修正要求入力ステップと、追従車の
操舵量の変化パターンに対する修正要求に応じて追従車
の操舵量の変化パターンを修正する追従車操舵パターン
修正ステップと、を含むことが好ましい。
In the trajectory output method, the following vehicle steering pattern modification request input step for inputting a modification request for the variation pattern of the steering amount of the following vehicle and the modification request for the variation pattern of the steering amount of the following vehicle. Preferably, the following vehicle steering pattern correction step of correcting the change pattern of the steering amount of the following vehicle.

【0011】ここで、上記軌跡出力プログラムにおい
て、追従車の操舵量の変化パターンに対する修正要求を
入力する追従車操舵パターン修正要求入力ステップと、
追従車の操舵量の変化パターンに対する修正要求に応じ
て追従車の操舵量の変化パターンを修正する追従車操舵
パターン修正ステップと、をコンピュータに実行させる
ことが好ましい。
Here, in the above trajectory output program, a following vehicle steering pattern correction request input step for inputting a correction request for the change pattern of the steering amount of the following vehicle,
It is preferable that the computer perform a following vehicle steering pattern correction step of correcting the variation pattern of the steering amount of the following vehicle in response to a correction request for the variation pattern of the steering amount of the following vehicle.

【0012】これらによれば、軌跡の出力結果に応じ
て、ユーザが、追従車の操舵量の変化パターンの修正要
求を入力すると、操舵させるべき操舵量の変化パターン
が修正され、修正された追従車の操舵量の変化パターン
に基づく連結車両の軌跡が再計算され出力される。これ
により、追従車の操舵量の変化パターンを変化させたと
きの連結車両、特に、追従車の軌跡の変化が容易に確認
され、連結車両の軌跡を所望の道路領域内に収めるため
に必要な、追従車の最適な操舵条件を容易に取得でき
る。
According to these, when the user inputs a correction request for the change pattern of the steering amount of the following vehicle in accordance with the output result of the locus, the change pattern of the steering amount to be steered is corrected, and the corrected follow amount is corrected. The trajectory of the connected vehicle based on the change pattern of the steering amount of the vehicle is recalculated and output. As a result, it is possible to easily confirm the change in the trajectory of the connected vehicle, particularly the change of the following vehicle when the change pattern of the steering amount of the following vehicle is changed, and it is necessary to keep the trajectory of the connected vehicle within the desired road area. The optimum steering condition of the following vehicle can be easily acquired.

【0013】また、上記軌跡出力装置において、追従車
の操舵量の変化パターンは、追従車の操舵輪の舵角の時
間変化パターンであり、追従車操舵パターン修正手段
は、修正要求に応じて、舵角が時間に応じて線形に変化
する区間を複数組み合わせたように時間変化パターンを
修正することが好ましい。
Further, in the above trajectory output device, the change pattern of the steering amount of the following vehicle is a time change pattern of the steering angle of the steered wheels of the following vehicle, and the following vehicle steering pattern correction means responds to the correction request. It is preferable to correct the time change pattern so that a plurality of sections in which the steering angle changes linearly with time are combined.

【0014】また、上記軌跡出力装置において、追従車
の操舵量の変化パターンは、追従車の操舵輪の舵角の走
行距離に対する変化パターンであり、追従車操舵パター
ン修正手段は、修正要求に応じて、舵角が走行距離に応
じて線形に変化する区間を複数組み合わせたように変化
パターンを修正してもよい。
In the trajectory output device, the change pattern of the steering amount of the following vehicle is a change pattern of the steering angle of the steered wheels of the following vehicle with respect to the travel distance, and the following vehicle steering pattern correction means responds to the correction request. Then, the change pattern may be corrected so that a plurality of sections in which the steering angle linearly changes according to the traveling distance are combined.

【0015】また、上記軌跡出力方法において、追従車
の操舵量の変化パターンは、追従車の操舵輪の舵角の時
間変化パターンであり、追従車操舵パターン修正ステッ
プは、修正要求に応じて、舵角が時間に応じて線形に変
化する区間を複数組み合わせたように時間変化パターン
を修正することが好ましい。
In the above trajectory output method, the change pattern of the steering amount of the follower vehicle is a time change pattern of the steering angle of the steered wheels of the follower vehicle, and the follower vehicle steering pattern correction step responds to the correction request. It is preferable to correct the time change pattern so that a plurality of sections in which the steering angle changes linearly with time are combined.

【0016】また、上記軌跡出力方法において、追従車
の操舵量の変化パターンは、追従車の操舵輪の舵角の走
行距離に対する変化パターンであり、追従車操舵パター
ン修正ステップは、修正要求に応じて、舵角が走行距離
に応じて線形に変化する区間を複数組み合わせたように
変化パターンを修正してもよい。
In the above trajectory output method, the change pattern of the steering amount of the following vehicle is a change pattern of the steering angle of the steered wheels of the following vehicle with respect to the traveling distance, and the following vehicle steering pattern correction step responds to the correction request. Then, the change pattern may be corrected so that a plurality of sections in which the steering angle linearly changes according to the traveling distance are combined.

【0017】また、上記軌跡出力プログラムにおいて、
追従車の操舵量の変化パターンは、追従車の操舵輪の舵
角の時間変化パターンであり、追従車操舵パターン修正
ステップは、修正要求に応じて、舵角が時間に応じて線
形に変化する区間を複数組み合わせたように時間変化パ
ターンを修正することが好ましい。
In the trajectory output program,
The change pattern of the steering amount of the following vehicle is a time change pattern of the steering angle of the steered wheels of the following vehicle, and the following vehicle steering pattern correction step changes the steering angle linearly with time in response to a correction request. It is preferable to correct the time change pattern so that a plurality of sections are combined.

【0018】また、上記軌跡出力プログラムにおいて、
追従車の操舵量の変化パターンは、追従車の操舵輪の舵
角の走行距離に対する変化パターンであり、追従車操舵
パターン修正ステップは、修正要求に応じて、舵角が走
行距離に応じて線形に変化する区間を複数組み合わせた
ように変化パターンを修正してもよい。
In the above trajectory output program,
The change pattern of the steering amount of the following vehicle is a change pattern of the steering angle of the steered wheels of the following vehicle with respect to the traveling distance, and the following vehicle steering pattern correction step is such that the steering angle changes linearly according to the traveling distance according to the correction request. The change pattern may be modified so as to combine a plurality of sections that change.

【0019】これらによれば、追従車の舵角を時間又は
走行距離に対して線形に変化させる区間を複数組み合わ
せた変化パターンで追従車を操舵した場合の連結車両の
軌跡が取得される。実際の連結車両において追従車の舵
角を変化させる場合には、舵角を時間や距離の線分等と
して変化させる場合が多い。上記構成によれば、時間や
距離に対して複雑な関数となるように舵角を変化させる
場合に比して、実際の追従車の舵角の操舵方法を定める
のに適したデータが得られる。
According to these, the trajectory of the connected vehicle when the follower vehicle is steered in a change pattern in which a plurality of sections in which the steering angle of the follower vehicle is changed linearly with respect to time or traveling distance is combined is acquired. When changing the rudder angle of the following vehicle in an actual connected vehicle, the rudder angle is often changed as a time or distance line segment. According to the above configuration, data suitable for determining the steering method of the actual steering angle of the following vehicle can be obtained as compared with the case where the steering angle is changed so as to have a complicated function with respect to time and distance. .

【0020】また、上記軌跡出力装置において、牽引車
の操舵量の変化パターンに対する修正要求を入力する牽
引車操舵パターン修正要求入力手段と、牽引車の操舵量
の変化パターンに対する修正要求に応じて牽引車操舵パ
ターン格納手段に格納された操舵量の変化パターンを修
正する牽引車操舵パターン修正手段と、を備えることが
好ましい。
In the above trajectory output device, the towing vehicle steering pattern correction request input means for inputting a correction request for the steering wheel change pattern of the towing vehicle and the towing in response to the correction request for the towing vehicle steering pattern change pattern. It is preferable to include a towing vehicle steering pattern correction unit that corrects the change pattern of the steering amount stored in the vehicle steering pattern storage unit.

【0021】また、上記軌跡出力方法において、牽引車
の操舵量の変化パターンに対する修正要求を入力する牽
引車操舵パターン修正要求入力ステップと、牽引車の操
舵量の変化パターンに対する修正要求に応じて牽引車の
操舵量の変化パターンを修正する牽引車操舵パターン修
正ステップと、を含むことが好ましい。
In the above trajectory output method, the towing vehicle steering pattern correction request input step for inputting a correction request for the steering wheel change pattern of the towing vehicle and the towing in response to the correction request for the towing vehicle steering pattern change pattern. It is preferable to include a towing vehicle steering pattern correction step of correcting a change pattern of the steering amount of the vehicle.

【0022】また、上記軌跡出力プログラムにおいて、
牽引車の操舵量の変化パターンに対する修正要求を入力
する牽引車操舵パターン修正要求入力ステップと、牽引
車の操舵量の変化パターンに対する修正要求に応じて牽
引車の操舵量の変化パターンを修正する牽引車操舵パタ
ーン修正ステップと、をコンピュータに実行させること
が好ましい。
In the above trajectory output program,
A towing vehicle steering pattern correction request input step for inputting a correction request for the change pattern of the steering amount of the towing vehicle, and a towing for correcting the change pattern of the steering amount of the towing vehicle according to the correction request for the changing pattern of the steering amount of the towing vehicle. It is preferable that the computer performs the vehicle steering pattern correction step.

【0023】これらによれば、軌跡の出力結果に応じ
て、ユーザが、牽引車の操舵量の変化パターンの修正要
求を入力すると、牽引車操舵パターン格納手段に格納さ
れた操舵量の変化パターンが修正され、修正された牽引
車の操舵量の変化パターンに基づく連結車両の軌跡が再
計算され出力される。これにより、牽引車の操舵量の変
化パターンを変化させたときの連結車両、特に、牽引車
の軌跡の変化が容易に確認され、連結車両の軌跡を所望
の道路領域内に収めるために必要な、牽引車の最適な操
舵条件を容易に取得できる。
According to these, when the user inputs a correction request for the change pattern of the steering amount of the towing vehicle in accordance with the output result of the locus, the change pattern of the steering amount stored in the towing vehicle steering pattern storage means is obtained. The trajectory of the connected vehicle is recalculated and output based on the modified change pattern of the steering amount of the towing vehicle. As a result, it is possible to easily confirm the change of the trajectory of the connected vehicle, particularly, the trajectory of the tow vehicle when the change pattern of the steering amount of the tow vehicle is changed, and it is necessary to keep the trajectory of the connected vehicle within the desired road area. The optimum steering conditions for the towing vehicle can be easily obtained.

【0024】また、上記軌跡出力装置において、追従車
操舵パターン入力手段は、追従車を牽引車に追従して走
行させるために必要な暫定的な追従車の操舵量の変化パ
ターンを生成し追従車操舵パターン格納手段に入力する
基準追従車操舵パターン生成手段を備えることが好まし
い。
Further, in the above trajectory output device, the following vehicle steering pattern input means generates a temporary change pattern of the steering amount of the following vehicle necessary for causing the following vehicle to travel following the towing vehicle to generate the following vehicle. It is preferable to include a reference following vehicle steering pattern generation means for inputting to the steering pattern storage means.

【0025】また、上記軌跡出力方法において、追従車
操舵パターン入力ステップにおいて、追従車を牽引車に
追従して走行させるために必要な暫定的な追従車の操舵
量の変化パターンを生成し追従車を操舵させるべき操舵
量の変化パターンとする基準追従車操舵パターン生成ス
テップを含むことが好ましい。
Further, in the above trajectory output method, in the following vehicle steering pattern input step, a temporary change pattern of the steering amount of the following vehicle required for causing the following vehicle to follow the towing vehicle is generated to generate the following vehicle. It is preferable to include a reference follower vehicle steering pattern generation step that is a change pattern of the steering amount for steering.

【0026】また、上記軌跡出力プログラムにおいて、
追従車操舵パターン入力ステップにおいて、追従車を牽
引車に追従して走行させるために必要な暫定的な追従車
の操舵量の変化パターンを生成し追従車を操舵させるべ
き操舵量の変化パターンとする基準追従車操舵パターン
生成ステップを含むことが好ましい。
In the trajectory output program,
In the step of inputting the following vehicle steering pattern, a temporary change pattern of the steering amount of the following vehicle required for the following vehicle to travel following the towing vehicle is generated and used as the change pattern of the steering amount for steering the following vehicle. It is preferable to include a reference following vehicle steering pattern generation step.

【0027】操舵輪を有する追従車は、車種等によって
は操舵量の変化パターンを与えないと旋回しにくい場合
がある。このような場合、連結車両の軌跡を取得するた
めには、少なくとも追従車に対して、牽引車に追従して
走行するような操舵量の変化パターンを与える必要があ
る。ところが、上記構成によれば、追従車を牽引車に追
従させるために必要な追従車の操舵量の変化パターンが
取得されるので、追従車の操舵量の変化パターンをユー
ザ等が入力しなくても、牽引車に追従して追従車が走行
する暫定的な連結車両の旋回軌跡を取得し入力すること
ができる。これにより、ユーザ等が牽引車の操舵量の変
化パターンに応じた追従車の操舵量の変化パターンを入
力する手間が省かれる。また、取得された連結車両の軌
跡に基づいて、ユーザ等が、このようにして得られた追
従車の操舵量の変化パターンを修正すれば、所望の軌跡
を走行させるための追従車の操舵量の変化パターンが容
易に求められる。
A follower vehicle having steered wheels may not easily turn unless a change pattern of the steering amount is given depending on the vehicle type and the like. In such a case, in order to acquire the trajectory of the connected vehicle, it is necessary to provide at least the following vehicle with a change pattern of the steering amount that allows the vehicle to follow the towing vehicle. However, according to the above configuration, since the change pattern of the steering amount of the following vehicle necessary for causing the following vehicle to follow the towing vehicle is acquired, the user or the like does not need to input the change pattern of the steering amount of the following vehicle. Also, it is possible to acquire and input the temporary turning trajectory of the connected vehicle in which the following vehicle travels following the towing vehicle. This saves the user the trouble of inputting the change pattern of the steering amount of the following vehicle according to the change pattern of the steering amount of the towing vehicle. Further, if the user or the like corrects the change pattern of the steering amount of the following vehicle obtained in this way based on the acquired trajectory of the connected vehicle, the steering amount of the following vehicle for traveling along the desired trajectory can be obtained. Change pattern is easily obtained.

【0028】また、上記軌跡出力装置において、軌跡取
得手段は、コーナリングフォースを考慮した運動方程式
に基づいて軌跡を取得することが好ましい。
Further, in the above trajectory output device, it is preferable that the trajectory acquisition means acquires the trajectory based on the equation of motion considering the cornering force.

【0029】また、上記軌跡出力方法において、軌跡取
得ステップは、コーナリングフォースを考慮した運動方
程式に基づいて軌跡を取得することが好ましい。
In the above trajectory output method, it is preferable that the trajectory acquisition step acquires the trajectory based on a motion equation in which the cornering force is taken into consideration.

【0030】また、上記軌跡出力プログラムにおいて、
軌跡取得方法は、コーナリングフォースを考慮した運動
方程式に基づいて軌跡を取得することが好ましい。
In the above trajectory output program,
The trajectory acquisition method preferably acquires the trajectory based on a motion equation that considers the cornering force.

【0031】これらにより、牽引車や追従車の重量の影
響を考慮した軌跡を取得できるので、軌跡の精度が向上
される。特に、追従車等が大重量の積載物を積載してい
る場合に好適である。
As a result, a trajectory in which the influence of the weight of the towing vehicle or the following vehicle is taken into consideration can be obtained, so that the accuracy of the trajectory is improved. In particular, it is suitable when the following vehicle or the like carries a heavy load.

【0032】[0032]

【発明の実施の形態】以下、添付図面を参照しながら、
本発明に係る軌跡出力装置の好適な実施形態について詳
細に説明する。なお、図面の説明において、同一または
相当要素には同一の符号を付し、重複する説明は省略す
る。
DETAILED DESCRIPTION OF THE INVENTION Referring to the accompanying drawings,
A preferred embodiment of the trajectory output device according to the present invention will be described in detail. In the description of the drawings, the same or corresponding elements will be denoted by the same reference symbols, without redundant description.

【0033】本実施形態の軌跡出力装置1は、コンピュ
ータ上の仮想領域で、操舵輪を有するトラクタ(牽引
車)と、操舵輪を有し前記牽引車に牽引される1もしく
は複数の追従車を含む仮想の連結車両が走行する際の軌
跡を取得しディスプレイ装置等に出力する軌跡出力装置
であり、これらのトラクタや追従車は、走行の際に各々
定められた操舵パターンに基づいて操舵されるものとさ
れる。
The trajectory output device 1 of the present embodiment includes a tractor (towing vehicle) having steered wheels and one or a plurality of following vehicles having steered wheels and being pulled by the towing vehicle in a virtual area on a computer. It is a trajectory output device that acquires the trajectory when the virtual connected vehicle including the vehicle travels and outputs it to a display device, etc., and these tractors and the following vehicles are steered based on the respective steering patterns that are determined when the vehicle travels. To be taken.

【0034】本実施形態の軌跡出力装置1は、トラクタ
の舵角の変化パターンを入力するためのトラクタ操舵パ
ターン入力手段2と、トラクタの舵角の変化パターンが
格納されるトラクタ操舵パターン格納手段4と、追従車
の舵角の変化パターンを入力するための追従車操舵パタ
ーン入力手段10と、追従車の舵角の変化パターンが格
納される追従車操舵パターン格納手段6と、トラクタ操
舵パターン格納手段4の変化パターンと追従車操舵パタ
ーン格納手段6の変化パターンに応じて各々トラクタ及
び追従車の舵角を制御した場合の連結車両の軌跡を取得
する軌跡取得手段18と、取得される軌跡をディスプレ
イ等に対して出力する出力手段20と、マウスやキーボ
ード等を介してユーザ等から追従車の舵角の変化パター
ンを修正するための修正要求を入力させる追従車操舵パ
ターン修正情報入力手段13と、追従車に対する修正要
求に基づいて追従車操舵パターン格納手段6の舵角の変
化パターンを修正する追従車操舵パターン修正手段12
と、マウスやキーボード等を介してユーザ等からトラク
タの舵角の変化パターンを修正するための修正要求を入
力させるトラクタ操舵パターン修正情報入力手段5と、
トラクタに対する修正要求に基づいてトラクタ操舵パタ
ーン格納手段4の舵角の変化パターンを修正するトラク
タ操舵パターン修正手段3と、トラクタや追従車を含む
連結車両や走行条件等の種々のデータを入力する連結車
両データ入力手段14と、走行可能領域を設定する走行
可能領域設定手段30と、同様の機能を有するコンピュ
ータ装置である。
The trajectory output device 1 of this embodiment includes a tractor steering pattern input means 2 for inputting a change pattern of a tractor steering angle, and a tractor steering pattern storage means 4 for storing a change pattern of a tractor steering angle. And a follower vehicle steering pattern input means 10 for inputting a change pattern of the follower vehicle steering angle, a follower vehicle steering pattern storage means 6 for storing the change pattern of the follower vehicle steering angle, and a tractor steering pattern storage means. 4, the trajectory acquisition means 18 for acquiring the trajectory of the connected vehicle when the steering angles of the tractor and the follower vehicle are controlled according to the change pattern of 4 and the change pattern of the following vehicle steering pattern storage means 6, and the acquired trajectory are displayed. For correcting the change pattern of the steering angle of the following vehicle from the user or the like via the output means 20 for outputting to the etc. and the mouse or keyboard. Modification request and follow vehicle steering pattern correction information input means 13 for inputting, tracking wheel steering pattern correcting means for correcting the variation pattern of the steering angle of the follower wheel steering pattern storage unit 6 based on the modified request for the follow-up wheel 12
And a tractor steering pattern correction information input means 5 for inputting a correction request for correcting a change pattern of the steering angle of the tractor from a user or the like via a mouse, a keyboard or the like,
A tractor steering pattern correction unit 3 that corrects the change pattern of the steering angle of the tractor steering pattern storage unit 4 based on a correction request to the tractor, and a connection that inputs various data such as a connected vehicle including a tractor and a follower vehicle and running conditions. The vehicle data input means 14 and the travelable area setting means 30 for setting the travelable area are computer devices having the same functions.

【0035】連結車両データ入力手段14は、キーボー
ドやマウス等を介して、トラクタや追従車に関する諸元
や連結状況、走行条件等を入力させるためのものであ
る。ここでは、トラクタ、追従車に関して、例えば、全
長や全幅等の車枠の形状、連結部(キングピン等)の位
置、軸間距離、操舵輪の位置・数、非操舵輪の位置・
数、各輪軸のタイヤ数、重心の位置、車両重量等の車両
の条件等の入力をさせる。このような情報は図示しない
記憶領域に記憶されている。
The connected vehicle data input means 14 is for inputting specifications, connection conditions, running conditions, etc. regarding the tractor and the following vehicle via a keyboard, a mouse and the like. Here, regarding the tractor and the following vehicle, for example, the shape of the vehicle frame such as the overall length and width, the position of the connecting portion (king pin, etc.), the inter-axle distance, the position / number of steered wheels, the position of the non-steered wheels
The number of vehicles, the number of tires on each wheel axle, the position of the center of gravity, and vehicle conditions such as vehicle weight are input. Such information is stored in a storage area (not shown).

【0036】なお、この連結車両データ入力手段14に
おいては、トラクタや追従車を各々設定し、設定された
各々のトラクタや追従車等を任意に連結・切り離して連
結車両を設定することが出来るようにされている。ま
た、各々のトラクタや追従車の諸元に応じて、これら車
両同士の連結可否の検討ができるようにされている。
In the connected vehicle data input means 14, it is possible to set a tractor and a following vehicle, and to set a connected vehicle by arbitrarily connecting and disconnecting each set tractor and following vehicle. Has been In addition, it is possible to examine whether or not these vehicles can be connected to each other according to the specifications of each tractor and the following vehicle.

【0037】トラクタ操舵パターン入力手段2は、マウ
スやキーボード等を介してユーザからトラクタの舵角の
変化パターンを取得し、これをトラクタ操舵パターン格
納手段4に入力する。なお、舵角とは、操舵輪が操舵輪
の中立位置との間になす鋭角のことである。
The tractor steering pattern input means 2 acquires a change pattern of the steering angle of the tractor from the user via a mouse, a keyboard or the like, and inputs this to the tractor steering pattern storage means 4. The steering angle is an acute angle formed between the steered wheels and the neutral position of the steered wheels.

【0038】ここでは、ユーザからの指示に応じて、以
下の2種類の方法でトラクタの舵角の変化パターンを取
得し入力する。第一の方法は、ユーザから、スタート位
置からゴール位置までの計算区間の操舵輪の舵角の変化
パターンを直接的に取得し、これをトラクタ操舵パター
ン格納手段4に入力する方法である。例えば、ユーザか
ら走行時間や走行距離に対して舵角を定めたデータテー
ブルや、走行時間や走行距離の関数等として定められた
舵角の関数を取得し、これに対応する情報をトラクタ操
舵パターン格納手段4に入力する事ができる。この方法
では、計算区間におけるスタート位置での舵角と、ゴー
ル位置での舵角を所望の値に固定できる。
Here, the change pattern of the steering angle of the tractor is acquired and input by the following two methods according to the instruction from the user. The first method is a method in which the user directly obtains the change pattern of the steering angle of the steered wheels in the calculation section from the start position to the goal position, and inputs it to the tractor steering pattern storage means 4. For example, a user obtains a data table that determines the steering angle with respect to the traveling time and the traveling distance from the user, and a function of the steering angle that is determined as a function of the traveling time and the traveling distance. It can be input to the storage means 4. According to this method, the steering angle at the start position and the steering angle at the goal position in the calculation section can be fixed to desired values.

【0039】なお、実車では、所定の区間毎に、トラク
タの操舵輪の舵角を時間に応じて線形に増加又は減少す
るように変化させて走行させることが多いので、トラク
タ操舵パターン入力手段2は、舵角が走行時間に応じて
微少な線分のつなぎ合わせで表されるような舵角の変化
パターンをトラクタ操舵パターン格納手段4に入力可能
であることが好ましい。
In an actual vehicle, since the steering angle of the steered wheels of the tractor is often changed so as to linearly increase or decrease with time in each predetermined section, the tractor steering pattern input means 2 is used. Preferably, it is possible to input into the tractor steering pattern storage means 4 a change pattern of the steering angle such that the steering angle is represented by a combination of minute line segments according to the traveling time.

【0040】第二の方法では、ユーザからトラクタの姿
勢角込みのスタート位置と、トラクタの姿勢角込みのゴ
ール位置とを取得し、トラクタのみを、操舵輪の舵角が
一定速度で変化するようにスタート位置からゴール位置
まで旋回走行させた場合の軌跡をクロソイド曲線に基づ
いて取得し、このクロソイド曲線に対応する舵角の変化
パターンをトラクタ操舵パターン格納手段4に入力す
る。このような計算には、例えば、特開平11−211
626号公報に記載された方法を用いることが好適であ
る。なお、本方法によれば、トラクタの概略的な走行軌
跡及びスタート位置、ゴール位置を把握した上でトラク
タの舵角の変化パターンを規定できる。
In the second method, the start position of the tractor including the attitude angle and the goal position of the tractor including the attitude angle are acquired from the user so that the steering angle of the steered wheels of the tractor changes at a constant speed. The locus when the vehicle is turned from the start position to the goal position is acquired based on the clothoid curve, and the change pattern of the steering angle corresponding to the clothoid curve is input to the tractor steering pattern storage means 4. For such calculation, for example, Japanese Patent Laid-Open No. 11-212
It is preferable to use the method described in Japanese Patent No. 626. According to this method, the change pattern of the steering angle of the tractor can be defined after grasping the rough traveling locus of the tractor, the start position, and the goal position.

【0041】トラクタ操舵パターン格納手段4は、上記
のようにして得られた、走行の際のトラクタの操舵輪の
舵角の変化パターンをメモリ上に格納する。図2に、格
納された変化パターンの一例をグラフ化したものを示す
(図中のトラクタ舵角変化パターンA参照)。
The tractor steering pattern storage means 4 stores in the memory the change pattern of the steering angle of the steered wheels of the tractor during traveling obtained as described above. FIG. 2 shows a graph of an example of the stored change pattern (see tractor steering angle change pattern A in the figure).

【0042】追従車操舵パターン入力手段10は、トラ
クタ操舵パターン入力手段2と同様に、マウスやキーボ
ード等を介してユーザから追従車の舵角の変化パターン
を取得し、追従車操舵パターン格納手段6に入力可能で
ある。
Similar to the tractor steering pattern input means 2, the follower vehicle steering pattern input means 10 acquires the change pattern of the steering angle of the follower vehicle from the user via the mouse or keyboard, and the follower vehicle steering pattern storage means 6 is provided. Can be entered in.

【0043】さらに、追従車操舵パターン入力手段10
は、ユーザからの指示に基づいて、追従車がトラクタに
追従して走行するために必要な追従車の舵角の変化パタ
ーンを自動的に生成し追従車操舵パターン格納手段6に
入力する基準追従車操舵パターン生成手段8を備えてい
る。
Further, the following vehicle steering pattern input means 10
Is a reference tracking that automatically generates a change pattern of the steering angle of the following vehicle required for the following vehicle to travel following the tractor based on an instruction from the user and inputs it to the following vehicle steering pattern storage unit 6. The vehicle steering pattern generation means 8 is provided.

【0044】このような基準となる追従車の舵角の変化
パターンは、例えば、追従車の舵角を、いつもトラクタ
と追従車とがなす角に比例するように与えること等によ
り、容易に取得できる。
The change pattern of the rudder angle of the following vehicle serving as the reference is easily obtained by, for example, giving the rudder angle of the following vehicle in proportion to the angle formed by the tractor and the following vehicle. it can.

【0045】ここで、このような舵角の変化パターンを
自動生成する理由を説明する。操舵輪を有する追従車
は、車種等によっては操舵量の変化パターンを与えない
と旋回しにくい場合がある。このような場合、連結車両
の軌跡を取得するためには、少なくとも追従車に対し
て、牽引車に追従して走行するような操舵量の変化パタ
ーンを与える必要がある。
Now, the reason why such a steering angle change pattern is automatically generated will be described. A follow-up vehicle having steered wheels may be difficult to turn unless a change pattern of the steering amount is given depending on the vehicle type and the like. In such a case, in order to acquire the trajectory of the connected vehicle, it is necessary to provide at least the following vehicle with a change pattern of the steering amount that allows the vehicle to follow the towing vehicle.

【0046】そこで、基準追従車操舵パターン生成手段
8によって、追従車を牽引車に追従させるために必要な
追従車の操舵量の変化パターンを取得することにより、
追従車の操舵量の変化パターンをユーザ等が入力しなく
ても、牽引車に追従して追従車が走行する暫定的な連結
車両の旋回軌跡を取得し入力させることができる。これ
により、ユーザ等が牽引車の操舵量の変化パターンに応
じた追従車の操舵量の変化パターンを入力する手間が省
かれる。また、取得された連結車両の軌跡に基づいて、
ユーザ等が、このようにして得られた追従車の操舵量の
変化パターンを修正すれば、所望の軌跡を走行させるた
めの追従車の操舵量の変化パターンが容易に求められ
る。
Therefore, the reference follower vehicle steering pattern generation means 8 obtains the change pattern of the steering amount of the follower vehicle required for causing the follower vehicle to follow the towing vehicle.
Even if the user or the like does not input the change pattern of the steering amount of the following vehicle, it is possible to acquire and input the temporary turning trajectory of the interlocking vehicle in which the following vehicle travels following the towing vehicle. This saves the user the trouble of inputting the change pattern of the steering amount of the following vehicle according to the change pattern of the steering amount of the towing vehicle. Also, based on the acquired trajectory of the connected vehicle,
If the user or the like corrects the change pattern of the steering amount of the following vehicle thus obtained, the change pattern of the steering amount of the following vehicle for traveling on a desired locus can be easily obtained.

【0047】追従車操舵パターン格納手段6は、上記の
ようにして得られる追従車の操舵輪の舵角の変化パター
ンを、メモリ上に格納する。
The follower vehicle steering pattern storage means 6 stores the change pattern of the steering angle of the steered wheels of the follower vehicle in the memory obtained as described above.

【0048】軌跡取得手段18は、上記条件の下で、ト
ラクタを所定の速度で所定時間走行させた場合の所定の
区間のトラクタ及び追従車を含む連結車両の走行軌跡を
取得する。
Under the above conditions, the locus acquisition means 18 acquires the running locus of the connected vehicle including the tractor and the following vehicle in a predetermined section when the tractor is driven at a predetermined speed for a predetermined time.

【0049】以下に、このような軌跡の取得の方法を説
明する。
A method of acquiring such a locus will be described below.

【0050】まず、第一の軌跡計算方法を説明する。こ
こでは、一例として、図3に示す、ポールトレーラのよ
うな連結車両50を想定する。すなわち、この連結車両
50は、トラクタ70と第一追従車(追従車)71と第
二追従車(追従車)72とからなり、トラクタ70の連
結部80と第一追従車71の連結部81とがジョイント
連結され、また、第一追従車71の連結部82と第二追
従車72の連結部83とがジョイント連結されている。
さらに、第二追従車72は、車体前方に延在し伸縮自在
なドローバー85を有し、このドローバー85の先端部
86がトラクタ70の連結部87にジョイント連結され
ている。なお、図面上では煩雑になるのをさけるため、
各接続部を互いに離して描いている。
First, the first trajectory calculation method will be described. Here, as an example, a connected vehicle 50 such as a pole trailer shown in FIG. 3 is assumed. That is, the connected vehicle 50 includes a tractor 70, a first following vehicle (following vehicle) 71, and a second following vehicle (following vehicle) 72, and the connecting portion 80 of the tractor 70 and the connecting portion 81 of the first following vehicle 71. Are joint-connected, and the connecting portion 82 of the first follower vehicle 71 and the connecting portion 83 of the second follower vehicle 72 are jointly connected.
Further, the second follower vehicle 72 has a drawbar 85 that extends forward of the vehicle body and is expandable and contractible, and a tip end portion 86 of the drawbar 85 is jointly connected to a connecting portion 87 of the tractor 70. In addition, in order to avoid becoming complicated on the drawing,
Each connection is drawn away from each other.

【0051】トラクタ70は、重心60の前後に操舵輪
91f,91rを有し、第一追従車71は重心61の前
後に操舵輪93f,93rを有し、第二追従車72は重
心62の前後に操舵輪95f,95rを有している。
The tractor 70 has steered wheels 91f and 91r before and after the center of gravity 60, the first follower vehicle 71 has steered wheels 93f and 93r before and after the center of gravity 61, and the second follower vehicle 72 has the center of gravity 62. Front and rear steering wheels 95f and 95r are provided.

【0052】ここで、添字n = 1, 2, 3を車両の番号と
し、順にトラクタ70、第一追従車71、第二追従車7
2に対応させる。
Here, the subscripts n = 1, 2, 3 are vehicle numbers, and the tractor 70, the first follower vehicle 71, and the second follower vehicle 7 are arranged in this order.
Corresponds to 2.

【0053】また、XY座標平面を設定し、ψnを車両
nの姿勢角(X座標と車両の軸とのなす角)、Fxij
yij、は各々の車両iと車両jとが互いに及ぼし合う
X方向Y方向の力、Fnfを車両nの前側車輪にかかるコ
ーナリングフォース、Fnrを車両nの後側車輪にかかる
コーナリングフォース、βnを車両nの滑り角(進行方
向と車両の軸とのなす角)、δnfを車両nの前側操舵輪
の舵角(操舵輪の中立位置からの角度)、δnrを車両n
の後側操舵輪の舵角、βnfを車両nの前側操舵輪の操舵
輪のスリップ角、βnrを車両nの後側操舵輪の操舵輪の
スリップ角、θ12をトラクタ70の軸と第一追従車71
の軸とのなす角、θ23を第二追従車72の軸と第二追従
車72の軸とのなす角、θ13をトラクタ70の軸と第二
追従車72の軸とのなす角、Lnfを車両nの重心から前
側操舵輪までの距離、Lnrを車両nの重心から後側操舵
輪までの距離、L1bをトラクタ70の重心60から連結
部80までの距離、L1dをトラクタ70の重心60から
連結部87までの距離、L2aを第一追従車71の重心6
1から連結部81までの距離、L2bを第一追従車71の
重心61から連結部82までの距離、L3aを第二追従車
72の重心62から連結部83までの距離、L3cを第二
追従車72の重心62からドローバーの連結部86まで
の距離とする。
Further, the XY coordinate plane is set, and ψ n is the posture angle of the vehicle n (the angle between the X coordinate and the axis of the vehicle), F xij ,
F yij is the force in the X and Y directions in which the respective vehicles i and j exert on each other, F nf is the cornering force applied to the front wheels of the vehicle n, F nr is the cornering force applied to the rear wheels of the vehicle n, β n is the slip angle of the vehicle n (the angle between the traveling direction and the axis of the vehicle), δ nf is the steering angle of the front steered wheels of the vehicle n (the angle from the neutral position of the steered wheels), and δ nr is the vehicle n.
The steering angle of the rear steering wheel, β nf is the steering wheel slip angle of the front steering wheel of vehicle n, β nr is the steering wheel slip angle of the rear steering wheel of vehicle n, and θ 12 is the axis of tractor 70. First follower vehicle 71
Angle, the angle between the angle, the theta 13 of the tractor 70 axis and the axis of the second follower wheel 72 with the axis of the shaft and a second follow-up wheel 72 of the theta 23 second follower wheel 72 with the shaft, L nf is the distance from the center of gravity of the vehicle n to the front steered wheels, L nr is the distance from the center of gravity of the vehicle n to the rear steered wheels, L 1b is the distance from the center of gravity 60 of the tractor 70 to the connecting portion 80, and L 1d is The distance from the center of gravity 60 of the tractor 70 to the connecting portion 87, L 2a, is the center of gravity 6 of the first follower vehicle 71.
1 to the connecting portion 81, L 2b is the distance from the center of gravity 61 of the first follower vehicle 71 to the connecting portion 82, L 3a is the distance from the center of gravity 62 of the second follower vehicle 72 to the connecting portion 83, and L 3c is The distance is from the center of gravity 62 of the second follower vehicle 72 to the connecting portion 86 of the drawbar.

【0054】ここで、図4を参照して、コーナリングフ
ォースを説明する。例えば、車両が横方向の運動やヨー
イング運動を伴っている場合、タイヤにはスリップ角β
1fが発生し、タイヤの進行方向に直角な方向にコーナリ
ングフォースF1fが生ずる。ここで、スリップ角β1f
小さいと仮定すると、車両nの前側の操舵輪にかかるコ
ーナリングフォースFnfと、車両nの後側の操舵輪に係
るコーナリングフォースFnrとは、式(1)及び式
(2)で表すことができる。ここで、Knuf、Knurは、
各々車両nの前側操舵輪のタイヤ一輪あたりのコーナリ
ングパワー、車両nの後側操舵輪のタイヤ一輪あたりの
コーナリングパワーであり、nnf、nnrは、車両nの前
側車輪のタイヤの数と後側車輪のタイヤの数である。
Here, the cornering force will be described with reference to FIG. For example, if the vehicle is undergoing lateral or yawing movements, the tire may have a slip angle β
1f is generated and a cornering force F 1f is generated in a direction perpendicular to the tire traveling direction. Assuming that the slip angle β 1f is small, the cornering force F nf applied to the front steered wheel of the vehicle n and the cornering force F nr applied to the steered wheel of the rear side of the vehicle n are expressed by the formula (1) and It can be expressed by equation (2). Where K nuf and K nur are
The cornering power per tire of the front steered wheels of the vehicle n and the cornering power per tire of the rear steered wheels of the vehicle n are respectively n nf and n nr , where n nf and n nr are the number of tires of the front wheels of the vehicle n and the rear The number of tires on the side wheels.

【0055】[0055]

【数1】 [Equation 1]

【0056】そして、図3に戻って、トラクタ70が一
定の低速V1で走行し、第一追従車71、第二追従車72
がトラクタ70に牽引されて走行すると仮定し、さら
に、車両間での牽引力や、タイヤの転がり抵抗がなく、
車体のローリング等がないと仮定する。
Returning to FIG. 3, the tractor 70 travels at a constant low speed V 1 , and the first follower vehicle 71 and the second follower vehicle 72 are moved.
Is towed by the tractor 70 and travels. Furthermore, there is no traction force between vehicles or rolling resistance of tires,
It is assumed that there is no rolling of the car body.

【0057】すると、各々の車両に働く力の釣り合い、
すなわち、連結する他の車両からの力Fx,Fyとコーナ
リングフォースFnf、Fnrとを考慮したトラクタ70、
第一追従車71、第二追従車72のX方向、Y方向及び
回転の運動方程式と、車両の各連結点での拘束条件の式
とに基づいて、式(3)〜(12)に示すように、各々
の車両について、車両の滑り角βの一階時間微分の方程
式及び車両の姿勢角ψの2階時間微分の方程式が得られ
る。ここで、mnは車両nの重量、Vnは車両nの速度、
nは車両nの慣性モーメント、rnはψnの一階時間微
分である。
Then, the balance of the forces acting on the respective vehicles,
That is, the tractor 70 considering the forces F x and F y from the other connected vehicles and the cornering forces F nf and F nr .
Based on the equations of motion of the first follower vehicle 71 and the second follower vehicle 72 in the X direction, the Y direction, and the rotation, and the equation of the constraint condition at each connecting point of the vehicle, the equations (3) to (12) are shown. Thus, for each vehicle, an equation for the first-order time derivative of the vehicle slip angle β and an equation for the second-order time derivative of the vehicle attitude angle ψ are obtained. Here, m n is the weight of the vehicle n, V n is the speed of the vehicle n,
I n is the moment of inertia of the vehicle n, and r n is the first-order time derivative of ψ n .

【0058】[0058]

【数2】 [Equation 2]

【0059】そして、このような式を微分方程式の初期
値問題の数値近似解法であるルンゲクッタ法等で、時間
0から微少な時間刻みτ毎に解いていくことにより、ψ
とβの時間変化が求められ、各々の時刻における各々の
車両の速度、角度、位置が求められる。
Then, by solving such an equation with the Runge-Kutta method, which is a numerical approximation method for the initial value problem of the differential equation, etc.
Then, the time changes of β and β are obtained, and the speed, angle, and position of each vehicle at each time are obtained.

【0060】なお、本式は例示であり、例えば、4両以
上の連結車両の軌跡の方程式や、他の連結形態の場合の
方程式も同様の考えに基づいて容易に得ることができ
る。また、一つの車両に、操舵輪をいくつ有していても
計算が行える。
This equation is an example, and for example, the equations of the loci of four or more connected vehicles and the equations for other connection forms can be easily obtained based on the same idea. Further, the calculation can be performed regardless of how many steering wheels are included in one vehicle.

【0061】なお、この方法では、コーナリングフォー
スを考慮した運動方程式を各々の車両について解いてい
るので、各々の車両の自重や積載物の重量の影響を考慮
した精度の高い軌跡が得られる。
In this method, since the equation of motion considering the cornering force is solved for each vehicle, a highly accurate trajectory considering the influence of the own weight of each vehicle and the weight of the load can be obtained.

【0062】第二の軌跡計算方法としては、図5に示す
ように、外力を考えず、操舵輪91r、91f等や連結
点81、83,86等での速度を絶対座標のX軸の速度
に各々置き換え、さらに各車両の姿勢角ψを含む式に各
々変換することにより、運動方程式を求める、いわゆ
る、純幾何学的な方法がある。ここで、一例として、第
一の軌跡計算方法で用いたのとほぼ同様な、第一のトラ
クタ70、第一追従車71、第二追従車72とからなる
ポールトレーラのような連結車両を想定する。また、操
舵輪91fの速度をV1f、操舵輪91rの速度をV1r
操舵輪93rの速度をV2r、操舵輪95rの速度を
3r、連結点81の速度をV2a1b、連結点83の速度を
3a2b、連結点86の速度をV3c1d、重心60の速度を
01、重心61の速度をV02、重心62の速度をV03
連結点81の速度の方向と第一追従車71の軸とがなす
角をξ12、連結点83の速度V3a2bと第二追従車72の
軸とのなす角をξ23、連結点86の速度V3c1dと第二追
従車72の軸とがなす角をξ13とすると、運動方程式と
して、例えば、式(13)〜(20)のような式が得ら
れる。ただし、V = V01 cosδ1とする。これらの式
は、第一追従車71の操舵輪がないものとして、取得し
たものであり、典型的なポールトレーラについてのもの
である。
As a second locus calculation method, as shown in FIG. 5, the speed at the steered wheels 91r, 91f, etc. and the connecting points 81, 83, 86, etc. is calculated as the absolute coordinate X-axis speed without considering the external force. There is a so-called pure geometric method in which the equation of motion is obtained by substituting each of the above equations with each other and further converting each into an equation including the attitude angle ψ of each vehicle. Here, as an example, a connected vehicle such as a pole trailer including a first tractor 70, a first following vehicle 71, and a second following vehicle 72, which is almost the same as that used in the first trajectory calculation method, is assumed. To do. Further, the speed of the steered wheels 91f is V 1f , the speed of the steered wheels 91r is V 1r ,
The speed of the steered wheels 93r is V 2r , the speed of the steered wheels 95r is V 3r , the speed of the connecting point 81 is V 2a1b , the speed of the connecting point 83 is V 3a2b , the speed of the connecting point 86 is V 3c1d , and the speed of the center of gravity 60 is V 01 , the velocity of the center of gravity 61 is V 02 , the velocity of the center of gravity 62 is V 03 ,
The angle between the speed direction of the connecting point 81 and the axis of the first following vehicle 71 is ξ 12 , the angle between the speed V 3a2b of the connecting point 83 and the axis of the second following vehicle 72 is ξ 23 , and the connecting point 86 is If the angle formed by the velocity V 3c1d and the axis of the second follower vehicle 72 is ξ 13 , equations (13) to (20) can be obtained as equations of motion. However, it is assumed that V = V 01 cos δ 1 . These equations are obtained assuming that the first follower vehicle 71 does not have the steered wheels, and are for a typical pole trailer.

【0063】[0063]

【数3】 [Equation 3]

【0064】このような運動方程式も、上述と同様に、
ルンゲクッタ法等を用いて微少な時間刻み毎に解いてい
けば、各々の車両の走行軌跡が取得できる。
This equation of motion is also the same as above.
By using the Runge-Kutta method or the like to solve for each minute time step, the running locus of each vehicle can be acquired.

【0065】なお、本式も例示であり、例えば、4両以
上の連結車両の軌跡の方程式や、他の連結形態の場合の
方程式も同様の考えに基づいて容易に得ることができ
る。また、一つの車両に、操舵輪をいくつ有していても
計算が行える。
This formula is also an example. For example, the equations of the loci of four or more connected vehicles and the equations in the case of other connection forms can be easily obtained based on the same idea. Further, the calculation can be performed regardless of how many steering wheels are included in one vehicle.

【0066】また、上述のような2つの運動方程式にお
いては、速度の向きをマイナスにすることにより、前進
だけでなくトラクタを後退させたときの連結車両の走行
軌跡を取得することもできる。
In the above two equations of motion, the traveling locus of the connected vehicle can be obtained not only when the tractor is moved backward but also when the tractor is moved backward by making the speed direction negative.

【0067】出力手段20は、取得した走行軌跡をディ
スプレイやプリンタ、外部記憶装置等に出力させる。
The output means 20 outputs the acquired traveling locus to a display, a printer, an external storage device or the like.

【0068】追従車操舵パターン修正情報入力手段(追
従車操舵パターン修正要求入力手段)13は、キーボー
ドやマウス操作を介して、ユーザから追従車の舵角の変
化パターンの修正要求を入力させるものである。また、
トラクタ操舵パターン修正情報入力手段(トラクタ操舵
パターン修正要求入力手段)5は、キーボードやマウス
操作を介して、ユーザからトラクタの舵角の変化パター
ンの修正要求を入力させるものである。
The following vehicle steering pattern correction information input means (following vehicle steering pattern correction request input means) 13 allows a user to input a correction request for the change pattern of the steering angle of the following vehicle via a keyboard or mouse operation. is there. Also,
The tractor steering pattern correction information input means (tractor steering pattern correction request input means) 5 allows a user to input a correction request for a change pattern of the tractor steering angle via a keyboard or a mouse operation.

【0069】追従車操舵パターン修正手段12は、修正
要求に応じて、追従車操舵パターン格納手段6に格納さ
れた追従車の操舵輪の変化パターンを修正する。また、
トラクタ操舵パターン修正手段3は、修正要求に応じ
て、トラクタ操舵パターン格納手段4に格納されたトラ
クタの操舵輪の変化パターンを修正する。ここでは、修
正要求に応じて、舵角が時間に応じて線形に変化する区
間を複数組み合わせた時間変化パターンとなるように各
々修正することが好ましい。
The follower vehicle steering pattern correction means 12 corrects the change pattern of the steered wheels of the follower vehicle stored in the follower vehicle steering pattern storage means 6 in response to the correction request. Also,
The tractor steering pattern correction means 3 corrects the change pattern of the steered wheels of the tractor stored in the tractor steering pattern storage means 4 in response to the correction request. Here, it is preferable that each of the corrections is made in accordance with the correction request so as to be a time change pattern in which a plurality of sections in which the steering angle linearly changes with time are combined.

【0070】このようにすると、追従車やトラクタの舵
角を時間に対して線形に変化させる区間を複数組み合わ
せた変化パターンで追従車やトラクタを操舵した場合の
連結車両の軌跡が取得される。実際の連結車両において
追従車やトラクタの舵角を変化させる場合には、舵角を
時間の線分として変化させる場合が多いので、時間に対
して複雑な関数となるように舵角を変化させるように格
納する場合に比して、実際の追従車やトラクタの舵角の
操舵方法を定めるのに適したデータが得られる。また、
追従車操舵パターン修正手段12は、変化パターンを直
接的に修正するほか、修正要求に応じて、追従者操舵パ
ターン入力手段10の基準追従車操舵パターン生成手段
8と同様にして自動生成される追従車の舵角変化パター
ンに基づいて、変化パターンを修正するようにしても良
い。また、トラクタ操舵パターン修正手段3は、変化パ
ターンを直接的に修正するほか、修正要求に応じて、ト
ラクタ操舵パターン入力手段2と同様に、クロソイド曲
線等に基づいて舵角変化パターンを生成し、これに基づ
いて変化パターンを修正するようにしても良い。
In this way, the locus of the connected vehicle when the follower vehicle or the tractor is steered is obtained in a change pattern in which a plurality of sections in which the steering angles of the follower vehicle and the tractor are changed linearly with respect to time are combined. When changing the rudder angle of a follower vehicle or a tractor in an actual connected vehicle, the rudder angle is often changed as a line segment of time, so the rudder angle is changed so that it becomes a complicated function with respect to time. Compared with the case of storing like this, data suitable for determining the steering method of the actual steering angle of the following vehicle or tractor can be obtained. Also,
The follower vehicle steering pattern correction means 12 directly corrects the change pattern and, in response to a correction request, is automatically generated in the same manner as the reference follower vehicle steering pattern generation means 8 of the follower steering pattern input means 10. The change pattern may be modified based on the steering angle change pattern of the vehicle. Further, the tractor steering pattern correction means 3 directly corrects the change pattern, and in response to a correction request, similarly to the tractor steering pattern input means 2, generates a steering angle change pattern based on a clothoid curve or the like. The change pattern may be corrected based on this.

【0071】なお、本実施形態では操舵量の変化パター
ンとして、舵角の時間変化パターンを採用しているがこ
れに限られず、舵角の走行距離に対する変化パターン等
としてもよい。
In this embodiment, the steering angle change pattern is the time change pattern of the steering angle. However, the present invention is not limited to this, and the change pattern of the steering angle with respect to the traveling distance may be used.

【0072】走行可能領域設定手段30は、ユーザから
の入力に基づいて、走行可能領域及び走行不可能領域を
設定し、出力手段20に出力しディスプレイ等に出力さ
せる。
The drivable area setting means 30 sets the drivable area and the drivable area based on the input from the user, and outputs them to the output means 20 and outputs them to a display or the like.

【0073】次に、本実施形態に係る軌跡出力装置1の
動作について説明すると共に、合わせて本実施形態に係
る軌跡出力方法について、図6を参照して説明する。
Next, the operation of the trajectory output device 1 according to this embodiment will be described, and the trajectory output method according to this embodiment will also be described with reference to FIG.

【0074】まず、ステップ101において、ユーザか
らトラクタ等の連結車両の諸元や連結条件、走行可能領
域等の条件を入力する。
First, in step 101, the user inputs specifications of a connected vehicle such as a tractor, connection conditions, and conditions such as a travelable area.

【0075】次に、ステップ103において、ユーザか
らの入力に応じて、トラクタの舵角の変化パターンを直
接入力するか否かを決定し、トラクタの舵角の変化パタ
ーンを直接入力する場合は、ステップ105へ進み、ス
タート位置とゴール位置とからトラクタの舵角の変化パ
ターンを間接的に求める場合は、ステップ107へ進
む。
Next, in step 103, it is determined whether or not the change pattern of the steering angle of the tractor is directly input according to the input from the user, and when the change pattern of the steering angle of the tractor is directly input, In step 105, if the change pattern of the steering angle of the tractor is indirectly obtained from the start position and the goal position, the process proceeds to step 107.

【0076】ステップ105においては、ユーザからの
入力に応じて、舵角の変化パターンをトラクタ操舵パタ
ーン格納手段4に格納する。例えば、ユーザが、スター
ト地点での舵角と、ゴール地点での舵角とを入力すると
共に、走行させる距離を入力することにより、トラクタ
操舵パターン入力手段2が、トラクタの走行速度に基づ
いて、トラクタの舵角変化の時間変化パターンを計算
し、図2のような、舵角の時間変化パターンをトラクタ
操舵パターン格納手段4に格納する。この場合、スター
ト位置とゴール位置とでのトラクタの舵角を直接指定す
るので、このような軌跡の区間を複数つなげて複雑な軌
跡を作成する際に、各々の軌跡の接続点においてトラク
タの舵角を連続して表現できる。
In step 105, the steering angle change pattern is stored in the tractor steering pattern storage means 4 in accordance with the input from the user. For example, when the user inputs the steering angle at the start point and the steering angle at the goal point and also inputs the traveling distance, the tractor steering pattern input means 2 causes the tractor steering pattern input means 2 to calculate the traveling speed of the tractor based on the traveling speed. The time change pattern of the steering angle change of the tractor is calculated, and the time change pattern of the steering angle as shown in FIG. 2 is stored in the tractor steering pattern storage means 4. In this case, since the rudder angle of the tractor at the start position and the goal position is directly specified, the tractor rudder at the connection point of each locus is created when connecting multiple sections of such locus to create a complicated locus. The corner can be expressed continuously.

【0077】一方、ステップ107においては、ユーザ
からの入力に応じて、スタート地点とゴール地点とを結
ぶクロソイド曲線を設定し、トラクタがクロソイド曲線
上等を旋回するためのトラクタの舵角の変化パターンを
取得し、トラクタ操舵パターン格納手段4に格納させ
る。この場合のトラクタのゴール位置での操舵角は、後
で取得する連結車両の軌跡のゴール位置におけるトラク
タの操舵角とは必ずしも一致しないが、トラクタの大ま
かな走行軌跡を予め把握することができる。
On the other hand, in step 107, a clothoid curve connecting the start point and the goal point is set according to the input from the user, and the change pattern of the steering angle of the tractor for the tractor to turn on the clothoid curve or the like. Is acquired and stored in the tractor steering pattern storage means 4. In this case, the steering angle of the tractor at the goal position does not necessarily match the steering angle of the tractor at the goal position of the trajectory of the vehicle to be acquired later, but the rough traveling trajectory of the tractor can be grasped in advance.

【0078】次に、ステップ109において、ユーザか
らの入力に応じて、追従車の舵角の変化パターンを直接
入力するか否かを決定し、追従車の舵角の変化パターン
を直接入力する場合は、ステップ111へ進み、追従車
の舵角の変化パターンを入力せず自動生成させる場合は
ステップ113へ進む。
Next, in step 109, it is determined whether or not the change pattern of the steering angle of the following vehicle is directly input according to the input from the user, and the change pattern of the steering angle of the following vehicle is directly input. Goes to step 111, and goes to step 113 when the change pattern of the steering angle of the following vehicle is automatically generated without being input.

【0079】ステップ111では、追従車の舵角変化パ
ターンを直接入力する。ここでは、ステップ105と同
様に、舵角の変化パターンの時間変化をデータテーブル
等として入力できるほか、追従車の舵角の変化パターン
を、トラクタとのなす角を利用したリンク機構等により
リンクさせて操舵させるのを模擬する数式等の入力も可
能である。
In step 111, the steering angle change pattern of the following vehicle is directly input. Here, as in step 105, the time change of the rudder angle change pattern can be input as a data table or the like, and the rudder angle change pattern of the following vehicle is linked by a link mechanism or the like that uses the angle formed by the tractor. It is also possible to input a mathematical expression or the like that simulates the steering operation.

【0080】一方、ステップ113では、トラクタに追
従して追従車が走行するような追従車の舵角変化パター
ンを自動生成して、追従車操舵パターン格納手段に入力
するように設定する。なお、例えば、トラクタと追従車
とのなす角に比例して、追従車の舵角の変化パターンを
与える場合は、軌跡の計算中に逐次舵角が入力されるこ
ととなる。
On the other hand, in step 113, a steering angle change pattern of the following vehicle that follows the tractor and travels is automatically generated and set to be input to the following vehicle steering pattern storage means. In addition, for example, when the change pattern of the steering angle of the following vehicle is given in proportion to the angle formed by the tractor and the following vehicle, the steering angle is sequentially input during the calculation of the locus.

【0081】次に、ステップ115において、上記条件
でトラクタと追従車の舵角を各々操舵させたときの連結
車両の所定の区間の軌跡を取得する。
Next, at step 115, the loci of a predetermined section of the connected vehicle when the steering angles of the tractor and the following vehicle are steered under the above conditions are acquired.

【0082】次に、ステップ117において、取得され
た区間の軌跡を走行可能領域等と重ね合わせて出力す
る。
Next, in step 117, the locus of the acquired section is overlapped with the travelable area and output.

【0083】そして、ステップ119において、ユーザ
からの指示により、追従車の軌跡が修正要とされた場合
はステップ121に進む。ステップ121においては、
ユーザからの指示に応じて、追従車操舵パターン格納手
段6の追従車の舵角変化パターンを修正させる。そし
て、ステップ115に戻って、修正された舵角変化パタ
ーンに応じた軌跡を計算し、ステップ117で出力す
る。
Then, in step 119, if the trajectory of the following vehicle needs to be corrected by the user's instruction, the process proceeds to step 121. In step 121,
According to an instruction from the user, the steering angle change pattern of the following vehicle in the following vehicle steering pattern storage means 6 is corrected. Then, returning to step 115, a trajectory according to the corrected steering angle change pattern is calculated and output in step 117.

【0084】一方、ステップ119において、ユーザか
らの指示により、追従車の軌跡の再修正が不要とされた
場合は、ステップ123に進む。
On the other hand, if it is determined in step 119 that the trajectory of the following vehicle does not need to be recorrected by the user's instruction, the process proceeds to step 123.

【0085】ステップ123では、ユーザからトラクタ
の舵角の変化パターンを修正する又は再入力する旨の要
求があるか否かを判定し、トラクタの舵角の変化パター
ンの再入力の要求があればステップ103に戻って一連
の処理を行う。また、トラクタの舵角の変化パターンの
修正の要求があれば、ステップ124へ進む。また、ト
ラクタの舵角の修正や再入力の要求がなければ、ステッ
プ125へ進む。
In step 123, it is judged whether or not there is a request from the user to correct or re-input the change pattern of the steering angle of the tractor, and if there is a request to re-input the change pattern of the steering angle of the tractor. Returning to step 103, a series of processing is performed. If there is a request to correct the change pattern of the steering angle of the tractor, the process proceeds to step 124. If there is no request for correction or re-input of the steering angle of the tractor, the process proceeds to step 125.

【0086】ステップ124では、ユーザからの指示に
応じて、トラクタ操舵パターン格納手段4のトラクタの
舵角変化パターンを修正する。そして、ステップ115
に戻って、修正された舵角変化パターンに応じた軌跡を
計算し、ステップ117で出力する。
In step 124, the steering angle change pattern of the tractor in the tractor steering pattern storage means 4 is corrected according to the instruction from the user. And step 115
Returning to step 1, the trajectory according to the corrected steering angle change pattern is calculated and output in step 117.

【0087】ステップ125では、ユーザから、取得し
た軌跡区間に続くさらなる軌跡区間の取得の要求がある
かどうかを判定し、次の軌跡区間を取得する場合はステ
ップ127に進んで、各々の車両のゴール位置をスター
ト位置に置き換え、さらにステップ103に戻って一連
の処理を行い、さらなる軌跡の取得を行う。一方、軌跡
取得不要の要求があれば、処理を終了する。
At step 125, it is judged whether or not there is a request from the user for acquisition of a further trajectory section following the acquired trajectory section, and if the next trajectory section is to be acquired, the routine proceeds to step 127, where each vehicle The goal position is replaced with the start position, the process is returned to step 103, and a series of processes is performed to acquire a further trajectory. On the other hand, if there is a request not to acquire a trajectory, the process ends.

【0088】ここで、本実施形態に係る軌跡出力装置1
を用いて連結車両の旋回に関する検討を行う例を示す。
Here, the trajectory output device 1 according to the present embodiment.
An example of studying the turning of an articulated vehicle by using is shown.

【0089】ここでは、図7に示すような、前輪のみ操
舵可能なトラクタ170と、第一追従車としてのタイヤ
のない長物171と、第二追従車としての後輪のみ操舵
可能な追従車172と、から構成される初期位置121
にある連結車両130を想定する。ここで、トラクタ1
70と長物171とが垂直軸回りに回転可能な連結部1
75を介して連結され、長物171と追従車172とが
垂直軸回りに回転可能な連結部176を介して連結され
ている。また、旋回させたい走行可能領域を道路形状1
50とする。
Here, as shown in FIG. 7, a tractor 170 that can steer only the front wheels, a tireless long object 171 as the first follower vehicle, and a follower vehicle 172 that can steer only the rear wheels as the second follower vehicle. An initial position 121 composed of
Assume an articulated vehicle 130 at Here, tractor 1
70 and the long object 171 is a connecting portion 1 rotatable about a vertical axis
The long object 171 and the follower vehicle 172 are connected via a connecting portion 176 rotatable about a vertical axis. In addition, the road shape 1
Set to 50.

【0090】そして、ステップ101において、道路形
状150と初期位置121を設定した後、ステップ10
5において、図2のトラクタ舵角パターンAのような舵
角の変化パターンを設定し、さらに、ステップ113に
おいてトラクタ170に追従するような追従車172の
舵角変化パターンを自動生成するようにすると、図7に
示すような軌跡120が得られる。なお、このとき、追
従車172の操舵は、自動生成された図2の非線形の追
従車舵角変化パターンBに基づいてなされている。ま
た、連結部176を固定状態としている。図7より明ら
かなようにゴール地点122に到達する際に、長物17
1が道路形状150の境界と接触して不適な旋回条件で
ある。
Then, in step 101, after setting the road shape 150 and the initial position 121, step 10
5, a rudder angle change pattern such as the tractor rudder angle pattern A of FIG. 2 is set, and further, in step 113, a rudder angle change pattern of the following vehicle 172 that follows the tractor 170 is automatically generated. , A locus 120 as shown in FIG. 7 is obtained. At this time, the follower vehicle 172 is steered based on the automatically generated non-linear follower vehicle steering angle change pattern B of FIG. Further, the connecting portion 176 is in a fixed state. As is clear from FIG. 7, when the goal point 122 is reached, the long object 17
1 is an unsuitable turning condition because it contacts the boundary of the road shape 150.

【0091】次に、ユーザが、ステップ121で、追従
車172の舵角の変化パターンを線分としての追従車舵
角変化パターンC(図8参照)に修正すると、図9のよ
うな軌跡124が得られる。ここでは、連結部176を
回転可能としている。この場合はゴール地点125に到
達した際に、長物171及び追従車172が道路形状1
50の境界と接触してより不適な旋回条件であることが
わかる。
Next, in step 121, when the user corrects the change pattern of the steering angle of the following vehicle 172 to the following vehicle steering angle change pattern C (see FIG. 8) as a line segment, the locus 124 as shown in FIG. Is obtained. Here, the connecting portion 176 is rotatable. In this case, when the goal point 125 is reached, the long object 171 and the follower vehicle 172 make the road shape 1
It can be seen that the turning condition is more unfavorable by contacting the boundary of 50.

【0092】さらに、ユーザが、ステップ121で、追
従車172の舵角の変化パターンを線分の組合せとして
の追従車舵角変化パターンD(図8参照)に修正する
と、図10のような軌跡126が得られる。この場合は
ゴール地点127に到達した際に、トラクタ170,長
物171及び追従車172が道路形状150の境界と接
触せず、好適な旋回条件であることがわかる。
Further, when the user corrects the change pattern of the steering angle of the following vehicle 172 to the following vehicle steering angle change pattern D (see FIG. 8) as a combination of line segments in step 121, the locus as shown in FIG. 126 is obtained. In this case, when the goal point 127 is reached, the tractor 170, the long object 171, and the following vehicle 172 do not come into contact with the boundary of the road shape 150, and it is understood that the turning condition is suitable.

【0093】このようにして、ユーザ等が、操舵輪を有
する追従車を含む実際の連結車両に対応する条件を軌跡
出力装置1に入力することにより、実際の連結車両が走
行する際の軌跡を軌跡出力装置上1で取得でき、当該連
結車両の旋回可否の判断等が好適に行える。
In this way, the user or the like inputs the conditions corresponding to the actual connected vehicle including the follower vehicle having the steered wheels to the track output device 1, so that the track when the actual connected vehicle travels can be obtained. It can be acquired on the trajectory output device 1, and it is possible to suitably determine whether or not the connected vehicle can turn.

【0094】さらに、軌跡の出力結果に応じて、ユーザ
が、追従車172の操舵量の変化パターンの修正要求を
入力すると、追従車操舵パターン格納手段6に格納され
た操舵量の変化パターンが修正され、修正された追従車
172の操舵量の変化パターンに基づく連結車両130
の軌跡が再計算され出力される。これにより、追従車1
72の操舵量の変化パターンを変化させたときの連結車
両、特に、追従車171,172の軌跡の変化が容易に
確認され、連結車両130の軌跡を所望の道路領域内に
収めるために必要な、追従車の最適な操舵条件を容易に
取得できる。
Further, when the user inputs a correction request for the change pattern of the steering amount of the following vehicle 172 according to the output result of the locus, the change pattern of the steering amount stored in the following vehicle steering pattern storage means 6 is corrected. The combined vehicle 130 based on the corrected and modified steering amount change pattern of the following vehicle 172.
Is recalculated and output. As a result, the following vehicle 1
When the change pattern of the steering amount of 72 is changed, the change in the trajectory of the connected vehicle, particularly, the follower vehicles 171, 172 can be easily confirmed, and it is necessary for keeping the trajectory of the connected vehicle 130 within the desired road area. The optimum steering condition of the following vehicle can be easily acquired.

【0095】また、舵角の変化パターンを非線形な変化
パターンでなく線分の組合せとなるように修正すると、
実際の追従車等の舵角の操舵方法を定めるのに適する。
なお、追従車172の舵角の変化パターンDを、さら
に、この区間内で分割して点線200で示すような線分
の組合せの変化パターンにしたり、さらに、点線201
で示すように、舵角を不連続に変化させ、停止時にステ
アリング操作を行う条件を入力することもできる。ま
た、このような線形の区間を多数組み合わせることによ
って、非線形的な舵角の変化パターンを線分の組合せで
模擬するようにしてもよい。
If the steering angle change pattern is modified to be a combination of line segments instead of a non-linear change pattern,
It is suitable for determining the steering method of the steering angle of the actual following vehicle.
It should be noted that the change pattern D of the steering angle of the follower vehicle 172 is further divided within this section to form a change pattern of a combination of line segments as shown by a dotted line 200, or further, a dotted line 201.
As shown by, it is possible to change the steering angle discontinuously and input a condition for steering operation at the time of stop. Further, by combining a large number of such linear sections, a nonlinear steering angle change pattern may be simulated by a combination of line segments.

【0096】最後に、本発明の実施形態に係る軌跡出力
プログラム、及び当該軌跡出力プログラムを記録したコ
ンピュータ読み取り可能な記録媒体(以下、単に記録媒
体という)について説明する。
Finally, a trajectory output program according to the embodiment of the present invention and a computer-readable recording medium (hereinafter, simply referred to as a recording medium) recording the trajectory output program will be described.

【0097】ここで、記録媒体とは、コンピュータのハ
ードウェア資源に備えられている読み取り装置に対し
て、プログラムの記述内容に応じて、磁気、光、電気等
のエネルギーの変化状態を引き起こして、それに対応す
る信号の形式で、読み取り装置にプログラムの記述内容
を伝達できるものである。かかる記録媒体として は、
例えば、磁気ディスク、光ディスク、CD−ROM、コ
ンピュータに内蔵されるメモリなどが該当する。
Here, the recording medium causes a reading device provided in a hardware resource of a computer to cause a change state of energy such as magnetism, light, and electricity according to the description content of a program, The description content of the program can be transmitted to the reading device in the form of the corresponding signal. As such a recording medium,
For example, a magnetic disk, an optical disk, a CD-ROM, a memory built in a computer, or the like is applicable.

【0098】図11は、本発明の実施形態に係る記録媒
体の構成図である。記録媒体210は、図11に示すよ
うに、プログラムを記録するプログラム領域200aを
備えている。このプログラム領域200aには、軌跡出
力プログラム202が記録されている。
FIG. 11 is a block diagram of a recording medium according to the embodiment of the present invention. The recording medium 210 includes a program area 200a for recording a program, as shown in FIG. A locus output program 202 is recorded in the program area 200a.

【0099】この軌跡出力プログラム202は、上記の
軌跡出力の処理を実行するプログラムであって、処理を
統括するメインモジュール202aと、トラクタの舵角
の変化パターンを入力するためのトラクタ操舵パターン
入力モジュール202cと、追従車の舵角の変化パター
ンを入力するための追従車操舵パターン入力モジュール
202dと、トラクタの舵角の変化パターンと追従車の
舵角の変化パターンに応じて各々トラクタ及び追従車の
舵角を制御した場合の連結車両の軌跡を取得する軌跡取
得モジュール202eと、取得される軌跡をディスプレ
イ等に対して出力する出力モジュール202jと、マウ
スやキーボード等を介してユーザ等から追従車の舵角の
変化パターンを修正するための修正要求を入力させる追
従車操舵パターン修正情報入力モジュール202fと、
追従車に対する修正要求に基づいて追従車の舵角の変化
パターンを修正する追従車操舵パターン修正モジュール
202gと、マウスやキーボード等を介してユーザ等か
らトラクタの舵角の変化パターンを修正するための修正
要求を入力させるトラクタ操舵パターン修正情報入力モ
ジュール202hと、トラクタに対する修正要求に基づ
いてトラクタの舵角の変化パターンを修正するトラクタ
操舵パターン修正モジュール202iと、トラクタや追
従車を含む連結車両や走行条件等の種々のデータを入力
する連結車両データ入力モジュール202bと、走行可
能領域を設定する走行可能領域設定モジュール202k
と、を備えて構成される。
The locus output program 202 is a program for executing the above locus output processing, and includes a main module 202a for supervising the processing and a tractor steering pattern input module for inputting a change pattern of the steering angle of the tractor. 202c, a follower vehicle steering pattern input module 202d for inputting a change pattern of the steered angle of the follower vehicle, and a tractor and a follower vehicle according to the change pattern of the steered angle of the tractor and the follower vehicle, respectively. A trajectory acquisition module 202e that acquires a trajectory of the connected vehicle when the steering angle is controlled, an output module 202j that outputs the acquired trajectory to a display or the like, and a user or the like of the following vehicle via a mouse or a keyboard. Follower vehicle steering pattern to input a correction request to correct the steering angle change pattern And the positive information input module 202f,
A follower vehicle steering pattern correction module 202g that corrects the change pattern of the steered angle of the follower vehicle based on the correction request to the follower vehicle, and a user or the like for correcting the change pattern of the steered angle of the tractor via a mouse, a keyboard, or the like. A tractor steering pattern correction information input module 202h for inputting a correction request, a tractor steering pattern correction module 202i for correcting a change pattern of a steering angle of a tractor based on a correction request for a tractor, a connected vehicle including a tractor and a following vehicle, and traveling. Connected vehicle data input module 202b for inputting various data such as conditions, and drivable area setting module 202k for setting drivable area
And are configured.

【0100】また、追従車操舵パターン入力モジュール
202dは、ユーザからの指示に基づいて、追従車がト
ラクタに追従して走行するために必要な追従車の舵角の
変化パターンを自動的に生成し入力する基準追従車操舵
パターン生成モジュール212を備えている。ここで、
トラクタ操舵パターン入力モジュール202c、追従車
操舵パターン入力モジュール202d、軌跡取得モジュ
ール202e、出力モジュール202j、追従車操舵パ
ターン修正情報入力モジュール202f、追従車操舵パ
ターン修正モジュール202g、トラクタ操舵パターン
修正情報入力モジュール202h、トラクタ操舵パター
ン修正モジュール202i、連結車両データ入力モジュ
ール202b、走行可能領域設定モジュール202k、
基準追従車操舵パターン生成モジュール212をそれぞ
れを動作させることによって実現する機能は、上記軌跡
出力装置1の、トラクタ操舵パターン入力手段2、追従
車操舵パターン入力手段10、軌跡取得手段18、出力
手段20、追従車操舵パターン修正情報入力手段13、
追従車操舵パターン修正手段12、トラクタ操舵パター
ン修正情報入力手段5、トラクタ操舵パターン修正手段
3、連結車両データ入力手段14、走行可能領域設定手
段30と、基準追従車操舵パターン生成手段8それぞれ
の機能と同様である。
Further, the following vehicle steering pattern input module 202d automatically generates the change pattern of the steering angle of the following vehicle required for the following vehicle to travel following the tractor based on the instruction from the user. A reference following vehicle steering pattern generation module 212 for inputting is provided. here,
Tractor steering pattern input module 202c, following vehicle steering pattern input module 202d, trajectory acquisition module 202e, output module 202j, following vehicle steering pattern correction information input module 202f, following vehicle steering pattern correction module 202g, tractor steering pattern correction information input module 202h , A tractor steering pattern correction module 202i, a connected vehicle data input module 202b, a travelable area setting module 202k,
The function realized by operating each of the reference follower vehicle steering pattern generation modules 212 is the tractor steering pattern input means 2, the follower vehicle steering pattern input means 10, the trajectory acquisition means 18, and the output means 20 of the trajectory output device 1. , The following vehicle steering pattern correction information input means 13,
Functions of the following vehicle steering pattern correction means 12, the tractor steering pattern correction information input means 5, the tractor steering pattern correction means 3, the connected vehicle data input means 14, the drivable area setting means 30, and the reference following vehicle steering pattern generation means 8. Is the same as.

【0101】図12は、記録媒体210に記録された軌
跡出力プログラムを実行するためのコンピュータ(例え
ば図1の軌跡出力装置1に内蔵のコンピュータ)310
Sのシステム構成図である。コンピュータ310Sは、
軌跡出力プログラム202の実行等を制御するCPU3
17と、記録媒体210に記録された軌跡出力プログラ
ム202を読み取り可能な読み取り装置319と、メモ
リ318と、ディスプレイ等より成る表示部312と、
テンキーやマウス等より成る入力部311と、軌跡等を
紙等に印字出力するプリンタ313と、軌跡データ等を
外部に出力するためのFDD等の外部記憶装置315を
備えている。ここで、記録媒体210が読み取り装置3
19に挿入されると、記録媒体210に記録された情報
が読み取り装置319からアクセス可能となり、図11
に示す記録媒体210のプログラム領域200aに記録
された軌跡出力プログラム202が、コンピュータ31
0Sによって実行可能となる。
FIG. 12 shows a computer (for example, a computer built in the trajectory output device 1 in FIG. 1) 310 for executing the trajectory output program recorded in the recording medium 210.
It is a system configuration diagram of S. The computer 310S is
CPU 3 for controlling execution of the trajectory output program 202
17, a reading device 319 capable of reading the trajectory output program 202 recorded on the recording medium 210, a memory 318, and a display unit 312 including a display and the like,
An input unit 311 including a numeric keypad, a mouse, etc., a printer 313 for printing out loci etc. on paper etc., and an external storage device 315 such as an FDD for outputting locus data etc. to the outside are provided. Here, the recording medium 210 is the reading device 3
When inserted in the recording medium 210, the information recorded in the recording medium 210 becomes accessible from the reading device 319, and
The trajectory output program 202 recorded in the program area 200a of the recording medium 210 shown in FIG.
It becomes executable by 0S.

【0102】上記読み取り装置319としては、記録媒
体210に対応して、フレキシブルディスクドライブ装
置、CD−ROMドライブ装置、あるいは磁気テープド
ライブ装置などが用いられる。
As the reading device 319, a flexible disk drive device, a CD-ROM drive device, a magnetic tape drive device, or the like is used corresponding to the recording medium 210.

【0103】なお、本発明は、上記実施形態に限定され
るものではなく、種々の変形態様を取ることが可能であ
る。
The present invention is not limited to the above embodiment, and various modifications can be made.

【0104】また、上記実施形態では、車両に付属する
ものや荷物等が形成する走行軌跡を取得していないが、
連結車両データ入力手段14において、トラクタ170
等の外形形状として、さらに、バックミラー、クレーン
等の形状を設定し、これらのトラクタ等の車枠からはみ
出す部分も含めた走行軌跡を取得してもよい。これによ
り、バックミラー等の軌跡も考慮に入れた旋回可能性の
検討ができる。
Further, in the above-mentioned embodiment, the traveling loci formed by the objects attached to the vehicle and the luggage are not acquired.
In the connected vehicle data input means 14, the tractor 170
It is also possible to set the shape of a rearview mirror, a crane, and the like as the outer shape of the vehicle, etc., and acquire the traveling locus including the portion of the tractor or the like that protrudes from the vehicle frame. As a result, the possibility of turning can be examined in consideration of the locus of the rearview mirror and the like.

【0105】また、上記実施形態では、路面に投影され
た二次元的な軌跡を取得しているが、三次元の軌跡等を
取得してもよい。
In the above embodiment, the two-dimensional locus projected on the road surface is acquired, but a three-dimensional locus or the like may be acquired.

【0106】また、上記実施形態では、3両編成の連結
車両としているが、4両以上でも構わず、2両でも1両
でも構わず、また、操舵輪を有していない追従車を含ん
でもよい。
Further, in the above-mentioned embodiment, the combination vehicle of the three-car train is used, but it may be four or more cars, two cars or one car, and may include a follower car having no steering wheel. Good.

【0107】また、上記実施形態では、連結車両を一編
成のみ取り扱っているが、複数の連結車両を取り扱うこ
とも容易であり、これにより、例えば、連結車両同士が
すれ違う場合の軌跡等を検討することが出来る。
Further, in the above-mentioned embodiment, although only one formation of connected vehicles is handled, it is also easy to handle a plurality of connected vehicles. Therefore, for example, a trajectory when the connected vehicles pass each other is considered. You can

【0108】また、車両に関する種々のデータの設定が
可能であり、例えば、積載重量に応じて車軸を上昇・下
降させて車輪の接地・非接地が選択可能なリフトアクス
ル付きの車両に対応させる場合は、接地・非接地に応じ
て、軸間距離等を変更した上で軌跡を計算させればよ
い。
Further, various data relating to the vehicle can be set. For example, in the case where the vehicle is equipped with a lift axle in which the axle can be raised / lowered according to the loaded weight and the grounding / non-grounding of the wheels can be selected. Can be calculated by changing the inter-axis distance and the like according to the contact / non-contact.

【0109】[0109]

【発明の効果】上述のように、本発明によれば、仮想領
域内で、操舵輪を有する追従車を含む連結車両が、牽引
車及び追従車の操舵輪が所定の操舵量の変化パターンで
各々操舵されて走行する際の仮想の連結車両の軌跡が取
得され出力される。これにより、ユーザ等が、操舵輪を
有する追従車を含む実際の連結車両に対応する条件を入
力することにより、実際の連結車両が走行する際の軌跡
を取得でき、当該連結車両の旋回可否の判断等が好適に
行える。
As described above, according to the present invention, the connected vehicle including the follower vehicle having the steered wheels in the virtual region, the steered wheels of the towing vehicle and the follower vehicle having a predetermined steering amount change pattern. Virtual trajectories of the connected vehicles as they are steered and travel are acquired and output. Accordingly, the user or the like can acquire the trajectory when the actual connected vehicle travels by inputting the conditions corresponding to the actual connected vehicle including the follower vehicle having the steered wheels, and whether or not the connected vehicle can turn. The judgment etc. can be suitably performed.

【図面の簡単な説明】[Brief description of drawings]

【図1】本実施形態に係る軌跡出力装置のブロック図で
ある。
FIG. 1 is a block diagram of a trajectory output device according to the present embodiment.

【図2】トラクタ操舵パターン格納手段や追従車操舵パ
ターン格納手段に格納される舵角の変化パターンを示す
図である。
FIG. 2 is a diagram showing a change pattern of a steering angle stored in a tractor steering pattern storage means and a following vehicle steering pattern storage means.

【図3】第一の方法によって連結車両の軌跡を取得する
方法を説明する図である。
FIG. 3 is a diagram illustrating a method of acquiring a trajectory of a connected vehicle by a first method.

【図4】コーナリングフォースを説明する図である。FIG. 4 is a diagram illustrating a cornering force.

【図5】第二の方法によって連結車両の軌跡を取得する
方法を説明する図である。
FIG. 5 is a diagram illustrating a method of acquiring a trajectory of a connected vehicle by a second method.

【図6】本実施形態に係る軌跡出力装置のフローを示す
図である。
FIG. 6 is a diagram showing a flow of the trajectory output device according to the present embodiment.

【図7】軌跡出力装置から出力される軌跡を示す第一の
図である。
FIG. 7 is a first diagram showing a trajectory output from the trajectory output device.

【図8】追従車操舵パターン格納手段に格納された修正
された舵角の変化パターンを示す図である。
FIG. 8 is a diagram showing a modified steering angle change pattern stored in a following vehicle steering pattern storage means.

【図9】軌跡出力装置から出力される軌跡を示す第二の
図である。
FIG. 9 is a second diagram showing a trajectory output from the trajectory output device.

【図10】軌跡出力装置から出力される軌跡を示す第三
の図である。
FIG. 10 is a third diagram showing a trajectory output from the trajectory output device.

【図11】本実施形態に係る軌跡出力プログラムを示す
図である。
FIG. 11 is a diagram showing a trajectory output program according to the present embodiment.

【図12】本実施形態に係るコンピュータを示す図であ
る。
FIG. 12 is a diagram showing a computer according to the present embodiment.

【符号の説明】[Explanation of symbols]

1…軌跡出力装置、2…トラクタ操舵パターン入力手段
(牽引車操舵パターン入力手段)、3…トラクタ操舵パ
ターン修正手段、4…トラクタ操舵パターン格納手段
(牽引車操舵パターン格納手段)、5…トラクタ操舵パ
ターン修正情報入力手段(トラクタ操舵パターン修正要
求入力手段)、6…追従車操舵パターン格納手段、8…
基準追従車操舵パターン生成手段、10…追従車操舵パ
ターン入力手段、12…追従車操舵パターン修正手段、
13…追従車操舵パターン修正情報入力手段(追従車操
舵パターン修正要求入力手段)、18…軌跡取得手段、
20…出力手段。
DESCRIPTION OF SYMBOLS 1 ... Locus output device, 2 ... Tractor steering pattern input means (traction vehicle steering pattern input means), 3 ... Tractor steering pattern correction means, 4 ... Tractor steering pattern storage means (traction vehicle steering pattern storage means), 5 ... Tractor steering Pattern correction information input means (tractor steering pattern correction request input means), 6 ... Follower vehicle steering pattern storage means, 8 ...
Reference follower vehicle steering pattern generation means, 10 ... Follower vehicle steering pattern input means, 12 ... Follower vehicle steering pattern correction means,
13 ... Follower vehicle steering pattern correction information input means (following vehicle steering pattern correction request input means), 18 ... Trajectory acquisition means,
20 ... Output means.

Claims (22)

【特許請求の範囲】[Claims] 【請求項1】 仮想領域内で、操舵輪を有する牽引車と
操舵輪を有し前記牽引車に牽引される追従車とを含む仮
想の連結車両を走行させる際の軌跡を取得し出力装置に
出力する軌跡出力装置であって、前記走行の際に前記牽
引車の操舵輪及び前記追従車の操舵輪は、各々に対して
定められた操舵量の変化パターンに応じて各々操舵され
るものとされ、 前記牽引車の操舵輪を操舵させるべき操舵量の変化パタ
ーンが格納される牽引車操舵パターン格納手段と、 前記牽引車操舵パターン格納手段に前記牽引車の操舵量
の変化パターンを入力する牽引車操舵パターン入力手段
と、 前記追従車の操舵輪を操舵させるべき操舵量の変化パタ
ーンが格納される追従車操舵パターン格納手段と、 前記追従車操舵パターン格納手段に前記追従車の操舵量
の変化パターンを入力する追従車操舵パターン入力手段
と、 前記牽引車の操舵輪が前記牽引車操舵パターン格納手段
に格納された操舵量の変化パターンに応じて操舵され、
前記追従車の操舵輪が前記追従車操舵パターン格納手段
に格納された操舵量の変化パターンに応じて操舵され
て、前記連結車両が走行する際の前記連結車両の軌跡を
取得する軌跡取得手段と、 前記軌跡を前記出力装置に出力させる出力手段と、 を備えることを特徴とする、軌跡出力装置。
1. A locus when a virtual connected vehicle including a towing vehicle having steered wheels and a follower vehicle having the steered wheels and being towed by the towing vehicle is run in a virtual region, and is output to an output device. A trajectory output device for outputting, wherein the steered wheels of the towing vehicle and the steered wheels of the follower vehicle are steered in accordance with a change pattern of a steering amount defined for each of them during the traveling. And a towing vehicle steering pattern storing means for storing a variation pattern of the steering amount for steering the steered wheels of the towing vehicle, and a towing unit for inputting the variation pattern of the steering amount of the towing vehicle to the towing vehicle steering pattern storage means. A vehicle steering pattern input means, a following vehicle steering pattern storage means for storing a change pattern of a steering amount for steering the steered wheels of the following vehicle, and a following vehicle steering pattern storage means for changing the steering amount of the following vehicle. A follower wheel steering pattern input means for inputting the pattern, steered wheels of the towing vehicle is steered in accordance with the steering amount of change patterns stored in the towing vehicle steering pattern storage means,
Trajectory acquisition means for steering the steered wheels of the following vehicle in accordance with the change pattern of the steering amount stored in the following vehicle steering pattern storage means, and obtaining a trajectory of the connected vehicle when the connected vehicle travels; An output unit that outputs the trajectory to the output device, and a trajectory output device.
【請求項2】 前記追従車の操舵量の変化パターンに対
する修正要求を入力する追従車操舵パターン修正要求入
力手段と、前記追従車の操舵量の変化パターンに対する
修正要求に応じて前記追従車操舵パターン格納手段に格
納された操舵量の変化パターンを修正する追従車操舵パ
ターン修正手段と、を備えることを特徴とする、請求項
1に記載の軌跡出力装置。
2. A follower vehicle steering pattern correction request input means for inputting a correction request for a change pattern of the steering amount of the follower vehicle, and the follower vehicle steering pattern in response to the correction request for the change pattern of the steering amount of the follower vehicle. The trajectory output device according to claim 1, further comprising: a follower vehicle steering pattern correction unit that corrects a change pattern of the steering amount stored in the storage unit.
【請求項3】 前記追従車の操舵量の変化パターンは、
前記追従車の操舵輪の舵角の時間変化パターンであり、 前記追従車操舵パターン修正手段は、前記修正要求に応
じて、前記舵角が時間に応じて線形に変化する区間を複
数組み合わせたように前記時間変化パターンを修正する
ことを特徴とする、請求項1又は2に記載の軌跡出力装
置。
3. The change pattern of the steering amount of the following vehicle is:
It is a time change pattern of the steering angle of the steered wheels of the follower vehicle, wherein the follower vehicle steering pattern correction means combines a plurality of sections in which the steered angle linearly changes with time in response to the correction request. The trajectory output device according to claim 1 or 2, wherein the time change pattern is corrected according to the above.
【請求項4】 前記追従車の操舵量の変化パターンは、
前記追従車の操舵輪の舵角の走行距離に対する変化パタ
ーンであり、 前記追従車操舵パターン修正手段は、前記修正要求に応
じて、前記舵角が走行距離に応じて線形に変化する区間
を複数組み合わせたように前記変化パターンを修正する
ことを特徴とする、請求項1又は2に記載の軌跡出力装
置。
4. The change pattern of the steering amount of the following vehicle is:
It is a change pattern of the steering angle of the steered wheels of the follower vehicle with respect to the travel distance, and the follower vehicle steering pattern correction means has a plurality of sections in which the steered angle linearly changes according to the travel distance in response to the correction request. The trajectory output device according to claim 1 or 2, wherein the change pattern is modified as a combination.
【請求項5】 前記牽引車の操舵量の変化パターンに対
する修正要求を入力する牽引車操舵パターン修正要求入
力手段と、前記牽引車の操舵量の変化パターンに対する
修正要求に応じて前記牽引車操舵パターン格納手段に格
納された操舵量の変化パターンを修正する牽引車操舵パ
ターン修正手段と、 を備えることを特徴とする、請求項1〜4の何れか一項
に記載の軌跡出力装置。
5. A towing vehicle steering pattern correction request input means for inputting a correction request for a variation pattern of the steering amount of the towing vehicle, and the towing vehicle steering pattern according to the correction request for the variation pattern of the steering amount of the towing vehicle. The trajectory output device according to any one of claims 1 to 4, further comprising: a towing vehicle steering pattern correction unit that corrects a change pattern of the steering amount stored in the storage unit.
【請求項6】 前記追従車操舵パターン入力手段は、前
記追従車を前記牽引車に追従して走行させるために必要
な暫定的な追従車の操舵量の変化パターンを生成し前記
追従車操舵パターン格納手段に入力する基準追従車操舵
パターン生成手段を備えることを特徴とする、請求項1
〜5の何れか一項に記載の軌跡出力装置。
6. The follower vehicle steering pattern input means generates a temporary change pattern of the steering amount of the follower vehicle required for causing the follower vehicle to travel following the towing vehicle and generates the follower vehicle steering pattern. The reference following vehicle steering pattern generation means for inputting to the storage means is provided.
The trajectory output device according to any one of 5 to 5.
【請求項7】 前記軌跡取得手段は、コーナリングフォ
ースを考慮した運動方程式に基づいて前記軌跡を取得す
ることを特徴とする、請求項1〜6の何れか一項に記載
の軌跡出力装置。
7. The trajectory output device according to claim 1, wherein the trajectory acquisition unit acquires the trajectory based on a motion equation in which a cornering force is taken into consideration.
【請求項8】 仮想領域内で、操舵輪を有する牽引車と
操舵輪を有し前記牽引車に牽引される追従車とを含む仮
想の連結車両を走行させる際の軌跡を取得し出力装置に
出力する軌跡出力方法であって、前記走行の際に前記牽
引車の操舵輪及び前記追従車の操舵輪は、各々に対して
定められた操舵量の変化パターンに応じて各々操舵され
るものとされ、 前記牽引車の操舵輪を操舵させるべき操舵量の変化パタ
ーンを入力する牽引車操舵パターン入力ステップと、 前記追従車の操舵輪を操舵させるべき操舵量の変化パタ
ーンを入力する追従車操舵パターン入力ステップと、 前記牽引車の操舵輪が前記牽引車の操舵量の変化パター
ンに応じて操舵され、前記追従車の操舵輪が前記追従車
の操舵量の変化パターンに応じて操舵されて、前記連結
車両が走行する際の前記連結車両の軌跡を取得する軌跡
取得ステップと、 前記軌跡を前記出力装置に出力させる軌跡出力ステップ
と、 を含むことを特徴とする、軌跡取得方法。
8. A locus when a virtual connected vehicle including a towing vehicle having steered wheels and a follower vehicle having the steered wheels and towed by the towed vehicle is traveled in a virtual region and is output to an output device. A trajectory output method for outputting, wherein the steered wheels of the towing vehicle and the steered wheels of the following vehicle are steered in accordance with a change pattern of a steering amount defined for each of them during the traveling. A towing vehicle steering pattern input step for inputting a change pattern of a steering amount for steering the steered wheels of the towing vehicle; and a following vehicle steering pattern for inputting a change pattern of a steering amount for steering the steered wheels of the following vehicle. An input step, the steered wheels of the towing vehicle are steered according to a change pattern of the steering amount of the towing vehicle, and the steered wheels of the following vehicle are steered according to the change pattern of the steering amount of the following vehicle, Connected vehicle A trajectory acquisition method, comprising: a trajectory acquisition step of acquiring a trajectory of the connected vehicle when traveling, and a trajectory output step of causing the output device to output the trajectory.
【請求項9】 前記追従車の操舵量の変化パターンに対
する修正要求を入力する追従車操舵パターン修正要求入
力ステップと、前記追従車の操舵量の変化パターンに対
する修正要求に応じて前記追従車の操舵量の変化パター
ンを修正する追従車操舵パターン修正ステップと、 を含むことを特徴とする、請求項8に記載の軌跡出力方
法。
9. A follow-up vehicle steering pattern correction request input step for inputting a correction request for the change pattern of the steering amount of the follow-up vehicle, and steering of the follow-up vehicle in response to the correction request for the change pattern of the steering amount of the follow-up vehicle. 9. The trajectory output method according to claim 8, further comprising a following vehicle steering pattern correction step of correcting a change pattern of the quantity.
【請求項10】 前記追従車の操舵量の変化パターン
は、前記追従車の操舵輪の舵角の時間変化パターンであ
り、 前記追従車操舵パターン修正ステップは、前記修正要求
に応じて、前記舵角が時間に応じて線形に変化する区間
を複数組み合わせたように前記時間変化パターンを修正
することを特徴とする、請求項8又は9に記載の軌跡出
力方法。
10. The change pattern of the steering amount of the following vehicle is a time change pattern of the steering angle of the steered wheels of the following vehicle, and the following vehicle steering pattern correction step responds to the correction request by the steering wheel. The trajectory output method according to claim 8 or 9, wherein the time change pattern is modified so that a plurality of sections in which an angle changes linearly with time are combined.
【請求項11】 前記追従車の操舵量の変化パターン
は、前記追従車の操舵輪の舵角の走行距離に対する変化
パターンであり、 前記追従車操舵パターン修正ステップは、前記修正要求
に応じて、前記舵角が走行距離に応じて線形に変化する
区間を複数組み合わせたように前記変化パターンを修正
することを特徴とする、請求項8又は9に記載の軌跡出
力方法。
11. The change pattern of the steering amount of the follower vehicle is a change pattern of the steering angle of the steered wheels of the follower vehicle with respect to the traveling distance, and the follower vehicle steering pattern correction step is performed in response to the correction request. 10. The trajectory output method according to claim 8, wherein the change pattern is corrected so that a plurality of sections in which the steering angle linearly changes according to a travel distance are combined.
【請求項12】 前記牽引車の操舵量の変化パターンに
対する修正要求を入力する牽引車操舵パターン修正要求
入力ステップと、前記牽引車の操舵量の変化パターンに
対する修正要求に応じて前記牽引車の操舵量の変化パタ
ーンを修正する牽引車操舵パターン修正ステップと、 を含むことを特徴とする、請求項8〜11の何れか一項
に記載の軌跡出力方法。
12. A towing vehicle steering pattern correction request input step for inputting a correction request for a variation pattern of the steering amount of the towing vehicle, and steering of the towing vehicle in response to the correction request for a variation pattern of the steering amount of the towing vehicle. The trajectory output method according to any one of claims 8 to 11, further comprising: a towing vehicle steering pattern correction step of correcting a variation pattern of the amount.
【請求項13】 前記追従車操舵パターン入力ステップ
において、前記追従車を前記牽引車に追従して走行させ
るために必要な暫定的な追従車の操舵量の変化パターン
を生成し前記追従車を操舵させるべき操舵量の変化パタ
ーンとする基準追従車操舵パターン生成ステップを含む
ことを特徴とする、請求項8〜12の何れか一項に記載
の軌跡出力方法。
13. In the following vehicle steering pattern input step, a temporary change pattern of the steering amount of the following vehicle required to drive the following vehicle to follow the towing vehicle is generated to steer the following vehicle. The trajectory output method according to any one of claims 8 to 12, comprising a reference follower vehicle steering pattern generation step that is a change pattern of a steering amount to be performed.
【請求項14】 前記軌跡取得ステップは、コーナリン
グフォースを考慮した運動方程式に基づいて前記軌跡を
取得することを特徴とする、請求項8〜13の何れか一
項に記載の軌跡出力方法。
14. The trajectory output method according to claim 8, wherein the trajectory acquisition step acquires the trajectory based on a motion equation in which a cornering force is taken into consideration.
【請求項15】 仮想領域内で、操舵輪を有する牽引車
と操舵輪を有し前記牽引車に牽引される追従車とを含む
仮想の連結車両を走行させる際の軌跡を取得し出力装置
に出力する軌跡出力プログラムであって、前記走行の際
に前記牽引車の操舵輪及び前記追従車の操舵輪は、各々
に対して定められた操舵量の変化パターンに応じて各々
操舵されるものとされ、 コンピュータに、 前記牽引車の操舵輪を操舵させるべき操舵量の変化パタ
ーンを入力する牽引車操舵パターン入力ステップと、 前記追従車の操舵輪を操舵させるべき操舵量の変化パタ
ーンを入力する追従車操舵パターン入力ステップと、 前記牽引車の操舵輪が前記牽引車の操舵量の変化パター
ンに応じて操舵され、前記追従車の操舵輪が前記追従車
の操舵量の変化パターンに応じて操舵されて、前記連結
車両が走行する際の前記連結車両の軌跡を取得する軌跡
取得ステップと、 前記軌跡を前記出力装置に出力させる軌跡出力ステップ
と、 を実行させることを特徴とする、軌跡取得プログラム。
15. A locus when a virtual connected vehicle including a towing vehicle having steered wheels and a follower vehicle having the steered wheels and towed by the towing vehicle is traveled in a virtual region and is output to an output device. A trajectory output program to be output, wherein the steered wheels of the towing vehicle and the steered wheels of the following vehicle are each steered in accordance with a change pattern of a steering amount defined for each of the traveling wheels. A steering vehicle steering pattern input step of inputting to the computer a change pattern of a steering amount for steering the steered wheels of the towing vehicle, and a follow-up inputting a change pattern of the steering amount for steering the steered wheels of the following vehicle. A vehicle steering pattern input step, the steered wheels of the towing vehicle are steered according to a change pattern of the steering amount of the towing vehicle, and the steered wheels of the follower vehicle according to the change pattern of the steering amount of the follower vehicle. A trajectory acquisition step of acquiring a trajectory of the connected vehicle when the connected vehicle travels by being steered, and a trajectory output step of causing the output device to output the trajectory, program.
【請求項16】 前記追従車の操舵量の変化パターンに
対する修正要求を入力する追従車操舵パターン修正要求
入力ステップと、前記追従車の操舵量の変化パターンに
対する修正要求に応じて前記追従車の操舵量の変化パタ
ーンを修正する追従車操舵パターン修正ステップと、 をさらに前記コンピュータに実行させることを特徴とす
る、請求項15に記載の軌跡出力プログラム。
16. A follow-up vehicle steering pattern correction request input step for inputting a correction request for a change pattern of the steering amount of the follow-up vehicle, and steering of the follow-up vehicle according to the correction request for the change pattern of the steering amount of the follow-up vehicle. 16. The trajectory output program according to claim 15, further comprising: a following vehicle steering pattern correction step of correcting a change pattern of the quantity, the step of:
【請求項17】 前記追従車の操舵量の変化パターン
は、前記追従車の操舵輪の舵角の時間変化パターンであ
り、 前記追従車操舵パターン修正ステップは、前記修正要求
に応じて、前記舵角が時間に応じて線形に変化する区間
を複数組み合わせたように前記時間変化パターンを修正
することを特徴とする、請求項15又は16に記載の軌
跡出力プログラム。
17. The change pattern of the steering amount of the following vehicle is a time change pattern of the steering angle of the steered wheels of the following vehicle, and the following vehicle steering pattern correction step responds to the correction request by the steering wheel. The trajectory output program according to claim 15 or 16, wherein the time change pattern is modified so that a plurality of sections in which an angle changes linearly with time are combined.
【請求項18】 前記追従車の操舵量の変化パターン
は、前記追従車の操舵輪の舵角の走行距離に対する変化
パターンであり、 前記追従車操舵パターン修正ステップは、前記修正要求
に応じて、前記舵角が走行距離に応じて線形に変化する
区間を複数組み合わせたように前記変化パターンを修正
することを特徴とする、請求項15又は16に記載の軌
跡出力プログラム。
18. The change pattern of the steering amount of the follower vehicle is a change pattern of the steering angle of the steered wheels of the follower vehicle with respect to the travel distance, and the follower vehicle steering pattern correction step is performed in response to the correction request. The trajectory output program according to claim 15 or 16, wherein the change pattern is corrected so that a plurality of sections in which the steering angle linearly changes according to a travel distance are combined.
【請求項19】 前記牽引車の操舵量の変化パターンに
対する修正要求を入力する牽引車操舵パターン修正要求
入力ステップと、前記牽引車の操舵量の変化パターンに
対する修正要求に応じて前記牽引車の操舵量の変化パタ
ーンを修正する牽引車操舵パターン修正ステップと、 を前記コンピュータにさらに実行させることを特徴とす
る、請求項15〜18の何れか一項に記載の軌跡出力プ
ログラム。
19. A towing vehicle steering pattern correction request input step for inputting a correction request for a change pattern of the steering amount of the towing vehicle, and steering of the towing vehicle in response to the correction request for the changing pattern of the steering amount of the towing vehicle. The trajectory output program according to any one of claims 15 to 18, further comprising: a towing vehicle steering pattern correction step of correcting a variation pattern of the amount.
【請求項20】 前記追従車操舵パターン入力ステップ
において、前記追従車を前記牽引車に追従して走行させ
るために必要な暫定的な追従車の操舵量の変化パターン
を生成し前記追従車を操舵させるべき操舵量の変化パタ
ーンとする基準追従車操舵パターン生成ステップを含む
ことを特徴とする、請求項15〜19の何れか一項に記
載の軌跡出力プログラム。
20. In the following vehicle steering pattern input step, a temporary change pattern of the steering amount of the following vehicle required to drive the following vehicle to follow the towing vehicle is generated to steer the following vehicle. 20. The trajectory output program according to claim 15, further comprising a reference follower vehicle steering pattern generation step that is a change pattern of a steering amount to be performed.
【請求項21】 前記軌跡取得ステップは、コーナリン
グフォースを考慮した運動方程式に基づいて前記軌跡を
取得することを特徴とする、請求項15〜20の何れか
一項に記載の軌跡出力プログラム。
21. The trajectory output program according to claim 15, wherein the trajectory acquisition step acquires the trajectory based on a motion equation in which a cornering force is taken into consideration.
【請求項22】 請求項15〜21の何れか1項に記載
の軌跡出力プログラムが記録されたことを特徴とする記
録媒体。
22. A recording medium on which the locus output program according to claim 15 is recorded.
JP2002148095A 2002-05-22 2002-05-22 Trajectory output device, trajectory output method, trajectory output program, and recording medium Expired - Fee Related JP3906109B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2002148095A JP3906109B2 (en) 2002-05-22 2002-05-22 Trajectory output device, trajectory output method, trajectory output program, and recording medium

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2002148095A JP3906109B2 (en) 2002-05-22 2002-05-22 Trajectory output device, trajectory output method, trajectory output program, and recording medium

Publications (2)

Publication Number Publication Date
JP2003344226A true JP2003344226A (en) 2003-12-03
JP3906109B2 JP3906109B2 (en) 2007-04-18

Family

ID=29766816

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2002148095A Expired - Fee Related JP3906109B2 (en) 2002-05-22 2002-05-22 Trajectory output device, trajectory output method, trajectory output program, and recording medium

Country Status (1)

Country Link
JP (1) JP3906109B2 (en)

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0472079U (en) * 1990-11-06 1992-06-25
JPH11211626A (en) * 1998-01-26 1999-08-06 Tokyu Car Corp Apparatus for testing running possibility of automobile and recording medium
JP2000329657A (en) * 1999-05-19 2000-11-30 Unisia Jecs Corp Simulation apparatus and method and recording medium recorded control program for simulation
JP2001310651A (en) * 2000-02-24 2001-11-06 Toyota Motor Corp Automatic travel joint vehicle and method of travel direction change

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0472079U (en) * 1990-11-06 1992-06-25
JPH11211626A (en) * 1998-01-26 1999-08-06 Tokyu Car Corp Apparatus for testing running possibility of automobile and recording medium
JP2000329657A (en) * 1999-05-19 2000-11-30 Unisia Jecs Corp Simulation apparatus and method and recording medium recorded control program for simulation
JP2001310651A (en) * 2000-02-24 2001-11-06 Toyota Motor Corp Automatic travel joint vehicle and method of travel direction change

Also Published As

Publication number Publication date
JP3906109B2 (en) 2007-04-18

Similar Documents

Publication Publication Date Title
EP2997429B1 (en) Method for assisting the reversal of an articulated vehicle
EP2928755B1 (en) Method for determining a maximum speed limit for a reversing vehicle combination
US9174674B2 (en) Parking assisting apparatus
US20180111621A1 (en) Control method using trailer yaw rate measurements for trailer backup assist
JPH09267762A (en) Trailer wheel steering control method and its device
CN107738691A (en) A kind of 4 wheel driven composite turning system and its Multipurpose Optimal Method in good time
CN107000741A (en) For the method and apparatus for the maneuvering performance for improving car group
Choi et al. The performance of independent wheels steering vehicle (4WS) applied Ackerman geometry
CN102730059B (en) Method for the control function of the feedforward control steering that generates motor vehicles
CN108749919A (en) A kind of line traffic control Four wheel independent steering system fault-tolerant control system and its control method
CN106274907A (en) A kind of many trains splice angle vision measurement optimization method based on Kalman filtering
CN112026749B (en) Stability control method for wire-controlled steering system
CN111824260B (en) Semi-trailer with rear wheels having reversing power and reversing method
CN110077459B (en) Electric power steering and distributed driving integrated control system and method
Tan et al. Design and development of a novel autonomous scaled multiwheeled vehicle
JP3906109B2 (en) Trajectory output device, trajectory output method, trajectory output program, and recording medium
Notsu et al. Investigation into turning behavior of semi-trailer with additional trailer-wheel steering--a control method for trailer-wheel steering to minimize trailer rear-overhang swing in short turns
CN114291117A (en) Four-wheel steering unmanned vehicle trajectory tracking control method
JP2023003050A (en) Retreat control device of combination vehicle and retreat control program of combination vehicle
CN115848404A (en) Articulated vehicle control method and articulated vehicle
JPH09286346A (en) Control method for steering wheel of coupled vehicle
Kim et al. Development of Novel Steering Scenarios for an 8X8 Scaled Electric Combat Vehicle
Alamdari Milani Modeling, simulation, and active control of tractor-semitrailer combinations
Schein Optimal Vehicle Control of Four-Wheel Steering
JP3547806B2 (en) Vehicle steering characteristic control method

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20040617

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20051215

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20060509

A521 Written amendment

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20060706

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: 20070109

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20070115

R150 Certificate of patent or registration of utility model

Free format text: JAPANESE INTERMEDIATE CODE: R150

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20100119

Year of fee payment: 3

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20110119

Year of fee payment: 4

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20110119

Year of fee payment: 4

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20120119

Year of fee payment: 5

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20120119

Year of fee payment: 5

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20130119

Year of fee payment: 6

S111 Request for change of ownership or part of ownership

Free format text: JAPANESE INTERMEDIATE CODE: R313111

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20130119

Year of fee payment: 6

R350 Written notification of registration of transfer

Free format text: JAPANESE INTERMEDIATE CODE: R350

S533 Written request for registration of change of name

Free format text: JAPANESE INTERMEDIATE CODE: R313533

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20130119

Year of fee payment: 6

R350 Written notification of registration of transfer

Free format text: JAPANESE INTERMEDIATE CODE: R350

LAPS Cancellation because of no payment of annual fees