JP4041911B2 - Steering control method for four-wheel independent steering vehicle - Google Patents
Steering control method for four-wheel independent steering vehicle Download PDFInfo
- Publication number
- JP4041911B2 JP4041911B2 JP2004261298A JP2004261298A JP4041911B2 JP 4041911 B2 JP4041911 B2 JP 4041911B2 JP 2004261298 A JP2004261298 A JP 2004261298A JP 2004261298 A JP2004261298 A JP 2004261298A JP 4041911 B2 JP4041911 B2 JP 4041911B2
- Authority
- JP
- Japan
- Prior art keywords
- steering
- wheel
- command value
- alpha
- center point
- 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.)
- Expired - Fee Related
Links
Images
Landscapes
- Steering-Linkage Mechanisms And Four-Wheel Steering (AREA)
- Steering Control In Accordance With Driving Conditions (AREA)
Description
この発明は、4輪独立操舵で走行する車両(殊に電気移動車両)の操舵制御方法に関するもので、車両を走行させる施設の通路形態や通路周縁の物体の配置状況に適応する操舵モードで車両を円滑・安全に走行させるための車両の操舵制御方法に関するものである。なお、この発明において「操舵モード」とは、操舵によって車両の各車輪が描く軌跡のパターンを意味する。 The present invention relates to a steering control method for a vehicle (especially an electric mobile vehicle) that travels by four-wheel independent steering, and the vehicle is operated in a steering mode that adapts to the path configuration of a facility where the vehicle is traveling and the arrangement of objects around the path. The present invention relates to a vehicle steering control method for smoothly and safely traveling a vehicle. In the present invention, the “steering mode” means a trace pattern drawn by each wheel of the vehicle by steering.
医療機関、福祉施設、工場、物流基地、コンピュータ格納ビル、大型商業施設、図書館、スポーツ・娯楽施設、遊園地などの各種の屋内外施設で走行させる4輪独立操舵車両に関して、複数種類の操舵モードを用意し、車両の始動ならびに走行過程で、それら複数種類の操舵モードの中から、その屋内外施設の通路形態や通路周縁の物体の配置状況に応じて、適切な操舵モードを選択しで4輪独立操舵の電気移動車両を走行制御する方法が、既に特開2003−146234号公開特許公報(特許文献1)で提案されている。また、上記の選択された一つの操舵モードにおいて独立操舵4輪の各車輪の操舵角度α1,α2,α3,α4変化させる過程で、左右の車輪に関する所謂「開閉脚現象」を防止して安全走行を図るための手段が特願2003−136158号特許出願明細書(特許文献2)で提示された。なお「開閉脚現象」とは、左右両車輪の相互の向きが車両の進行方向に対して先拡がり状態となる開脚現象と、左右両車輪の相互の向きが車両の進行方向に対して先すぼみ状態となる閉脚現象の両現象を総称したものである。 Multiple steering modes for four-wheel independent steering vehicles running in various indoor and outdoor facilities such as medical institutions, welfare facilities, factories, distribution bases, computer storage buildings, large commercial facilities, libraries, sports / entertainment facilities, amusement parks, etc. In the starting and running process of the vehicle, an appropriate steering mode is selected from among the plurality of types of steering modes according to the path configuration of the indoor / outdoor facilities and the arrangement situation of objects around the path. A method for traveling control of an electric vehicle with wheel independent steering has already been proposed in Japanese Patent Laid-Open No. 2003-146234 (Patent Document 1). Further, in the process of changing the steering angles α 1 , α 2 , α 3 , α 4 of the four independently steered wheels in the selected one steering mode, the so-called “open / close leg phenomenon” relating to the left and right wheels is prevented. Thus, a means for safe driving was presented in Japanese Patent Application No. 2003-136158 (Patent Document 2). The "open / close leg phenomenon" refers to an open leg phenomenon in which the mutual orientation of the left and right wheels is expanded with respect to the traveling direction of the vehicle, and the mutual orientation of the left and right wheels precedes the traveling direction of the vehicle. It is a collective term for both the closed-leg phenomenon that causes a sag.
すなわち、特開2003−146234号公開特許公報(特許文献1)には、左右の前車輪と左右の後車輪がそれぞれ個別の操舵モータによって操舵制御される電気移動車両を、幾つかの種類の異なる操舵モードで操舵することが示され、操舵モードの事例として、右後車輪の走行軌跡と左後車輪の走行軌跡がそれぞれ右前車輪の走行軌跡と左前車輪の走行軌跡に追従する操舵モードM1(特許文献1の図3参照)、前車輪の旋回軌跡に対し後車輪の旋回軌跡がいわゆる内輪差軌跡となる操舵モードM3(特許文献1の図5参照)、右後車輪を中心として車両を右回りに旋回させあるいは左後車輪を中心として車両を左回りに旋回させる操舵モードM4(特許文献1の図6参照)、右前車輪を中心として車両を右回りに旋回させあるいは左前車輪を中心として車両を左回りに旋回させる操舵モードM5(特許文献1の図7参照)が示されており、操舵モードM1,M3,M4,M5の中から通路の形態や通路周囲の状況に適合する操舵モードを選定し、その選定した操舵モードの形成に必要な各車輪の操舵角度α1,α2,α3,α4を操舵拘束条件式(略して「条件式」ともいう)に従って演算し、その操舵角度α1,α2,α3,α4を基に各車輪の操舵モータの回転を制御して車両を操舵制御する方法が示されている。 That is, Japanese Patent Laid-Open No. 2003-146234 (Patent Document 1) discloses several types of electric mobile vehicles in which left and right front wheels and left and right rear wheels are respectively steering-controlled by individual steering motors. Steering mode is shown. As an example of the steering mode, a steering mode M 1 (where the traveling locus of the right rear wheel and the traveling locus of the left rear wheel follow the traveling locus of the right front wheel and the traveling locus of the left front wheel, respectively. FIG. 3 of Patent Document 1), steering mode M 3 in which the turning trajectory of the rear wheel becomes a so-called inner wheel difference trajectory with respect to the trajectory of the front wheel (see FIG. 5 of Patent Document 1), and the vehicle centering on the right rear wheel. steering mode M 4 the vehicle is steered counterclockwise around the or left rear wheel to pivot clockwise (see FIG. 6 of Patent Document 1), or to turn the vehicle to the right direction around the front right wheel Are shown steering mode M 5 turn the vehicle around the front wheel counterclockwise (see FIG. 7 of Patent Document 1), the steering mode M 1, M 3, M 4, passages in the form from the M 5 And a steering mode suitable for the situation around the passage and the steering angle α 1 , α 2 , α 3 , α 4 of each wheel necessary for the formation of the selected steering mode is determined as a steering constraint condition equation (abbreviated as “condition”). A method is shown in which the vehicle is steered by controlling the rotation of the steering motor of each wheel based on the steering angles α 1 , α 2 , α 3 , α 4 .
そして、上記の各操舵モードを形成するために必用な各車輪(右前車輪P1,左前車輪P2,右後車輪P3,左後車輪P4)の操舵角度α1,α2,α3,α4についての操舵拘束条件式として、次の諸式が示されている。
操舵モードM1に対して(特許文献1の図1、図3参照):
・・・・・式(E11)
・・・・・式(E12)
操舵モードM3に対して(特許文献1の図1、図5参照):
・・・・・式(E31)
・・・・・式(E32)
・・・・・式(E33)
操舵モードM4に対して(特許文献1の図1、図6参照):
右旋回時において、
・・・・・式(E41)
・・・・・式(E42)
・・・・・式(E43)
左旋回時において、
・・・・・式(E45)
・・・・・式(E46)
・・・・・式(E47)
操舵モードM5に対して(特許文献1の図1、図7参照):
右旋回時において、
・・・・・式(E51)
・・・・・式(E52)
・・・・・式(E53)
左旋回時において、
・・・・・式(E55)
・・・・・式(E56)
・・・・・式(E57)
なお上記条件式において、
α1:右前車輪に対する操舵角度.
α2:左前車輪に対する操舵角度.
α3:右後車輪に対する操舵角度.
α4:左後車輪に対する操舵角度.
L :前車輪と後車輪の間の中心線Xと各車輪の間の距離.
W :車輪と左車輪の間の中心線Yと各車輪の間の距離.
R :各車輪の旋回軌跡が同心円弧となる場合の、同心円弧の中心と、各車輪の位置に対する中心点の間の距離.(車両の中心から車両の旋回中心までの距離)(すなわち車両の旋回半径)
Then, the steering angles α 1 , α 2 , α 3 of the respective wheels (right front wheel P 1 , left front wheel P 2 , right rear wheel P 3 , left rear wheel P 4 ) necessary for forming each steering mode described above. , as the steering constraint condition equations for alpha 4, are shown the following Shoshiki.
For the steering mode M1 (see FIGS. 1 and 3 of Patent Document 1):
... Formula (E11)
... Formula (E12)
For the steering mode M3 (see FIGS. 1 and 5 of Patent Document 1):
... Formula (E31)
... Formula (E32)
... Formula (E33)
For the steering mode M4 (see FIGS. 1 and 6 of Patent Document 1):
When turning right,
... Formula (E41)
... Formula (E42)
... Formula (E43)
When turning left,
... Formula (E45)
... Formula (E46)
... Formula (E47)
For the steering mode M5 (see FIGS. 1 and 7 of Patent Document 1):
When turning right,
... Formula (E51)
... Formula (E52)
... Formula (E53)
When turning left,
... Formula (E55)
... Formula (E56)
... Formula (E57)
In the above conditional expression,
α 1 : Steering angle with respect to the right front wheel.
α 2 : Steering angle with respect to the left front wheel.
α 3 : Steering angle with respect to the right rear wheel.
α 4 : Steering angle with respect to the left rear wheel.
L: Distance between the center line X between the front wheel and the rear wheel and each wheel.
W: Distance between the center line Y between the wheel and the left wheel and each wheel.
R: Distance between the center of the concentric arc and the center point with respect to the position of each wheel when the turning trajectory of each wheel is a concentric arc. (Distance from vehicle center to vehicle turning center) (ie vehicle turning radius)
一方、車両の進行方向を変えるために、距離(車両の旋回半径)Rを操舵指令値として、操舵指令値Rを増加あるいは減少させることにより、上記の操舵拘束条件式に従って各車輪の操舵角度α1,α2,α3,α4を減少あるいは増加させて車両の進行方向を変える場合に、操舵指令値Rを現在の操舵指令値R1から所望の操舵指令値R2へ設定を変えても、各車輪の操舵角度α1,α2,α3,α4が操舵拘束条件式で規定される新たな操舵角度に到達する迄に若干の時間差(操舵指令追随時間)があることから、その操舵指令追随時間の間の操舵過程において、左右両車輪の相互の向きが車両の進行方向に対し先拡がり状態となる開脚現象や、左右両車輪の相互の向きが車両の進行方向に対し先すぼみ状態となる閉脚現象が生じ、その開閉脚現象によって操舵機構に無理な力が加わって故障の原因になったり、車両上の人や物の安定性が損なわれる危惧が伴う。 On the other hand, in order to change the traveling direction of the vehicle, by using the distance (turning radius of the vehicle) R as the steering command value and increasing or decreasing the steering command value R, the steering angle α of each wheel according to the steering constraint condition formula described above. When changing the traveling direction of the vehicle by decreasing or increasing 1 , 1 , 2 , 3 , 4 , the setting of the steering command value R is changed from the current steering command value R 1 to the desired steering command value R 2 . Since there is a slight time difference (steering command following time) until the steering angle α 1 , α 2 , α 3 , α 4 of each wheel reaches a new steering angle defined by the steering constraint conditional expression, In the steering process during the steering command follow time, the left and right wheels are in a state where the mutual orientation of the left and right wheels spreads out with respect to the traveling direction of the vehicle, and the mutual orientation of the left and right wheels is relative to the traveling direction of the vehicle. A closed leg phenomenon occurs that becomes a pointed state Or causing the failure opening and closing the legs phenomenon by and excessive force is applied to the steering mechanism, accompanied by fear that stability of the person or object on the vehicle may be impaired.
この開閉脚現象の防止するために、上記の特願2003−136158号特許出願では、選択した操舵モードを形成するための操舵拘束条件式に従って各車輪の各操舵角度α1,α2,α3,α4を個別に制御して車両の走行方向を変える操舵制御において、各車輪の旋回軌跡が同心円弧となる場合の同心円弧の中心点と各車輪の位置に対する中心点の間の距離Rを操舵指令値とし、その操舵指令値RをR1からR2へ変えて、各車輪の操舵角度α1,α2,α3,α4を、操舵指令値R1に対応する各操舵角度[α1,α2,α3,α4]R1 から操舵指令値R2に対応する各操舵角度[α1,α2,α3,α4]R2 へ移行する過程で、操舵指令値R1に微小操舵指令値ΔRを加えた操舵指令値(R1+ΔR)に対して前記操舵拘束条件式を満たす微小移行操舵角度[α1,α2,α3,α4](R1+ΔR) を演算し、その微小移行操舵角度[α1,α2,α3,α4](R1+ΔR) に向けて各操舵角度α1,α2,α3,α4を変化させ、各操舵角度α1,α2,α3,α4が前記微小移行操舵角度[α1,α2,α3,α4](R1+ΔR) に到達して舵角整合したことを検知した後、前記操舵指令値(R1+ΔR)に更に微小操舵指令値ΔRを加えた操舵指令値(R1+2ΔR)に対して前記操舵拘束条件式を満たす微小移行操舵角度[α1,α2,α3,α4](R1+2ΔR) を演算し、その微小移行操舵角度[α1,α2,α3,α4](R1+2ΔR) に向けて各操舵角度α1,α2,α3,α4を変化させ、以後同様に、各車輪の操舵角度α1,α2,α3,α4が舵角整合したことを検知した後、微小操舵指令値ΔRを順次加えた操舵指令値(R1+nΔR)に対して前記操舵拘束条件式を満たす微小移行操舵角度[α1,α2,α3,α4](R1+nΔR) を演算し、その微小移行操舵角度[α1,α2,α3,α4](R1+nΔR) に向けて各操舵角度α1,α2,α3,α4を変化させ、各操舵角度α1,α2,α3,α4が微小移行操舵角度[α1,α2,α3,α4](R1+nΔR) に到達して舵角整合したことの検知を繰り返して、各車輪の操舵角度α1,α2,α3,α4をそれぞれ各操舵角度[α1,α2,α3,α4](R1) から各操舵角度[α1,α2,α3,α4](R2) へ変化させるようにした4輪独立操舵車両の操舵制御方法が提案されている。 In order to prevent this open / close leg phenomenon, in the above-mentioned Japanese Patent Application No. 2003-136158, the steering angles α 1 , α 2 , α 3 of the respective wheels according to the steering constraint condition formula for forming the selected steering mode. , Α 4 individually, in steering control to change the traveling direction of the vehicle, the distance R between the center point of the concentric arc when the turning trajectory of each wheel becomes a concentric arc and the center point with respect to the position of each wheel The steering command value R is changed from R 1 to R 2, and the steering angles α 1 , α 2 , α 3 , α 4 of the wheels are changed to the steering angle values corresponding to the steering command value R 1 [ α 1, α 2, α 3 , α 4] each steering angle corresponding to the steering command value R 2 from R1 [α 1, α 2, α 3, in the process of transition to alpha 4] R2, the steering command value R 1 steering command value obtained by adding a small steering command value [Delta] R to (R 1 + ΔR) previously for Small transition steering angles that satisfy the steering constraint condition expression [α 1, α 2, α 3, α 4] (R1 + ΔR) computes its small transition steering angles [α 1, α 2, α 3, α 4] (R1 + ΔR ) , The steering angles α 1 , α 2 , α 3 , α 4 are changed, and the steering angles α 1 , α 2 , α 3 , α 4 are changed to the minute transition steering angles [α 1 , α 2 , α 3, α 4] after detecting that the matched steering angle reaches the (R1 + ΔR), to the steering command value (R 1 + ΔR) further steering command value obtained by adding a small steering command value ΔR (R 1 + 2ΔR) On the other hand, a minute transition steering angle [α1, α2, α3, α4] (R1 + 2ΔR) that satisfies the steering constraint condition is calculated, and the minute transition steering angle [α 1 , α 2 , α 3 , α 4 ] (R1 + 2ΔR) is calculated. each steering angle α 1, α 2, α 3 , by changing the alpha 4 toward the similarly thereafter, each Steering angle alpha 1 of the wheel, alpha 2, alpha 3, after the alpha 4 detects that it has matched the steering angle, the steering constraint condition to successively added steering command value small steering command value ΔR (R 1 + nΔR) A small transition steering angle [α 1 , α 2 , α 3 , α 4 ] (R1 + nΔR) satisfying the equation is calculated and directed toward the small transition steering angle [α 1 , α 2 , α 3 , α 4 ] (R1 + nΔR) . Each steering angle α 1 , α 2 , α 3 , α 4 is changed, and each steering angle α 1 , α 2 , α 3 , α 4 is changed to a minute transition steering angle [α 1 , α 2 , α 3 , α 4. ] (R1 + nΔR) is reached and the detection that the steering angle is matched is repeated, and the steering angles α 1 , α 2 , α 3 , α 4 of the wheels are set to the respective steering angles [α 1 , α 2 , α 3 , alpha 4] each steering angle from (R1) [α 1, α 2, α 3, α 4] 4 -wheel which is adapted to vary the (R2) Steering control method of standing steering vehicle has been proposed.
しかし上記の特開2003−146234号公開特許公報ならびに特願2003−136158号特許出願で提案されているものは、何れも各操舵モードM1,M3,M4,M5に対する操舵拘束条件式(E11〜12),(E31〜33),(E41〜43),(E45〜47),(E51〜53),(E55〜57)が、選択する全ての操舵モードの演算に適用できる同一形態の共通条件式とはなっていない。そのため、或る操舵モードで走行中の車両を他の操舵モードへ変えて続走させる場合、車両を一旦停止させた上で形態の異なる他の操舵拘束条件式に設定を変えした後、設定変更後の操舵拘束条件式に従う演算に基づいて、車両を他の操舵モードで再起動させる必要がある。すなわち、上記従来の4輪独立操舵車両の操舵制御方法では、走行中の車両を一旦停止させることなく操舵モードを他の操舵モードに移行することが出来ず、このことは、屋内外施設の通路形態や通路周縁の物体の配置状況に応じて多種の操舵モードを自由に選択しながら円滑・迅速に操舵できる4輪独立操舵車両を実用化する上で大きな難点であった。 However, all of those proposed in the above-mentioned Japanese Patent Application Laid-Open No. 2003-146234 and Japanese Patent Application No. 2003-136158 apply to the steering restraint condition formulas for the respective steering modes M 1 , M 3 , M 4 , and M 5. (E11-12), (E31-33), (E41-43), (E45-47), (E51-53), (E55-57) can be applied to the calculation of all the selected steering modes. It is not a common conditional expression. Therefore, when a vehicle running in a certain steering mode is changed to another steering mode to continue running, the setting is changed after changing the setting to another steering constraint conditional expression having a different form after temporarily stopping the vehicle. It is necessary to restart the vehicle in another steering mode based on the calculation according to the following steering constraint conditional expression. That is, in the conventional steering control method for a four-wheel independent steering vehicle, the steering mode cannot be shifted to another steering mode without temporarily stopping the running vehicle. This was a major difficulty in putting a four-wheel independent steering vehicle into practical use, which can be smoothly and quickly steered while freely selecting various steering modes depending on the form and the arrangement of objects around the passage.
この発明の課題は、車両通路の形態や通路周縁の状況に応じて操舵モードを変えて適切な操舵モードで走行させる4輪独立操舵車両において、走行中の4輪独立操舵車両を一旦停止させることなく、その走行過程で操舵モードを迅速・円滑に変更できるようにすることにある。又この発明の課題は、その操舵モードの変更過程(遷移過程)において、車輪の開閉脚現象が生じないようにすることにある。 An object of the present invention is to temporarily stop a traveling four-wheel independent steering vehicle in a four-wheel independent steering vehicle that travels in an appropriate steering mode by changing the steering mode according to the form of the vehicle passage and the state of the periphery of the passage. The steering mode can be changed quickly and smoothly during the traveling process. Another object of the present invention is to prevent the opening / closing leg phenomenon of the wheels from occurring in the change process (transition process) of the steering mode.
この発明は、上記の課題・目的を達するために、すなわち、操舵モードを選択して適切な操舵モードで走行させる4輪独立操舵車両において走行中の4輪独立操舵車両を一旦停止させることなくその走行過程で操舵モードを円滑に変更できるようにするために、選択可能な複数種類の各操舵モードにおける各車輪の操舵角度を規定する操舵拘束条件式を、選択する全ての操舵モードに適用できる同一形態の共通条件式とする。 In order to achieve the above-mentioned problems / objectives, the present invention can be achieved without temporarily stopping a four-wheel independent steering vehicle that is running in a four-wheel independent steering vehicle that selects a steering mode and travels in an appropriate steering mode. In order to make it possible to smoothly change the steering mode in the running process, the steering constraint condition formula that defines the steering angle of each wheel in each of a plurality of selectable steering modes can be applied to all the selected steering modes. A common conditional expression of the form.
そしてこの発明は、選択可能な全ての操舵モードに共通して適用できる同一形態の操舵拘束条件式を用いるという技術思想を基に、仮想4角形の角部にそれぞれ位置して車体ベースに配設され各々独立操舵制御される右前車輪P1,左前車輪P2,右後車輪P3,左後車輪P4に対する中心点Oを座標原点とし、その中心点Oを通って左・右前車輪P2,P1ならびに左・右後車輪P4,P3の左右方向に延びる線をX座標軸とし、その中心点Oを通って前・後右車輪P1,P3ならびに前・後左車輪P2,P4の前後方向に延びる線をY座標軸とし、前記車体ベースを旋回させるに要する左・右前車輪P2,P1ならびに左・右後車輪P4,P3のそれぞれの旋回中心点を同一共通旋回中心点Cとしてその同一共通旋回中心点CのX座標・Y座標を(R,m)とし、左・右前車輪P2,P1ならびに左右後車輪P4,P3のそれぞれのX座標軸からの距離をLとし、左・右前車輪P2,P1ならびに左・右後車輪P4,P3のそれぞれのY座標軸からの距離をWとし、前記同一共通旋回中心点CのX座標・Y座標(R,m)を操舵指令値R,mとして、右前車輪P1,左前車輪P2,右後車輪P3,左後車輪P4の各操舵角度α1,α2,α3,α4を、次の操舵拘束条件式、
に従って演算して操舵制御する。
The present invention is based on the technical idea of using the same form of steering restraint conditional expression that can be applied in common to all selectable steering modes, and is arranged at the corners of the virtual quadrangle, respectively, on the vehicle body base. The center point O for the right front wheel P 1 , the left front wheel P 2 , the right rear wheel P 3 , and the left rear wheel P 4 that are independently steered is set as the coordinate origin, and the left and right front wheels P 2 pass through the center point O. , P 1 and the left and right rear wheels P 4 , P 3 extending in the left-right direction are defined as X coordinate axes, and the front / rear right wheels P 1 , P 3 and front / rear left wheels P 2 are passed through the center point O. , a line extending in the longitudinal direction of the P 4 and Y axes, the same respective pivot point of the left and right front wheels P 2 required to the vehicle body based swirling, P 1 and left and right rear wheels P 4, P 3 During the same common turning as the common turning center point C The X and Y coordinates of the center point C are (R, m), the distance from the X coordinate axis of each of the left and right front wheels P 2 and P 1 and the left and right rear wheels P 4 and P 3 is L, and the left and right front The distance from the Y coordinate axis of each of the wheels P 2 and P 1 and the left and right rear wheels P 4 and P 3 is W, and the X and Y coordinates (R, m) of the same common turning center point C are steering commands. As the values R and m, the steering angles α 1 , α 2 , α 3 and α 4 of the right front wheel P 1 , the left front wheel P 2 , the right rear wheel P 3 and the left rear wheel P 4 are expressed by the following steering constraint conditional expressions ,
According to the calculation, steering control is performed.
またこの発明は、上記の課題・目的を達するために、操舵モードを変えて車両を走行させる4輪独立操舵車両の操舵制御方法において、仮想4角形の角部にそれぞれ位置して車体ベースに配設され各々独立操舵制御される右前車輪P1,左前車輪P2,右後車輪P3,左後車輪P4に対する中心点Oを座標原点とし、その中心点Oを通って左・右前車輪P2,P1ならびに左・右後車輪P4,P3の左右方向に延びる線をX座標軸とし、その中心点Oを通って前・後右車輪P1,P3ならびに前・後左車輪P2,P4の前後方向に延びる線をY座標軸とし、前記車体ベースを旋回させるに要する左・右前車輪P2,P1ならびに左・右後車輪P4,P3のそれぞれの旋回中心点を同一共通旋回中心点Cとし、その同一共通旋回中心点CのX座標・Y座標を(R,m)とし、左・右前車輪P2,P1ならびに左・右後車輪P4,P3のそれぞれのX座標軸からの距離をLとし、左・右前車輪P2,P1ならびに左・右後車輪P4,P3のそれぞれのY座標軸からの距離をWとし、前記同一共通旋回中心点CのX座標・Y座標(R,m)を操舵指令値R,mとし、右前車輪P1,左前車輪P2,右後車輪P3,右後車輪P3,左後車輪P4の各操舵角度α1,α2,α3,α4を、次の操舵拘束条件式、
に従って演算すると共に、その操舵指令値m又は/及びRを変化させることにより操舵モードを変えて操舵制御を行う。
In order to achieve the above-described problems and objects, the present invention provides a steering control method for a four-wheel independently-steered vehicle in which the vehicle is driven by changing the steering mode, and is disposed at each corner of a virtual quadrangle and arranged on the vehicle body base. The center point O for the right front wheel P 1 , left front wheel P 2 , right rear wheel P 3 , and left rear wheel P 4 that are installed and independently controlled is the coordinate origin, and the left and right front wheels P pass through the center point O. 2 , P 1 and the left and right rear wheels P 4 , P 3 extending in the left-right direction are taken as X coordinate axes, and the front / rear right wheels P 1 , P 3 and front / rear left wheels P are passed through the center point O. 2 , P 4 extending in the front-rear direction is defined as the Y coordinate axis, and the respective turning center points of the left / right front wheels P 2 , P 1 and the left / right rear wheels P 4 , P 3 required for turning the vehicle body base are defined. The same common turning center point C, and the same common turning point The X and Y coordinates of the rotation center point C are (R, m), and the distances from the X coordinate axes of the left and right front wheels P 2 and P 1 and the left and right rear wheels P 4 and P 3 are L, The distance from the Y coordinate axis of each of the left and right front wheels P 2 and P 1 and the left and right rear wheels P 4 and P 3 is W, and the X and Y coordinates (R, m) of the same common turning center C Are steering command values R, m, and the steering angles α 1 , α 2 , α 3 , α of the right front wheel P 1 , left front wheel P 2 , right rear wheel P 3 , right rear wheel P 3 , left rear wheel P 4 4 is the following steering constraint conditional expression:
And the steering command value m or / and R is changed to change the steering mode and perform the steering control.
またこの発明は、操舵モードを変えながら車両を走行させる4輪独立操舵車両の操舵制御方法において、操舵モードを変える過程で車輪の開閉脚現象を防止するために、仮想4角形の角部にそれぞれ位置して車体ベースに配設され各々独立操舵制御される右前車輪P1,左前車輪P2,右後車輪P3,左後車輪P4に対する中心点Oを座標原点とし、その中心点Oを通って前記各車輪の左右方向に延びる線をX座標軸とし、その中心点Oを通って前記各車輪の前後方向に延びる線をY座標軸とし、前記車体ベースを旋回させるに要する前記左・右前車輪P2,P1ならびに前記左・右後車輪P4,P3のそれぞれの旋回中心点を同一共通旋回中心点Cとして、その同一共通旋回中心点CのX座標・Y座標を(R,m)とし、前記左・右前車輪P2,P1ならびに前記左・右後車輪P4,P3の前記X座標軸からの距離をLとし、前記左・右前車輪P2,P1ならびに前記左・右後車輪P4,P3の前記Y座標軸からの距離をWとし、前記同一共通旋回中心点CのX座標・Y座標(R,m)を操舵指令値R,mとし、前記操舵指令値m又は/及びRを変更し且つその操舵指令値m又は/及びRの遷移過程の総ての時間断面で前記操舵指令値m又は/及びRを徐々に変化させながら前記の右前車輪P1,左前車輪P2,右後車輪P3,左後車輪P4の各操舵角度α1,α2,α3,α4を、次の操舵拘束条件式、
に従って演算して操舵制御し、前記操舵指令値m又は/及びRを変化させることにより操舵モードを変えて操舵制御を行う。
In addition, in the steering control method for a four-wheel independent steering vehicle in which the vehicle is driven while changing the steering mode, each corner portion of the virtual quadrangular shape is used to prevent the opening / closing leg phenomenon of the wheels in the process of changing the steering mode. The center point O for the right front wheel P 1 , the left front wheel P 2 , the right rear wheel P 3 , and the left rear wheel P 4 , which is positioned and disposed on the vehicle body base and independently controlled, is set as the coordinate origin, and the center point O is The left and right front wheels required to turn the vehicle body base with the line extending in the left-right direction of each wheel passing through as the X coordinate axis and the line extending through the center point O extending in the front-rear direction of each wheel as the Y coordinate axis The turning center points of P 2 and P 1 and the left and right rear wheels P 4 and P 3 are defined as the same common turning center point C, and the X and Y coordinates of the same common turning center point C are represented by (R, m ) And left The distance from the X coordinate axis of the right front wheels P 2 and P 1 and the left and right rear wheels P 4 and P 3 is L, and the left and right front wheels P 2 and P 1 and the left and right rear wheels P 4 , The distance of P 3 from the Y coordinate axis is W, the X coordinate / Y coordinate (R, m) of the same common turning center point C is the steering command value R, m, and the steering command value m or / and R is The right front wheel P 1 , the left front wheel P 2 , the right, while changing and gradually changing the steering command value m or / and R in all time sections of the transition process of the steering command value m or / and R Each steering angle α 1 , α 2 , α 3 , α 4 of the rear wheel P 3 and the left rear wheel P 4 is expressed by the following steering constraint condition formula:
And the steering control is performed by changing the steering command value m or / and R to change the steering mode.
そしてこの発明では、 操舵モードを変えて車両を走行させる4輪独立操舵車両の操舵制御方法において、仮想4角形の角部にそれぞれ位置して車体ベースに配設され互いに独立操舵制御される右前車輪P1,左前車輪P2,右後車輪P3,左後車輪P4に対する中心点Oを座標原点とし、その中心点Oを通って前記各車輪の左右方向に延びる線をX座標軸とし、その中心点Oを通って前記各車輪の前後方向に延びる線をY座標軸とし、前記車体ベースを旋回させるに要する前記左・右前車輪P2,P1ならびに左・右後車輪P4,P3のそれぞれの旋回中心点を同一共通旋回中心点Cとして、その同一共通旋回中心点CのX座標・Y座標を(R,m)とし、前記左・右前車輪P2,P1ならびに左・右後車輪P4,P3の前記X座標軸からの距離をLとし、前記左・右前車輪P2,P1ならびに左・右後車輪P4,P3の前記Y座標軸からの距離をWとし、前記同一共通旋回中心点CのX座標・Y座標(R,m)を操舵指令値R,mとして、前記の右前車輪P1,左前車輪P2,右後車輪P3,左後車輪P4の各操舵角度α1,α2,α3,α4を、次の操舵拘束条件式、
に従って演算して操舵制御すると共に、その操舵指令値mをm1からm2へ変えて、前記各車輪の操舵角度α1,α2,α3,α4を、操舵指令値m1に対応する各操舵角度[α1,α2,α3,α4](m1) から、操舵指令値m2に対応する操舵角度[α1,α2,α3,α4](m2) へ移行させる過程で、操舵指令値m1に微小操舵指令値Δmを加えた操舵指令値(m1+Δm)に対して前記操舵拘束条件式を満たす微小移行操舵角度[α1,α2,α3,α4](m1+Δm) を演算し、その微小移行操舵角度[α1,α2,α3,α4](m1+Δm)に向けて各操舵角度α1,α2,α3,α4を変化させ、各操舵角度α1,α2,α3,α4が前記微小移行操舵角度[α1,α2,α3,α4](m1+Δm)に到達した後、前記操舵指令値(m1+Δm)に更に微小操舵指令値Δmを加えた操舵指令値(m1+2Δm)に対して前記操舵拘束条件式を満たす微小移行操舵角度[α1,α2,α3,α4](m1+2Δm)を演算し、その微小移行操舵角度[α1,α2,α3,α4](m1+2Δm)に向けて各操舵角度α1,α2,α3,α4を変化させ、以後同様に、微小操舵指令値Δmを順次加えた操舵指令値(m1+nΔm)に対して前記操舵拘束条件式を満たす微小移行操舵角度[α1,α2,α3,α4](m1+nΔm)を演算し、その微小移行操舵角度[α1,α2,α3,α4](m1+nΔm) に向けて各操舵角度α1,α2,α3,α4を変化させることを繰り返して、各車輪の操舵角度α1,α2,α3,α4をそれぞれ各操舵角度[α1,α2,α3,α4](m1) から各操舵角度[α1,α2,α3,α4](m2) へ変化させて操舵制御を行う。
According to the present invention, in the steering control method for a four-wheel independent steering vehicle in which the vehicle is driven by changing the steering mode, the right front wheel is disposed at the corner of the virtual quadrangle and is disposed on the vehicle body base and independently controlled by each other. The center point O for P 1 , the left front wheel P 2 , the right rear wheel P 3 , and the left rear wheel P 4 is the coordinate origin, and the line extending through the center point O in the left-right direction of each wheel is the X coordinate axis. A line extending through the center point O in the front-rear direction of each wheel is a Y coordinate axis, and the left and right front wheels P 2 and P 1 and the left and right rear wheels P 4 and P 3 required for turning the vehicle body base Each turning center point is the same common turning center point C, and the X and Y coordinates of the same common turning center point C are (R, m), and the left and right front wheels P 2 and P 1 and the left and right rear points the wheels P 4, P 3 The distance from the axis is L, the distance from the Y coordinate axis of the left and right front wheels P 2, P 1 and left and right rear wheels P 4, P 3 and W, X coordinates of the same common pivot point C With the Y coordinate (R, m) as steering command values R, m, the steering angles α 1 , α 2 of the right front wheel P 1 , left front wheel P 2 , right rear wheel P 3 , left rear wheel P 4 , α 3 and α 4 are expressed by the following steering restraint conditional expression:
The steering command value m is changed from m 1 to m 2, and the steering angles α 1 , α 2 , α 3 , α 4 of the wheels correspond to the steering command value m 1 . The steering angle [α 1 , α 2 , α 3 , α 4 ] (m1 ) to be shifted to the steering angle [α 1 , α 2 , α 3 , α 4 ] (m2) corresponding to the steering command value m 2 in the process of, the steering command value m steering command value obtained by adding a small steering command value Delta] m to 1 (m 1 + Δm) small transition steering angles that satisfy the steering constraint condition expression for [α 1, α 2, α 3, α 4] (m1 + Δm) computes its small transition steering angles [α 1, α 2, α 3, α 4] (m1 + Δm) each steering angle alpha 1 toward, alpha 2, alpha 3, changes the alpha 4 Each steering angle α 1 , α 2 , α 3 , α 4 is changed to the minute transition steering angle [α 1 , α 2 , α 3 , α 4 ] ( m1 + Delta] m) after reaching, the steering command value (m 1 + Δm) further steering command value obtained by adding a small steering command value Δm (m 1 + 2Δm) small transition steering angles that satisfy the steering constraint condition expression for [alpha 1 , α 2 , α 3 , α 4 ] (m1 + 2Δm) , and each steering angle α 1 , α 2 toward the minute transition steering angle [α 1 , α 2 , α 3 , α 4 ] (m1 + 2Δm). , Α 3 , α 4 are changed, and thereafter, similarly, a small transition steering angle [α 1 , α that satisfies the steering constraint condition formula with respect to a steering command value (m 1 + nΔm) obtained by sequentially adding a small steering command value Δm. 2 , α 3 , α 4 ] (m1 + nΔm) and calculate each steering angle α 1 , α 2 , α 3 toward the minute transition steering angle [α 1 , α 2 , α 3 , α 4 ] (m1 + nΔm). , repeatedly varying the alpha 4, the steering angle of each wheel alpha 1 α 2, α 3, the steering angle alpha 4 each [α 1, α 2, α 3, α 4] each steering angle from (m1) [α 1, α 2, α 3, α 4] to (m2) Change the steering control.
またこの発明では、操舵モードを変えて車両を走行させる4輪独立操舵車両の操舵制御方法において、仮想4角形の角部にそれぞれ位置して車体ベースに配設され互いに独立操舵制御される右前車輪P1,左前車輪P2,右後車輪P3,左後車輪P4に対する中心点Oを座標原点とし、その中心点Oを通って前記各車輪の左右方向に延びる線をX座標軸とし、その中心点Oを通って前記各車輪の前後方向に延びる線をY座標軸とし、前記車体ベースを旋回させるに要する前記左・右前車輪P2,P1ならびに左・右後車輪P4,P3のそれぞれの旋回中心点を同一共通旋回中心点Cとして、その同一共通旋回中心点CのX座標・Y座標を(R,m)とし、前記左・右前車輪P2,P1ならびに左・右後車輪P4,P3の前記X座標軸からの距離をLとし、前記左・右前車輪P2,P1ならびに左・右後車輪P4,P3の前記Y座標軸からの距離をWとし、前記同一共通旋回中心点CのX座標・Y座標(R,m)を操舵指令値R,mとして、前記の右前車輪P1,左前車輪P2,右後車輪P3,左後車輪P4の各操舵角度α1,α2,α3,α4を、次の操舵拘束条件式、
に従って演算して操舵制御すると共に、その操舵指令値RをR1からR2へ変えて、前記各車輪の操舵角度α1,α2,α3,α4を、操舵指令値R1に対応する各操舵角度[α1,α2,α3,α4](R1) から、操舵指令値R2に対応する操舵角度[α1,α2,α3,α4](R2)) へ移行させる過程で、操舵指令値R1に微小操舵指令値ΔRを加えた操舵指令値(R1+ΔR)に対して前記操舵拘束条件式を満たす微小移行操舵角度[α1,α2,α3,α4](R1+ΔR) を演算し、その微小移行操舵角度[α1,α2,α3,α4](R1+ΔR)に向けて各操舵角度α1,α2,α3,α4を変化させ、各操舵角度α1,α2,α3,α4が前記微小移行操舵角度[α1,α2,α3,α4](R1+ΔR)に到達した後、前記操舵指令値(R1+ΔR)に更に微小操舵指令値ΔRを加えた操舵指令値(R1+2ΔR)に対して前記操舵拘束条件式を満たす微小移行操舵角度[α1,α2,α3,α4](R1+2ΔR)を演算し、その微小移行操舵角度[α1,α2,α3,α4](R1+2ΔR)に向けて各操舵角度α1,α2,α3,α4を変化させ、以後同様に、微小操舵指令値ΔRを順次加えた操舵指令値(R1+nΔR)に対して前記操舵拘束条件式を満たす微小移行操舵角度[α1,α2,α3,α4](R1+nΔR)を演算し、その微小移行操舵角度[α1,α2,α3,α4](R1+nΔR) に向けて各操舵角度α1,α2,α3,α4を変化させることを繰り返して、各車輪の操舵角度α1,α2,α3,α4をそれぞれ各操舵角度[α1,α2,α3,α4](R1) から各操舵角度[α1,α2,α3,α4](R2) へ変化させて操舵制御を行う。
According to the present invention, in the steering control method for a four-wheel independent steering vehicle in which the vehicle is driven by changing the steering mode, the right front wheel is disposed on the corner portion of the virtual quadrangle and is disposed on the vehicle body base and independently controlled by each other. The center point O for P 1 , the left front wheel P 2 , the right rear wheel P 3 , and the left rear wheel P 4 is the coordinate origin, and the line extending through the center point O in the left-right direction of each wheel is the X coordinate axis. A line extending through the center point O in the front-rear direction of each wheel is a Y coordinate axis, and the left and right front wheels P 2 and P 1 and the left and right rear wheels P 4 and P 3 required for turning the vehicle body base Each turning center point is the same common turning center point C, and the X and Y coordinates of the same common turning center point C are (R, m), and the left and right front wheels P 2 and P 1 and the left and right rear points The X seat of the wheels P 4 and P 3 The distance from the reference axis is L, the distance from the Y coordinate axis of the left / right front wheels P 2 , P 1 and the left / right rear wheels P 4 , P 3 is W, and the X of the same common turning center C The steering angles α 1 , α 2 of the right front wheel P 1 , left front wheel P 2 , right rear wheel P 3 , left rear wheel P 4 are set with the coordinates and Y coordinates (R, m) as steering command values R, m. , Α 3 , α 4 can be expressed as
The steering command value R is changed from R 1 to R 2, and the steering angles α 1 , α 2 , α 3 , α 4 of the wheels correspond to the steering command value R 1 . From each steering angle [α 1 , α 2 , α 3 , α 4 ] (R1) to the steering angle [α 1 , α 2 , α 3 , α 4 ] (R2)) corresponding to the steering command value R 2 in the course of shifting, the steering command value obtained by adding a small steering command value [Delta] R to the steering command value R 1 (R 1 + ΔR) said steering small transition steering angles that satisfy the constraint condition expression [alpha 1 relative to, alpha 2, alpha 3 , Α 4 ] (R1 + ΔR) and calculate each steering angle α 1 , α 2 , α 3 , α 4 toward the minute transition steering angle [α 1 , α 2 , α 3 , α 4 ] (R1 + ΔR). Each steering angle α 1 , α 2 , α 3 , α 4 is changed to the minute transition steering angle [α 1 , α 2 , α 3 , α 4 ]. (R1 + [Delta] R) after reaching, the steering command value (R 1 + ΔR) further steering command value obtained by adding a small steering command value ΔR (R 1 + 2ΔR) small transition steering angles that satisfy the steering constraint condition expression for [ α 1, α 2, α 3 , α 4] (R1 + 2ΔR) computes its small transition steering angles [α 1, α 2, α 3, α 4] (R1 + 2ΔR) each steering angle alpha 1 towards, alpha 2 , α 3 , α 4 are changed, and thereafter, similarly, a small transition steering angle [α 1 ,... Satisfying the steering constraint conditional expression with respect to a steering command value (R 1 + nΔR) obtained by sequentially adding a small steering command value ΔR. α 2, α 3, α 4 ] (R1 + nΔR) computes its small transition steering angles [α 1, α 2, α 3, α 4] (R1 + nΔR) each steering angle alpha 1 toward, alpha 2, alpha 3, is repeated varying the alpha 4, the steering angle alpha 1 of the wheels , Α 2 , α 3 , α 4 are changed from the respective steering angles [α 1 , α 2 , α 3 , α 4 ] (R1) to the respective steering angles [α 1 , α 2 , α 3 , α 4 ] (R2). The steering control is performed by changing to.
そして上記のようなこの発明に係る手段によれば、操舵モードを変えて走行させることのできる4輪独立操舵車両において、走行中の車両を一旦停止させることなく、その走行過程で、車両走行通路の形態や通路周縁の物体の配置状況に即応して的確・円滑に操舵モードを変えて車両を走行させることができる。更に上記のような発明手段によれば、操舵モードの変更が可能な4輪独立操舵車両において、操舵モードの遷移過程(変更過程)での車輪の開閉脚現象が防止され、車輪の開閉脚現象に起因する操舵機構の故障・破損を防ぎ、開閉脚現象によって走行中の車両上にある人や物の安定性が損なわれることを防止して安全に人や物を移送することができる。 According to the above-described means according to the present invention, in the four-wheel independent steering vehicle that can be driven while changing the steering mode, the vehicle running path can be changed in the running process without temporarily stopping the running vehicle. The vehicle can be driven by changing the steering mode accurately and smoothly in response to the form of the object and the arrangement state of the objects at the periphery of the passage. Furthermore, according to the invention means as described above, in a four-wheel independent steering vehicle capable of changing the steering mode, the opening / closing leg phenomenon of the wheel in the transition process (change process) of the steering mode is prevented, and the opening / closing leg phenomenon of the wheel is prevented. It is possible to prevent the steering mechanism from being broken or damaged due to the above, and to prevent the stability of the person or the object on the running vehicle from being impaired by the opening / closing leg phenomenon, thereby safely transferring the person or the object.
この発明の最良の実施形態は、操舵モードを変えながら車両を走行させる4輪独立操舵車両の操舵制御方法において、仮想4角形の角部にそれぞれ位置して車体ベースに配設され各々独立操舵制御される右前車輪P1,左前車輪P2,右後車輪P3,左後車輪P4に対する中心点Oを座標原点とし、その中心点Oを通って前記各車輪の左右方向に延びる線をX座標軸とし、その中心点Oを通って前記各輪の前後方向に延びる線をY座標軸とし、前記車体ベースを旋回させるに要する前記左・右前車輪P2,P1ならびに前記左・右後車輪P4,P3のそれぞれの旋回中心点をそれらの車輪に対して共通する同一の旋回中心点(同一共通旋回中心点)Cとして、その同一共通旋回中心点CのX座標・Y座標を(R,m)とし、前記左・右前車輪P2,P1ならびに前記左・右後車輪P4,P3の前記X座標軸からの距離をLとし、前記左・右前車輪P2,P1ならびに前記左・右後車輪P4,P3の前記Y座標軸からの距離をWとし、前記同一共通旋回中心点CのX座標・Y座標(R,m)を操舵指令値R,mとして、前記の右前車輪P1,左前車輪P2,右後車輪P3,左後車輪P4の各操舵角度α1,α2,α3,α4を、次の操舵拘束条件式、
に従って演算して操舵制御すると共に、その操舵指令値mをm1からm2へ変え、その操舵指令値RをR1からR2へ変えて、各車輪の操舵角度α1,α2,α3,α4を、操舵指令値R1,m1に対応する各操舵角度[α1,α2,α3,α4](R1),(m1) から、操舵指令値R2,m2に対応する操舵角度[α1,α2,α3,α4](R2),(m2) へ遷移させる過程で、操舵指令値R1,m1に微小操舵指令値ΔR,Δmを加えた操舵指令値(R1+ΔR),(m1+Δm)に対して前記操舵拘束条件式を満たす微小移行操舵角度[α1,α2,α3,α4](R1+ΔR),(m1+Δm) を演算し、その微小移行操舵角度[α1,α2,α3,α4](R1+ΔR),(m1+Δm)に向けて各操舵角度α1,α2,α3,α4を変化させ、各操舵角度α1,α2,α3,α4が前記微小移行操舵角度[α1,α2,α3,α4](R1+ΔR),(m1+Δm)に到達した後、前記操舵指令値(R1+ΔR),(m1+Δm)に更に微小操舵指令値ΔR,Δmを加えた操舵指令値(R1+2ΔR),(m1+2Δm)に対して前記操舵拘束条件式を満たす微小移行操舵角度[α1,α2,α3,α4](R1+2ΔR),(m1+2Δm)を演算し、その微小移行操舵角度[α1,α2,α3,α4](R1+2ΔR),(m1+2Δm)に向けて各操舵角度α1,α2,α3,α4を変化させ、以後同様に、微小操舵指令値ΔR,Δmを順次加えた操舵指令値(R1+nΔR),(m1+nΔm)に対して前記操舵拘束条件式を満たす微小移行操舵角度[α1,α2,α3,α4](R1+nΔR),(m1+nΔm)を演算し、その微小移行操舵角度[α1,α2,α3,α4](R1+nΔR),(m1+nΔm) に向けて各操舵角度α1,α2,α3,α4を変化させることを繰り返して、各車輪の操舵角度α1,α2,α3,α4をそれぞれ各操舵角度[α1,α2,α3,α4](R1),(m1) から各操舵角度[α1,α2,α3,α4](R2),(m2) へ変化させる4輪独立操舵車両の操舵制御方法である。
In the steering control method for a four-wheel independent steering vehicle in which the vehicle travels while changing the steering mode, the best embodiment of the present invention is located on the corners of the virtual quadrangle and is disposed on the vehicle body base and independently controlled. A center point O with respect to the right front wheel P 1 , left front wheel P 2 , right rear wheel P 3 , and left rear wheel P 4 is a coordinate origin, and a line extending in the left-right direction of each wheel through the center point O is defined as X The left and right front wheels P 2 and P 1 and the left and right rear wheels P required for turning the vehicle body base are defined as coordinate axes, and a line extending in the front-rear direction of each wheel through the center point O is defined as a Y coordinate axis. 4 , P 3 as the same turning center point (same common turning center point) C common to those wheels, and the X and Y coordinates of the same common turning center point C are (R M) and the left The distance from the X coordinate axis of the right front wheels P 2 and P 1 and the left and right rear wheels P 4 and P 3 is L, and the left and right front wheels P 2 and P 1 and the left and right rear wheels P 4 , The distance from the Y coordinate axis of P 3 is W, the X coordinate / Y coordinate (R, m) of the same common turning center C is the steering command value R, m, and the right front wheel P 1 , left front wheel P 2 , the steering angles α 1 , α 2 , α 3 , α 4 of the right rear wheel P 3 and the left rear wheel P 4 are expressed by the following steering constraint condition formulas:
The steering command value m is changed from m 1 to m 2 , the steering command value R is changed from R 1 to R 2, and the steering angles α 1 , α 2 , α of the respective wheels are calculated. 3, alpha 4, and the steering angle corresponding to the steering command value R 1, m 1 [α 1 , α 2, α 3, α 4] (R1), from (m1), steering command value R 2, m 2 In the process of transitioning to the steering angles [α 1 , α 2 , α 3 , α 4 ] (R2), (m2) corresponding to, the small steering command values ΔR, Δm were added to the steering command values R 1 , m 1 A small transition steering angle [α 1 , α 2 , α 3 , α 4 ] (R1 + ΔR), (m1 + Δm) that satisfies the steering constraint conditional expression is calculated with respect to the steering command values (R 1 + ΔR), (m 1 + Δm). and, the small transition steering angles [α 1, α 2, α 3, α 4] (R1 + ΔR), each toward the (m1 + Δm) Rudder angle α 1, α 2, α 3 , by changing the alpha 4, each steering angle α 1, α 2, α 3 , α 4 are the small transition steering angles [α 1, α 2, α 3, α 4] After reaching (R1 + ΔR), (m1 + Δm) , steering command values (R 1 + 2ΔR), (m) obtained by adding minute steering command values ΔR, Δm to the steering command values (R 1 + ΔR), (m 1 + Δm). 1 + 2Δm) is calculated with respect to the minute transition steering angle [α 1 , α 2 , α 3 , α 4 ] (R1 + 2ΔR), (m1 + 2Δm) that satisfies the steering constraint condition formula, and the minute transition steering angle [α 1 , [alpha] 2 , [alpha] 3 , [alpha] 4 ] (R1 + 2 [Delta ] R), (m1 + 2 [Delta ] m), the steering angles [alpha] 1 , [alpha] 2 , [alpha] 3 , [alpha] 4 are changed. In addition steering command value (R 1 + nΔR), contracture the steering relative to (m 1 + nΔm) Small transition steering angles that satisfy the condition [α 1, α 2, α 3, α 4] (R1 + nΔR), (m1 + nΔm) computes its small transition steering angles [α 1, α 2, α 3, α 4] (R1 + nΔR), (m1 + nΔm) each steering angle alpha 1 toward, α 2, α 3, repeatedly varying the alpha 4, the steering angle alpha 1 of the wheels, α 2, α 3, α 4 , respectively Each steering angle [α 1 , α 2 , α 3 , α 4 ] (R1), (m1) is changed to each steering angle [α 1 , α 2 , α 3 , α 4 ] (R2), (m2) . This is a steering control method for a four-wheel independent steering vehicle.
以下この発明を、その実施例を示す図1を参考に説明する。図1はこの発明に係る4輪独立操舵車両の操舵制御方法の説明参考図である。図1において、1は4輪独立操舵車両の車体ベースで、車体ベース1は、右前車輪P1,左前車輪P2,右後車輪P3,左後車輪P4を装着する構造体を意味する。1aは、右前車輪P1,左前車輪P2,右後車輪P3,左後車輪P4の配置位置を説明するために想定した仮想4角形で、各々独立操舵制御される右前車輪P1,左前車輪P2,右後車輪P3,左後車輪P4が仮想4角形1aの角部にそれぞれ位置する状態で車体ベース1に配設され装着されている。そして右前車輪P1,左前車輪P2,右後車輪P3,左後車輪P4に対する中心点Oを座標原点とし、その中心点Oを通って各車輪の左右方向に延びる線をX座標軸とし、中心点Oを通って各車輪の前後方向に延びる線をY座標軸とし、車体ベース1(車両)を旋回させるに要する各車輪P1,P2,P3,P4,のそれぞれの旋回中心点を、各車輪P1,P2,P3,P4に対し共通する同一の旋回中心点(同一共通旋回中心点)Cとし、その同一共通旋回中心点CのX座標・Y座標を(R,m)とし、左・右前車輪P2,P1ならびに左・右後車輪P4,P3のX座標軸からの距離をLとし、左・右前車輪P2,P1ならびに左・右後車輪P4,P3のY座標軸からの距離をWとし、同一共通旋回中心点CのX座標・Y座標(R,m)を操舵指令値R,mとし、その操舵指令値R,m、すなわち同一共通中心点Cの位置(座標)を変えることにより操舵モードを変えて車両を操舵制御するものである。なお、A1,A2,A3,A4はそれぞれ右前車輪P1,左前車輪P2,右後車輪P3,左後車輪P4が操舵制御されて進む方向(各車輪の向き)を示すものである。 The present invention will be described below with reference to FIG. 1 showing an embodiment thereof. FIG. 1 is an explanatory reference diagram of a steering control method for a four-wheel independent steering vehicle according to the present invention. In FIG. 1, 1 is a vehicle body base of a four-wheel independent steering vehicle, and the vehicle body base 1 means a structure on which a right front wheel P 1 , a left front wheel P 2 , a right rear wheel P 3 , and a left rear wheel P 4 are mounted. . 1a is the front right wheel P 1, the front left wheel P 2, the rear right wheel P 3, a virtual square that assumes for explaining the position of the left rear wheel P 4, the front right wheel P 1 is independently steering control, The left front wheel P 2 , the right rear wheel P 3 , and the left rear wheel P 4 are disposed and mounted on the vehicle body base 1 in a state of being positioned at the corners of the virtual quadrangle 1a. The center point O for the right front wheel P 1 , the left front wheel P 2 , the right rear wheel P 3 , and the left rear wheel P 4 is the coordinate origin, and the line extending through the center point O in the horizontal direction of each wheel is the X coordinate axis. The center of rotation of each wheel P 1 , P 2 , P 3 , P 4 required for turning the vehicle body base 1 (vehicle) is defined by using a line extending through the center point O in the front-rear direction of each wheel as the Y coordinate axis. The point is defined as the same turning center point (same common turning center point) C common to the wheels P 1 , P 2 , P 3 , P 4 , and the X and Y coordinates of the same common turning center point C are ( R, m), L is the distance from the X coordinate axis of the left / right front wheels P 2 , P 1 and the left / right rear wheels P 4 , P 3 , and the left / right front wheels P 2 , P 1 and the left / right rear The distance from the Y coordinate axis of the wheels P 4 and P 3 is W, and the X seat of the same common turning center point C Steering control is performed by changing the steering mode by changing the steering command value R, m, that is, the position (coordinate) of the same common center point C, with the mark / Y coordinate (R, m) as the steering command value R, m. To do. A 1 , A 2 , A 3 , and A 4 indicate the directions (the directions of the wheels) that the right front wheel P 1 , the left front wheel P 2 , the right rear wheel P 3 , and the left rear wheel P 4 are steered. It is shown.
そしてこの発明において重要なことは、車体ベース1(車両)を幾つかの操舵モードで操舵するに要する右前車輪P1,左前車輪P2,右後車輪P3,左後車輪P4の各操舵角度α1,α2,α3,α4を規定する操舵拘束条件式として、次の式(1〜4)を用いることであり、その操舵拘束条件式(1〜4)は、選択可能な複数の操舵モードに対し共通した同一形態の式であることである。
・・・・・ 式(1)
・・・・・ 式(2)
・・・・・ 式(3)
・・・・・ 式(4)
What is important in the present invention is that the steering of the right front wheel P 1 , the left front wheel P 2 , the right rear wheel P 3 , and the left rear wheel P 4 required for steering the vehicle body base 1 (vehicle) in several steering modes. The following formulas (1 to 4) are used as steering constraint conditional expressions for defining the angles α 1 , α 2 , α 3 , and α 4 , and the steering constraint conditional expressions (1 to 4) are selectable. This is a common formula for a plurality of steering modes.
Equation (1)
Equation (2)
Equation (3)
Equation (4)
そして車両には、上記の式(1)(2)(3)(4)に従って各操舵角度α1,α2,α3,α4を演算する演算プログラム(図示省略)と、その演算された操舵角度α1,α2,α3,α4に基づいて各車輪を操舵する操舵モータ(図示省略)を備えており、前記操舵指令値(同一共通中心点Cの位置)R,mを変化させることにより、操舵拘束条件式(1〜4)に基づいて演算される各車輪の操舵角度α1,α2,α3,α4が変化して、異なる操舵モードで車両を操舵することができる。因みに、上記の操舵拘束条件式(1)(2)(3)(4)と先の特許文献1に示された操舵モードM1の操舵拘束条件式(E11,12)、操舵モードM3の操舵拘束条件式(E31,32,33)、操舵モードM4の操舵拘束条件式(E41,42,43,45,46,47)、操舵モードM5の操舵拘束条件式(51,52,53,55,56,57)を比較すると、この発明に係る操舵拘束条件式(1)(2)(3)(4)において操舵指令値m=0の場合に操舵モードM1の操舵拘束条件式(E11,12)に相当し、m=―Lの場合に操舵モードM3の操舵拘束条件式(E31,32,33)に相当し、操舵指令値m=−L、操舵指令値R=Wの場合に操舵モードM4の操舵拘束条件式(E41,42,43,45,46,47)に相当し、操舵指令値m=L、操舵指令値R=Wの場合に操舵モードM5の操舵拘束条件式(E51,52,53,55,56,57)に相当していることが解かる。従って、この発明に係る操舵拘束条件式(1〜4)を適用して、その操舵指令値m,Rを変化させることにより、操舵モードM1,M3,M4,M5などの相異なる操舵モードで4輪独立操舵車両を操舵制御することができる。そしてこの発明に係る操舵拘束条件式(1〜4)は、異なる操舵モードに対しても共通の同一形態の条件式であるため、車両の走行中にその走行を一旦停めることなく、その操舵指令値m,Rを変化させることにより、操舵モードを迅速・円滑に変えて、車両走行通路の形態や通路周縁の物体の配置状況に即応して的確・円滑に操舵モードを変えて車両を走行させることができる。 The vehicle has an arithmetic program (not shown) for calculating the steering angles α 1 , α 2 , α 3 , α 4 according to the above formulas (1), (2), (3), and (4), and the calculation is performed. A steering motor (not shown) for steering each wheel based on the steering angles α 1 , α 2 , α 3 , α 4 is provided, and the steering command values (positions of the same common center point C) R, m are changed. As a result, the steering angles α 1 , α 2 , α 3 , α 4 of the wheels calculated based on the steering constraint conditional expressions (1 to 4) change, and the vehicle can be steered in different steering modes. it can. Incidentally, the above-described steering the constraint condition expression (1) (2) (3) (4) the previous Patent Document 1 indicated steering constraint condition expression in the steering mode M 1 (E11,12), the steering mode M 3 steering constraint condition expression (E31,32,33), steering constraint condition expression of steering mode M 4 (E41,42,43,45,46,47), steering constraint condition expression of steering mode M 5 (51,52,53 comparing the 55, 56, 57), the steering constraint condition expression according to the present invention (1) (2) (3) (4) steering constraint condition expression in the steering mode M 1 if the steering command value m = 0 in corresponds to (E11,12), m = the case of -L corresponds to the steering constraint condition expression in the steering mode M 3 (E31,32,33), steering command value m = -L, steering command value R = W corresponding to steering constraint condition expression in the steering mode M 4 (E41,42,43,45,46,47) in the case of Tokaru that corresponds to a steering command value m = L, the steering constraint condition expression in the steering mode M 5 when the steering command value R = W (E51,52,53,55,56,57). Therefore, by applying the steering constraint conditional expressions (1 to 4) according to the present invention and changing the steering command values m and R, the steering modes M 1 , M 3 , M 4 , M 5, etc. are different. Steering control of a four-wheel independent steering vehicle can be performed in the steering mode. Since the steering constraint conditional expressions (1 to 4) according to the present invention are conditional expressions of the same form that are common to different steering modes, the steering command is temporarily stopped without stopping the traveling while the vehicle is traveling. By changing the values m and R, the steering mode is changed quickly and smoothly, and the vehicle is driven by changing the steering mode accurately and smoothly in response to the form of the vehicle traveling path and the arrangement of objects at the periphery of the path. be able to.
また上記実施例では、操舵指令値m,R変化させて操舵モードを変える場合に、例えば操舵指令値mをm1からm2へ変え操舵指令値RをR1からR2へ変えて操舵モードを変える際に、その操舵モードの遷移過程で車輪の開閉脚現象が生じることを防止して、安定した迅速・円滑な操舵モード遷移が実行されるようにしている。すなわち、操舵指令値mをm1からm2へ変え操舵指令値RをR1からR2へ変えて操舵モードを変える場合に、各車輪の操舵角度α1,α2,α3,α4を、操舵指令値R1,m1に対応する各操舵角度[α1,α2,α3,α4](R1),(m1) から、操舵指令値R2,m2に対応する操舵角度[α1,α2,α3,α4](R2),(m2) へ遷移させる過程で、操舵指令値R1,m1に微小操舵指令値ΔR,Δmを加えた操舵指令値(R1+ΔR),(m1+Δm)に対して前記操舵拘束条件式を満たす微小移行操舵角度[α1,α2,α3,α4](R1+ΔR),(m1+Δm) を演算し、その微小移行操舵角度[α1,α2,α3,α4](R1+ΔR),(m1+Δm)に向けて各操舵角度α1,α2,α3,α4を変化させ、各操舵角度α1,α2,α3,α4が前記微小移行操舵角度[α1,α2,α3,α4](R1+ΔR),(m1+Δm)に到達した後、前記操舵指令値(R1+ΔR),(m1+Δm)に更に微小操舵指令値ΔR,Δmを加えた操舵指令値(R1+2ΔR),(m1+2Δm)に対して前記操舵拘束条件式を満たす微小移行操舵角度[α1,α2,α3,α4](R1+2ΔR),(m1+2Δm)を演算し、その微小移行操舵角度[α1,α2,α3,α4](R1+2ΔR),(m1+2Δm)に向けて各操舵角度α1,α2,α3,α4を変化させ、以後同様に、微小操舵指令値ΔR,Δmを順次加えた操舵指令値(R1+nΔR),(m1+nΔm)に対して前記操舵拘束条件式を満たす微小移行操舵角度[α1,α2,α3,α4](R1+nΔR),(m1+nΔm)を演算し、その微小移行操舵角度[α1,α2,α3,α4](R1+nΔR),(m1+nΔm) に向けて各操舵角度α1,α2,α3,α4を変化させることを繰り返して、各車輪の操舵角度α1,α2,α3,α4をそれぞれ各操舵角度[α1,α2,α3,α4](R1),(m1) から各操舵角度[α1,α2,α3,α4](R2),(m2) へ変化させるようにして4輪独立操舵車両の安定した円滑且つ迅速な操舵制御を図っている。 In the above embodiment, when the steering mode is changed by changing the steering command values m and R, for example, the steering command value m is changed from m 1 to m 2 and the steering command value R is changed from R 1 to R 2 . When changing the steering wheel, the opening / closing leg phenomenon of the wheel is prevented from occurring in the steering mode transition process, so that stable, quick and smooth steering mode transition is executed. That is, when the steering command value m is changed from m 1 to m 2 and the steering command value R is changed from R 1 to R 2 to change the steering mode, the steering angles α 1 , α 2 , α 3 , α 4 of the wheels are changed. From the steering angles [α 1 , α 2 , α 3 , α 4 ] (R1), (m1) corresponding to the steering command values R 1 , m 1 , the steering corresponding to the steering command values R 2 , m 2. In the process of transitioning to the angles [α 1 , α 2 , α 3 , α 4 ] (R2), (m2) , a steering command value obtained by adding the small steering command values ΔR, Δm to the steering command values R 1 , m 1 ( A small transition steering angle [α 1 , α 2 , α 3 , α 4 ] (R1 + ΔR), (m1 + Δm) that satisfies the steering constraint condition formula is calculated with respect to R 1 + ΔR), (m 1 + Δm), and the minute migration steering angle [α 1, α 2, α 3, α 4] (R1 + ΔR), (m1 + Δm) each steering angle towards the alpha 1 α 2, α 3, by changing the alpha 4, each steering angle α 1, α 2, α 3 , α 4 are the small transition steering angles [α 1, α 2, α 3, α 4] (R1 + ΔR), ( after reaching m1 + Δm), the steering command value (R 1 + ΔR), ( m 1 + more small steering command value to Delta] m) [Delta] R, the steering command value plus Δm (R 1 + 2ΔR), with respect to (m 1 + 2Δm) Then, a small transition steering angle [α 1 , α 2 , α 3 , α 4 ] (R1 + 2ΔR), (m1 + 2Δm) that satisfies the steering constraint conditional expression is calculated, and the small transition steering angle [α 1 , α 2 , α 3 is calculated. , Α 4 ] (R1 + 2ΔR), (m1 + 2Δm) , the steering angles α 1 , α 2 , α 3 , α 4 are changed, and thereafter, similarly, the steering command value obtained by sequentially adding the minute steering command values ΔR, Δm. (R 1 + nΔR), Mitsuru said steering constraint condition expression for (m 1 + nΔm) Be small transition steering angles [α 1, α 2, α 3, α 4] (R1 + nΔR), (m1 + nΔm) computes its small transition steering angles [α 1, α 2, α 3, α 4] (R1 + nΔR) , (M1 + nΔm) , each steering angle α 1 , α 2 , α 3 , α 4 is repeatedly changed to change the steering angle α 1 , α 2 , α 3 , α 4 of each wheel to each steering angle. [Α 1 , α 2 , α 3 , α 4 ] (R1), (m1) is changed to each steering angle [α 1 , α 2 , α 3 , α 4 ] (R2), (m2) A stable and smooth steering control of a four-wheel independent steering vehicle is achieved.
社会の高齢化に伴う医療・福祉環境の向上・整備のために、また日常生活の質的向上に資する文化・教育・スポーツ・娯楽環境の向上・整備のために、更にまた産業界における業務の合理化・拡大化への必要から、医療・福祉施設、工場、物流基地、コンピュータ関係施設、大型商業施設、図書館、スポーツ施設、遊園地、娯楽施設など、各種の施設の屋内外で人や物を乗載して安全に移送できる車両の需要が更に高まると考えられ、それらの用途に沿う車両として、車両の操舵走行軌跡の自由度が高く、操舵・走行中の衝撃や揺れが少なく、円滑・安全に操舵制御できるものが特に求められると考えられる。そのような中にあって、この発明は、上記の実施例からも明らかなように、車両通路の形態・周縁状況に応じて操舵モードを変えて適切な操舵モードで走行させることができる4輪独立操舵車両に関するものであって、選択可能な複数種類の操舵モードを形成するための各車輪の操舵角度を各操舵モードの全てに適用できる同一形態の操舵拘束条件式として、走行中の4輪独立操舵車両を一旦停止させることなくその走行過程で操舵モードを迅速・円滑に変更できるようにし、またその操舵モードの変更過程(遷移過程)における総ての時間断面で操舵指令値を徐々に変化させながら各車輪の各操舵角度を操舵拘束条件式に従って制御して、操舵モードの遷移過程における車輪の開閉脚現象を防止し操舵・走行中の車両における衝撃や揺れを防ぐようにしたものである。したがって、この発明に係る4輪独立操舵車両の操舵制御方法によれば、車両の操舵走行軌跡の自由度が高く、操舵・走行中の衝撃や揺れが少なく、迅速・円滑・安全に操舵制御できる車両として、今後求められる社会環境・生活環境を支える各種多様な産業に役立つ可能性は極めて高いと考えられる。 In order to improve and maintain the medical and welfare environment accompanying the aging of society, to improve and maintain the culture, education, sports and entertainment environment that contributes to improving the quality of daily life, and to further improve the business in the industry. Because of the need for rationalization and expansion, people and goods can be used indoors and outdoors in various facilities such as medical / welfare facilities, factories, logistics bases, computer-related facilities, large commercial facilities, libraries, sports facilities, amusement parks, and entertainment facilities. The demand for vehicles that can be safely transported on board is expected to increase further, and as a vehicle that meets these applications, the degree of freedom of the steering trajectory of the vehicle is high, and there is little impact or shaking during steering and traveling, What can be safely controlled by steering is considered to be particularly required. Under such circumstances, as is apparent from the above embodiment, the present invention is a four-wheel vehicle that can be driven in an appropriate steering mode by changing the steering mode in accordance with the form and peripheral state of the vehicle passage. This relates to an independently-steered vehicle, and the four-wheels that are running as a steering restraint conditional expression of the same form that can apply the steering angle of each wheel to form a plurality of selectable steering modes to all the steering modes. The steering mode can be changed quickly and smoothly in the course of traveling without stopping the independent steering vehicle, and the steering command value is gradually changed in all time sections in the change process (transition process) of the steering mode. The steering angle of each wheel is controlled according to the steering restraint condition formula to prevent the opening and closing leg phenomenon of the wheel during the transition process of the steering mode, and the impact and shaking in the steering / running vehicle are prevented. It is obtained by the Guyo. Therefore, according to the steering control method for a four-wheel independent steering vehicle according to the present invention, the degree of freedom of the steering traveling locus of the vehicle is high, and there is little impact and shaking during steering / traveling, and steering control can be performed quickly, smoothly, and safely. As a vehicle, it is highly likely to be useful for various industries that support the social and living environments that will be required in the future.
1 :車体ベース
1a:仮想4角形
A1:右前車輪の走行向き
A2:左前車輪の走行向き
A3:右後車輪の走行向き
A4:左後車輪の走行向き
C :車輪P1,P2,P3,P4に対する同一共通旋回中心点
L :車輪P1,P2,P3,P4のX座標軸からの距離
O :車輪P1,P2,P3,P4に対する中心点
P1:右前車輪
P2:左前車輪
P3:右後車輪
P4:左後車輪
R :操舵指令値(同一共通旋回中心点のX座標)
m :操舵指令値(同一共通旋回中心点のY座標)
W :車輪P1,P2,P3,P4のY座標軸からの距離
X :X座標軸
Y :Y座標軸
α1 :右前車輪の操舵角度
α2 :左前車輪の操舵角度
α3 :右後車輪の操舵角度
α4 :左後車輪の操舵角度
ΔR,Δm:微小操舵指令値
1: Vehicle body base 1a: Virtual quadrangle A 1 : Travel direction of right front wheel A 2 : Travel direction of left front wheel A 3 : Travel direction of right rear wheel A 4 : Travel direction of left rear wheel C: Wheels P 1 , P 2, P 3, the same common turning center point for P 4 L: the distance from the X axis of the wheel P 1, P 2, P 3 , P 4 O: center point to the wheels P 1, P 2, P 3 , P 4 P 1 : Right front wheel P 2 : Left front wheel P 3 : Right rear wheel P 4 : Left rear wheel R: Steering command value (X coordinate of the same common turning center point)
m: Steering command value (Y coordinate of the same common turning center point)
W: Distance of wheels P 1 , P 2 , P 3 , P 4 from Y coordinate axis X: X coordinate axis Y: Y coordinate axis α 1 : Steering angle α 2 of right front wheel: Steering angle α 3 of left front wheel: Right rear wheel Steering angle α 4 : Steering angle ΔR, Δm of the left rear wheel: Micro steering command value
Claims (3)
に従って演算して操舵制御すると共に、その操舵指令値mをm 1 からm 2 へ変えて、前記各車輪の操舵角度α 1 ,α 2 ,α 3 ,α 4 を、操舵指令値m 1 に対応する各操舵角度[α 1 ,α 2 ,α 3 ,α 4 ] (m1) から、操舵指令値m 2 に対応する操舵角度[α 1 ,α 2 ,α 3 ,α 4 ] (m2) へ遷移させる過程で、操舵指令値m 1 に微小操舵指令値Δmを加えた操舵指令値(m 1 +Δm)に対して前記操舵拘束条件式を満たす微小移行操舵角度[α 1 ,α 2 ,α 3 ,α 4 ] (m1+Δm) を演算し、その微小移行操舵角度[α 1 ,α 2 ,α 3 ,α 4 ] (m1+Δm) に向けて各操舵角度α 1 ,α 2 ,α 3 ,α 4 を変化させ、各操舵角度α 1 ,α 2 ,α 3 ,α 4 が前記微小移行操舵角度[α 1 ,α 2 ,α 3 ,α 4 ] (m1+Δm) に到達した後、前記操舵指令値(m 1 +Δm)に更に微小操舵指令値Δmを加えた操舵指令値(m 1 +2Δm)に対して前記操舵拘束条件式を満たす微小移行操舵角度[α 1 ,α 2 ,α 3 ,α 4 ] (m1+2Δm) を演算し、その微小移行操舵角度[α 1 ,α 2 ,α 3 ,α 4 ] (m1+2Δm) に向けて各操舵角度α 1 ,α 2 ,α 3 ,α 4 を変化させ、以後同様に、微小操舵指令値Δmを順次加えた操舵指令値(m 1 +nΔm)に対して前記操舵拘束条件式を満たす微小移行操舵角度[α 1 ,α 2 ,α 3 ,α 4 ] (m1+nΔm) を演算し、その微小移行操舵角度[α 1 ,α 2 ,α 3 ,α 4 ] (m1+nΔm) に向けて各操舵角度α 1 ,α 2 ,α 3 ,α 4 を変化させることを繰り返して、各車輪の操舵角度α 1 ,α 2 ,α 3 ,α 4 をそれぞれ各操舵角度[α 1 ,α 2 ,α 3 ,α 4 ] (m1) から各操舵角度[α 1 ,α 2 ,α 3 ,α 4 ] (m2) へ変化させることを特徴とする4輪独立操舵車両の操舵制御方法。 In a steering control method for a four-wheel independently-steered vehicle in which the vehicle is driven while changing the steering mode, the right front wheel P 1 and the left front wheel that are respectively positioned at the corners of the virtual quadrangle and are disposed on the vehicle body base and independently controlled. The center point O with respect to P 2 , the right rear wheel P 3 , and the left rear wheel P 4 is taken as the coordinate origin, the line extending in the left-right direction of each wheel through the center point O is taken as the X coordinate axis, and passes through the center point O. A line extending in the front-rear direction of each wheel is defined as a Y coordinate axis, and the respective turning centers of the left / right front wheels P 2 , P 1 and the left / right rear wheels P 4 , P 3 required for turning the vehicle body base Let the point be the same common turning center point C, and the X and Y coordinates of the same common turning center point C be (R, m), and the left and right front wheels P 2 and P 1 and the left and right rear wheels P 4. , P 3 from the X coordinate axis The distance is L, the distance from the Y coordinate axis of the left / right front wheels P 2 , P 1 and the left / right rear wheels P 4 , P 3 is W, and the X coordinate / Y of the same common turning center point C Using the coordinates (R, m) as steering command values R, m, the steering angles α 1 , α 2 , α 3 of the right front wheel P 1 , left front wheel P 2 , right rear wheel P 3 , left rear wheel P 4 are described. , Α 4 is expressed by the following steering constraint condition formula:
The steering command value m is changed from m 1 to m 2, and the steering angles α 1 , α 2 , α 3 , α 4 of the wheels correspond to the steering command value m 1 . the transition from the steering angle [α 1, α 2, α 3, α 4] (m1), a steering angle corresponding to the steering command value m 2 [α 1, α 2 , α 3, α 4] to (m2) in the process of, the steering command value m steering command value obtained by adding a small steering command value Delta] m to 1 (m 1 + Δm) small transition steering angles that satisfy the steering constraint condition expression for [α 1, α 2, α 3, α 4] (m1 + Δm) computes its small transition steering angles [α 1, α 2, α 3, α 4] (m1 + Δm) each steering angle alpha 1 toward, alpha 2, alpha 3, changes the alpha 4 Each steering angle α 1 , α 2 , α 3 , α 4 is changed to the minute transition steering angle [α 1 , α 2 , α 3 , α 4 ] ( m1 + Delta] m) after reaching, the steering command value (m 1 + Δm) further steering command value obtained by adding a small steering command value Δm (m 1 + 2Δm) small transition steering angles that satisfy the steering constraint condition expression for [alpha 1 , α 2 , α 3 , α 4 ] (m1 + 2Δm) , and each steering angle α 1 , α 2 toward the minute transition steering angle [α 1 , α 2 , α 3 , α 4 ] (m1 + 2Δm). , Α 3 , α 4 are changed, and thereafter, similarly, a small transition steering angle [α 1 , α that satisfies the steering constraint condition formula with respect to a steering command value (m 1 + nΔm) obtained by sequentially adding a small steering command value Δm. 2 , α 3 , α 4 ] (m1 + nΔm) and calculate each steering angle α 1 , α 2 , α 3 toward the minute transition steering angle [α 1 , α 2 , α 3 , α 4 ] (m1 + nΔm). , repeatedly varying the alpha 4, the steering angle of each wheel alpha 1 α 2, α 3, the steering angle alpha 4 each [α 1, α 2, α 3, α 4] each steering angle from (m1) [α 1, α 2, α 3, α 4] to (m2) A steering control method for a four-wheel independently-steered vehicle, characterized by being changed.
に従って演算して操舵制御すると共に、その操舵指令値RをR 1 からR 2 へ変えて、前記各車輪の操舵角度α 1 ,α 2 ,α 3 ,α 4 を、操舵指令値R 1 に対応する各操舵角度[α 1 ,α 2 ,α 3 ,α 4 ] (R1) から、操舵指令値R 2 に対応する操舵角度[α 1 ,α 2 ,α 3 ,α 4 ] (R2) へ遷移させる過程で、操舵指令値R 1 に微小操舵指令値ΔRを加えた操舵指令値(R 1 +ΔR)に対して前記操舵拘束条件式を満たす微小移行操舵角度[α 1 ,α 2 ,α 3 ,α 4 ] (R1+ΔR) を演算し、その微小移行操舵角度[α 1 ,α 2 ,α 3 ,α 4 ] (R1+ΔR) に向けて各操舵角度α 1 ,α 2 ,α 3 ,α 4 を変化させ、各操舵角度α 1 ,α 2 ,α 3 ,α 4 が前記微小移行操舵角度[α 1 ,α 2 ,α 3 ,α 4 ] (R1+ΔR) に到達した後、前記操舵指令値(R 1 +ΔR)に更に微小操舵指令値ΔRを加えた操舵指令値(R 1 +2ΔR)に対して前記操舵拘束条件式を満たす微小移行操舵角度[α 1 ,α 2 ,α 3 ,α 4 ] (R1+2ΔR) を演算し、その微小移行操舵角度[α 1 ,α 2 ,α 3 ,α 4 ] (R1+2ΔR) に向けて各操舵角度α 1 ,α 2 ,α 3 ,α 4 を変化させ、以後同様に、微小操舵指令値ΔRを順次加えた操舵指令値(R 1 +nΔR)に対して前記操舵拘束条件式を満たす微小移行操舵角度[α 1 ,α 2 ,α 3 ,α 4 ] (R1+nΔR) を演算し、その微小移行操舵角度[α 1 ,α 2 ,α 3 ,α 4 ] (R1+nΔR) に向けて各操舵角度α 1 ,α 2 ,α 3 ,α 4 を変化させることを繰り返して、各車輪の操舵角度α 1 ,α 2 ,α 3 ,α 4 をそれぞれ各操舵角度[α 1 ,α 2 ,α 3 ,α 4 ] (R1) から各操舵角度[α 1 ,α 2 ,α 3 ,α 4 ] (R2) へ変化させることを特徴とする4輪独立操舵車両の操舵制御方法。 In a steering control method for a four-wheel independently-steered vehicle in which the vehicle is driven while changing the steering mode, the right front wheel P 1 and the left front wheel that are respectively positioned at the corners of the virtual quadrangle and are disposed on the vehicle body base and independently controlled. The center point O with respect to P 2 , the right rear wheel P 3 , and the left rear wheel P 4 is taken as the coordinate origin, the line extending in the left-right direction of each wheel through the center point O is taken as the X coordinate axis, and passes through the center point O. A line extending in the front-rear direction of each wheel is defined as a Y coordinate axis, and the respective turning centers of the left / right front wheels P 2 , P 1 and the left / right rear wheels P 4 , P 3 required for turning the vehicle body base Let the point be the same common turning center point C, and the X and Y coordinates of the same common turning center point C be (R, m), and the left and right front wheels P 2 and P 1 and the left and right rear wheels P 4. , P 3 from the X coordinate axis The distance is L, the distance from the Y coordinate axis of the left / right front wheels P 2 , P 1 and the left / right rear wheels P 4 , P 3 is W, and the X coordinate / Y of the same common turning center point C Using the coordinates (R, m) as steering command values R, m, the steering angles α 1 , α 2 , α 3 of the right front wheel P 1 , left front wheel P 2 , right rear wheel P 3 , left rear wheel P 4 are described. , Α 4 is expressed by the following steering constraint condition formula:
The steering command value R is changed from R 1 to R 2, and the steering angles α 1 , α 2 , α 3 , α 4 of the wheels correspond to the steering command value R 1 . Transition from each steering angle [α 1 , α 2 , α 3 , α 4 ] (R1) to the steering angle [α 1 , α 2 , α 3 , α 4 ] (R2) corresponding to the steering command value R 2. in the process of, steering command value steering command value obtained by adding a small steering command value [Delta] R to R 1 (R 1 + ΔR) small transition steering angles that satisfy the steering constraint condition expression for [α 1, α 2, α 3, α 4] (R1 + ΔR) computes its small transition steering angles [α 1, α 2, α 3, α 4] each steering angle alpha 1 toward the (R1 + ΔR), α 2 , α 3, changes the alpha 4 Each steering angle α 1 , α 2 , α 3 , α 4 is changed to the minute transition steering angle [α 1 , α 2 , α 3 , α 4 ] ( R1 + After reaching the [Delta] R), the steering command value (R 1 + ΔR) further steering command value obtained by adding a small steering command value ΔR (R 1 + 2ΔR) small transition steering angles that satisfy the steering constraint condition expression for [alpha 1 , α 2 , α 3 , α 4 ] (R1 + 2ΔR) , and each steering angle α 1 , α 2 toward the minute transition steering angle [α 1 , α 2 , α 3 , α 4 ] (R1 + 2ΔR). , Α 3 , α 4 are changed, and thereafter, similarly, the small transition steering angle [α 1 , α satisfying the steering constraint condition expression with respect to the steering command value (R 1 + nΔR) obtained by sequentially adding the small steering command value ΔR. 2 , α 3 , α 4 ] (R1 + nΔR) and calculate each steering angle α 1 , α 2 , α 3 toward the minute transition steering angle [α 1 , α 2 , α 3 , α 4 ] (R1 + nΔR). , repeatedly varying the alpha 4, the steering angle of each wheel alpha 1 α 2, α 3, the steering angle alpha 4 each [α 1, α 2, α 3, α 4] (R1) each steering angle from [α 1, α 2, α 3, α 4] to (R2) A steering control method for a four-wheel independently-steered vehicle, characterized by being changed.
に従って演算して操舵制御すると共に、その操舵指令値mをm 1 からm 2 へ変え、その操舵指令値RをR 1 からR 2 へ変えて、前記各車輪の操舵角度α 1 ,α 2 ,α 3 ,α 4 を、操舵指令値R 1 ,m 1 に対応する各操舵角度[α 1 ,α 2 ,α 3 ,α 4 ] (R1),(m1) から、操舵指令値R 2 ,m 2 に対応する操舵角度[α 1 ,α 2 ,α 3 ,α 4 ] (R2),(m2) へ遷移させる過程で、操舵指令値R 1 ,m 1 に微小操舵指令値ΔR,Δmを加えた操舵指令値(R 1 +ΔR),(m 1 +Δm)に対して前記操舵拘束条件式を満たす微小移行操舵角度[α 1 ,α 2 ,α 3 ,α 4 ] (R1+ΔR),(m1+Δm) を演算し、その微小移行操舵角度[α 1 ,α 2 ,α 3 ,α 4 ] (R1+ΔR),(m1+Δm) に向けて各操舵角度α 1 ,α 2 ,α 3 ,α 4 を変化させ、各操舵角度α 1 ,α 2 ,α 3 ,α 4 が前記微小移行操舵角度[α 1 ,α 2 ,α 3 ,α 4 ] (R1+ΔR),(m1+Δm) に到達した後、前記操舵指令値(R 1 +ΔR),(m 1 +Δm)に更に微小操舵指令値ΔR,Δmを加えた操舵指令値(R 1 +2ΔR),(m 1 +2Δm)に対して前記操舵拘束条件式を満たす微小移行操舵角度[α 1 ,α 2 ,α 3 ,α 4 ] (R1+2ΔR),(m1+2Δm) を演算し、その微小移行操舵角度[α 1 ,α 2 ,α 3 ,α 4 ] (R1+2ΔR),(m1+2Δm) に向けて各操舵角度α 1 ,α 2 ,α 3 ,α 4 を変化させ、以後同様に、微小操舵指令値ΔR,Δmを順次加えた操舵指令値(R 1 +nΔR),(m 1 +nΔm)に対して前記操舵拘束条件式を満たす微小移行操舵角度[α 1 ,α 2 ,α 3 ,α 4 ] (R1+nΔR),(m1+nΔm) を演算し、その微小移行操舵角度[α 1 ,α 2 ,α 3 ,α 4 ] (R1+nΔR),(m1+nΔm) に向けて各操舵角度α 1 ,α 2 ,α 3 ,α 4 を変化させることを繰り返して、各車輪の操舵角度α 1 ,α 2 ,α 3 ,α 4 をそれぞれ各操舵角度[α 1 ,α 2 ,α 3 ,α 4 ] (R1),(m1) から各操舵角度[α 1 ,α 2 ,α 3 ,α 4 ] (R2),(m2) へ変化させることを特徴とする4輪独立操舵車両の操舵制御方法。 In a steering control method for a four-wheel independently-steered vehicle in which the vehicle is driven while changing the steering mode, the right front wheel P 1 and the left front wheel that are respectively positioned at the corners of the virtual quadrangle and are disposed on the vehicle body base and independently controlled. The center point O with respect to P 2 , the right rear wheel P 3 , and the left rear wheel P 4 is taken as the coordinate origin, the line extending in the left-right direction of each wheel through the center point O is taken as the X coordinate axis, and passes through the center point O. A line extending in the front-rear direction of each wheel is defined as a Y coordinate axis, and the respective turning centers of the left / right front wheels P 2 , P 1 and the left / right rear wheels P 4 , P 3 required for turning the vehicle body base Let the point be the same common turning center point C, and the X and Y coordinates of the same common turning center point C be (R, m), and the left and right front wheels P 2 and P 1 and the left and right rear wheels P 4. , P 3 from the X coordinate axis The distance is L, the distance from the Y coordinate axis of the left / right front wheels P 2 , P 1 and the left / right rear wheels P 4 , P 3 is W, and the X coordinate / Y of the same common turning center point C Using the coordinates (R, m) as steering command values R, m, the steering angles α 1 , α 2 , α 3 of the right front wheel P 1 , left front wheel P 2 , right rear wheel P 3 , left rear wheel P 4 are described. , Α 4 is expressed by the following steering constraint condition formula:
The steering command value m is changed from m 1 to m 2 , the steering command value R is changed from R 1 to R 2, and the steering angles α 1 , α 2 , α 3 and α 4 are changed from the steering angles [α 1 , α 2 , α 3 , α 4 ] (R1) and (m1) corresponding to the steering command values R 1 and m 1 to the steering command values R 2 and m 1. In the process of transitioning to steering angles [α 1 , α 2 , α 3 , α 4 ] (R2), (m2) corresponding to 2 , the small steering command values ΔR, Δm are added to the steering command values R 1 , m 1. steering command value (R 1 + ΔR), a (m 1 + Δm) small transition steering angles that satisfy the steering constraint condition expression for [α 1, α 2, α 3, α 4] (R1 + ΔR), (m1 + Δm) calculated, the micro transition steering angles [α 1, α 2, α 3, α 4] (R1 + ΔR), towards the (m1 + Δm) Each steering angle α 1, α 2, α 3 , by changing the alpha 4, each steering angle α 1, α 2, α 3 , α 4 are the small transition steering angles [α 1, α 2, α 3, α 4 ] After reaching (R1 + ΔR), (m1 + Δm) , steering command values (R 1 + 2ΔR), ( R 1 + ΔR), (m 1 + Δm), and further adding minute steering command values ΔR, Δm to (R 1 + ΔR), (m 1 + Δm) m 1 + 2Δm) the steering micro transition steering angles that satisfy the constraint condition expression for [α 1, α 2, α 3, α 4] (R1 + 2ΔR), (m1 + 2Δm) computes its small transition steering angles [alpha 1 , Α 2 , α 3 , α 4 ] (R1 + 2ΔR), (m1 + 2Δm) , the steering angles α 1 , α 2 , α 3 , α 4 are changed, and thereafter the minute steering command values ΔR, Δm are similarly changed. sequentially added steering command value (R 1 + nΔR), the steering relative to (m 1 + nΔm) Small transition steering angles that satisfy the constraint condition expression [α 1, α 2, α 3, α 4] (R1 + nΔR), (m1 + nΔm) computes its small transition steering angles [α 1, α 2, α 3, α 4 ] (R1 + nΔR), the (m1 + nΔm) each steering angle alpha 1 toward, α 2, α 3, by repeating the varying alpha 4, the steering angle alpha 1 of the wheels, α 2, α 3, α 4 The steering angles [α 1 , α 2 , α 3 , α 4 ] (R1), (m1) are changed to the respective steering angles [α 1 , α 2 , α 3 , α 4 ] (R2), (m2) , respectively. A steering control method for a four-wheel independent steering vehicle.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2004261298A JP4041911B2 (en) | 2004-09-08 | 2004-09-08 | Steering control method for four-wheel independent steering vehicle |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2004261298A JP4041911B2 (en) | 2004-09-08 | 2004-09-08 | Steering control method for four-wheel independent steering vehicle |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2006076393A JP2006076393A (en) | 2006-03-23 |
| JP4041911B2 true JP4041911B2 (en) | 2008-02-06 |
Family
ID=36156219
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2004261298A Expired - Fee Related JP4041911B2 (en) | 2004-09-08 | 2004-09-08 | Steering control method for four-wheel independent steering vehicle |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP4041911B2 (en) |
Families Citing this family (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| KR101226536B1 (en) | 2011-04-29 | 2013-01-25 | 제이엠씨엔지니어링 주식회사 | The apparatus of four wheel electric car with hall effect encoder module |
| KR101480252B1 (en) | 2013-10-28 | 2015-01-12 | 경북대학교 산학협력단 | Fault tolerant apparatus and method for an independent controlled steering in a four wheel drive system |
| CN108791568A (en) * | 2018-07-12 | 2018-11-13 | 广东嘉腾机器人自动化有限公司 | A kind of AGV minor-circle turns control method and three train AGV |
-
2004
- 2004-09-08 JP JP2004261298A patent/JP4041911B2/en not_active Expired - Fee Related
Also Published As
| Publication number | Publication date |
|---|---|
| JP2006076393A (en) | 2006-03-23 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| US6871125B2 (en) | Electric vehicle steering/drive control method, electric vehicle steering/drive control apparatus, and electric vehicle | |
| JP4802622B2 (en) | Running body and method of adjusting running body | |
| JP4345391B2 (en) | Parking assistance device | |
| Han et al. | Balancing and velocity control of a unicycle robot based on the dynamic model | |
| CN102963355A (en) | Intelligent auxiliary parking method and implementation system thereof | |
| CN109895844B (en) | Ride control system and method for a vehicle | |
| Mac et al. | MIMO fuzzy control for autonomous mobile robot | |
| CN114200926B (en) | Local path planning method and system for unmanned vehicle | |
| Ostafew et al. | Visual teach and repeat, repeat, repeat: Iterative learning control to improve mobile robot path tracking in challenging outdoor environments | |
| Kim et al. | Auto parking path planning system using modified Reeds-Shepp curve algorithm | |
| JP4041911B2 (en) | Steering control method for four-wheel independent steering vehicle | |
| CN113467475B (en) | Mecanum wheel omnidirectional mobile robot track tracking sliding mode control method | |
| JP2017010292A (en) | Agv orbit calculation device and method | |
| JP2018020665A (en) | Automobile body | |
| Kozłowski et al. | Dynamics simulation studies on the electric city car with an electromechanical differential and the rear wheels drive | |
| JP4045338B2 (en) | Steering control method for four-wheel independent steering vehicle | |
| Farina et al. | When Helbing meets Laumond: the headed social force model | |
| Lee | Operator-centric joystick mapping for intuitive manual operation of differential drive robots | |
| Fuad et al. | Path Planning and Smoothing in Maze Exploration Using Virtual Mobile Robot-Based Modified Probabilistic Road Map | |
| JP2007328486A (en) | Mobile robot | |
| Baltes et al. | A fuzzy logic controller for car-like mobile robots | |
| JP2013112108A (en) | Inverted moving body, control method thereof and program | |
| Watanabe et al. | Experiments for Verifying Basic Behaviors in an Omnidirectional Mobile Platform Using a Rocker-Bogie Suspension System | |
| CN117685978A (en) | An adaptive obstacle avoidance path planning method and system | |
| Jung et al. | Development of a fault-tolerant omnidirectional wheeled mobile robot using nonholonomic constraints |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20070403 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20070710 |
|
| A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20070910 |
|
| 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: 20071002 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20071025 |
|
| 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: 20101122 Year of fee payment: 3 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20111122 Year of fee payment: 4 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20111122 Year of fee payment: 4 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20121122 Year of fee payment: 5 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20121122 Year of fee payment: 5 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20131122 Year of fee payment: 6 |
|
| LAPS | Cancellation because of no payment of annual fees |