Deprecated: The each() function is deprecated. This message will be suppressed on further calls in /home/zhenxiangba/zhenxiangba.com/public_html/phproxy-improved-master/index.php on line 456
JP4844740B2 - Traveling vehicle - Google Patents
[go: Go Back, main page]

JP4844740B2 - Traveling vehicle - Google Patents

Traveling vehicle Download PDF

Info

Publication number
JP4844740B2
JP4844740B2 JP2006323566A JP2006323566A JP4844740B2 JP 4844740 B2 JP4844740 B2 JP 4844740B2 JP 2006323566 A JP2006323566 A JP 2006323566A JP 2006323566 A JP2006323566 A JP 2006323566A JP 4844740 B2 JP4844740 B2 JP 4844740B2
Authority
JP
Japan
Prior art keywords
traveling vehicle
vehicle
occupant
stopping
traveling
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Expired - Fee Related
Application number
JP2006323566A
Other languages
Japanese (ja)
Other versions
JP2008137422A (en
Inventor
直樹 牛来
弘毅 林
隆文 三宅
克則 土井
和昭 澤田
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.)
Equos Research Co Ltd
Original Assignee
Equos Research Co Ltd
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 Equos Research Co Ltd filed Critical Equos Research Co Ltd
Priority to JP2006323566A priority Critical patent/JP4844740B2/en
Publication of JP2008137422A publication Critical patent/JP2008137422A/en
Application granted granted Critical
Publication of JP4844740B2 publication Critical patent/JP4844740B2/en
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Electric Propulsion And Braking For Vehicles (AREA)
  • Motorcycle And Bicycle Frame (AREA)

Description

本発明は、車体と、車輪と、車輪に対して車体の姿勢を制御する機構とを備えた走行車両に関する。   The present invention relates to a traveling vehicle including a vehicle body, wheels, and a mechanism for controlling the posture of the vehicle body with respect to the wheels.

従来、同軸に配された左右の駆動輪の前方側または後方側で接地する補助輪と、該補助輪出没させる補助輪駆動部とを備え、補助輪を出して接地させた状態で乗降を行うことで、不安定感をなくすものがある(特許文献1参照)。   Conventionally, an auxiliary wheel that is grounded on the front side or the rear side of the left and right drive wheels arranged coaxially and an auxiliary wheel drive unit that causes the auxiliary wheel to invade and retract are used to get on and off in a state where the auxiliary wheel is brought out and grounded. Thus, there is one that eliminates the feeling of instability (see Patent Document 1).

また、複数の車輪の接地点が略直線上に並ぶ移動車の停車時にスタンドを接地することで安定な姿勢を保持し、転倒の可能性が低減され、簡便な取り扱いが可能となるものがある(特許文献2参照)。
特開2004−74814号公報 特開2004−243845号公報
In addition, there is a thing that a stable posture can be maintained by grounding the stand when the moving vehicle stops with the grounding points of a plurality of wheels arranged in a substantially straight line, the possibility of falling is reduced, and simple handling is possible. (See Patent Document 2).
JP 2004-74814 A JP 2004-243845 A

しかしながら、特許文献1及び特許文献2に記載された発明では、車両の停止時等に乗員が降車スイッチ等での手続きをせずに降りてしまった場合、車両は無人のまま走行制御を続けることになり、燃料等のエネルギが無駄に使用される可能性があった。また、乗員が不在の状態では、人や物がぶつかる等の外乱により、車両が走行制御を実行し、動いてしまう可能性があった。   However, in the inventions described in Patent Document 1 and Patent Document 2, when the occupant gets off without going through the procedure of the exit switch or the like when the vehicle is stopped, the vehicle keeps unmanned driving control. Therefore, energy such as fuel may be wasted. Further, in the absence of an occupant, there is a possibility that the vehicle executes traveling control and moves due to a disturbance such as a collision with a person or an object.

本発明は、上記課題を解決するものであって、乗員が降車手続きをせずに降りてしまった場合、走行車両を迅速に安定に停車させるので、燃料等のエネルギの無駄がなくなり、外乱により動いてしまうこともない走行車両を提供することを目的とする。   The present invention solves the above-mentioned problem, and when the occupant gets off without getting off the procedure, the traveling vehicle is quickly and stably stopped. An object is to provide a traveling vehicle that does not move.

そのために本発明は、車体と、前記車体に回転可能に支持された車輪と、を有する走行車両において、停車時に前記走行車両の姿勢を補助する停車時姿勢補助手段と、乗員の有無を検知する乗員検知装置と、乗員が手続きをすることで走行車両を停車させる降車手続手段と、乗員が前記降車手続手段の手続きをしないまま降車し、且つ、前記乗員検知手段が乗員を検知しなかった場合、前記走行車両を停車させ、前記停車時姿勢補助手段により姿勢を補助する制御装置と、前記走行車両の所定範囲を監視する周辺監視装置と、を備え、前記制御装置は、前記走行車両が、前記車輪による走行時から、前記車輪及び前記停車時姿勢補助手段によって3点以上で接地する停車時へ移行する際、前記車体及び前記車輪が傾斜又は移動することにより、通過・占有する停車時移動空間マップを記憶した記憶手段を有し、前記周辺監視装置が、前記停車時移動空間マップ内に何も検知しなかった場合に、前記走行車両を停車させることを特徴とする。
To this end, the present invention, in a traveling vehicle having a vehicle body and a wheel rotatably supported by the vehicle body, detects the presence or absence of an occupant during stopping, and a posture assistance means for assisting the posture of the traveling vehicle when the vehicle is stopped. When the occupant detection device, the getting-off procedure means for stopping the traveling vehicle by the procedure of the occupant, the occupant getting off without performing the procedure of the getting-off procedure means, and the occupant detection means does not detect the occupant A control device that stops the traveling vehicle and assists the posture by the stopping posture assisting means, and a peripheral monitoring device that monitors a predetermined range of the traveling vehicle, the control device comprising: When the vehicle body and the wheel are inclined or moved when the vehicle moves from the traveling time to the stationary time when the wheel and the stationary posture assisting means are grounded at three or more points. Characterized in that a storage means for storing the vehicle stop during movement space map passing-occupied, the surroundings monitoring device, when nothing is detected the stop during the movement space map, to stop the traveling vehicle And

また、前記制御装置は、停車時に操縦装置を無効にすることを特徴とする。   Further, the control device disables the control device when the vehicle is stopped.

また、前記乗員検知手段が乗員を検知しなかった時点からカウントするタイマを備え、前記制御手段は、前記タイマにより所定時間カウントされた後、前記走行車両を停車させることを特徴とする。   In addition, a timer that counts from the time when the occupant detection means does not detect an occupant is provided, and the control means stops the traveling vehicle after being counted for a predetermined time by the timer.

また、前記周辺監視装置は、前記停車時移動空間マップ内を監視する第1センサと、前記停車時移動空間マップ外を監視する第2センサとを有し、前記制御装置は、前記第1センサが前記停車時移動空間マップ内に障害物等を検知した場合、前記障害物等までの距離を計測し、前記第2センサにより、前記検知した障害物等までの距離と同じ距離内に他の障害物が存在するか検知し、検知しなかった場合、前記走行車両を障害物が検知されない方向に移動させて停車することを特徴とする。   The periphery monitoring device includes a first sensor that monitors the inside of the moving space map at the time of stopping, and a second sensor that monitors the outside of the moving space map at the time of stopping, and the control device includes the first sensor. When an obstacle or the like is detected in the moving space map when the vehicle is stopped, the distance to the obstacle or the like is measured, and other distances within the same distance as the detected obstacle or the like are measured by the second sensor. It is characterized in that it is detected whether an obstacle exists, and when the obstacle is not detected, the traveling vehicle is moved in a direction in which the obstacle is not detected and stopped.

また、前記制御装置は、停車後に点灯手段を点灯させることを特徴とする。   Moreover, the said control apparatus makes a lighting means light after stopping.

また、前記停車時姿勢補助手段は、通常時は格納され、停車時に突出することを特徴とする。   Further, the stationary posture assisting means is stored in a normal state and protrudes when the vehicle is stopped.

本発明は、車体と、前記車体に回転可能に支持された車輪と、を有する走行車両において、停車時に前記走行車両の姿勢を補助する停車時姿勢補助手段と、乗員の有無を検知する乗員検知装置と、乗員が手続きをすることで走行車両を停車させる降車手続手段と、乗員が前記降車手続手段の手続きをしないまま降車し、且つ、前記乗員検知手段が乗員を検知しなかった場合、前記走行車両を停車させ、前記停車時姿勢補助手段により姿勢を補助する制御装置と、前記走行車両の所定範囲を監視する周辺監視装置と、を備え、前記制御装置は、前記走行車両が、前記車輪による走行時から、前記車輪及び前記停車時姿勢補助手段によって3点以上で接地する停車時へ移行する際、前記車体及び前記車輪が傾斜又は移動することにより、通過・占有する停車時移動空間マップを記憶した記憶手段を有し、前記周辺監視装置が、前記停車時移動空間マップ内に何も検知しなかった場合に、前記走行車両を停車させるので、停車時に燃料等のエネルギを無駄に使用することがなくなり、外乱により動いてしまうこともなくなると共に、周辺の移動空間を迅速に演算して障害物等に衝突する危険を防止することができる。
The present invention relates to a traveling vehicle having a vehicle body and a wheel rotatably supported by the vehicle body, and a stationary posture assistance means for assisting the posture of the traveling vehicle when the vehicle is stopped, and occupant detection for detecting the presence or absence of a passenger. A device, an unloading procedure means for stopping the traveling vehicle by the procedure of the occupant, an occupant getting off without performing the procedure of the unloading procedure means, and when the occupant detection unit does not detect the occupant, A control device that stops the traveling vehicle and assists the posture by the stopping posture assisting means; and a peripheral monitoring device that monitors a predetermined range of the traveling vehicle, wherein the control device is configured such that the traveling vehicle includes the wheels. When the vehicle moves from the time of traveling to the time of stopping when the wheel and the stopping posture assisting means are grounded at three or more points, the vehicle body and the wheel are inclined or moved, so that Storage means for storing a moving space map when stopped, and the surrounding monitoring device stops the traveling vehicle when nothing is detected in the moving space map when stopped. Energy is not wasted, and it is not moved due to disturbance, and the surrounding moving space can be quickly calculated to prevent the danger of colliding with an obstacle or the like.

また、前記制御装置は、停車時に操縦装置を無効にするので、誤って何かが触れてしまっても、暴走することがない。   In addition, since the control device disables the control device when the vehicle is stopped, even if something touches by mistake, the control device will not run away.

また、前記乗員検知手段が乗員を検知しなかった時点からカウントするタイマを備え、前記制御手段は、前記タイマにより所定時間カウントされた後、前記走行車両を停車させるので、落とした物の拾得や買い物等で乗員が一時的に降りる場合には、走行車両を停車させることがなく、再び乗車する際に何ら操作をする必要がない。   In addition, a timer that counts when the occupant detection means does not detect an occupant is provided, and the control means stops the traveling vehicle after being counted for a predetermined time by the timer. When an occupant gets off temporarily for shopping or the like, the traveling vehicle is not stopped, and no operation is required when getting on again.

また、前記周辺監視装置は、前記停車時移動空間マップ内を監視する第1センサと、前記停車時移動空間マップ外を監視する第2センサとを有し、前記制御装置は、前記第1センサが前記停車時移動空間マップ内に障害物等を検知した場合、前記障害物等までの距離を計測し、前記第2センサにより、前記検知した障害物等までの距離と同じ距離内に他の障害物が存在するか検知し、検知しなかった場合、前記走行車両を障害物が検知されない方向に移動させて停車するので、停車させることのできる範囲がより広くなる。   The periphery monitoring device includes a first sensor that monitors the inside of the moving space map at the time of stopping, and a second sensor that monitors the outside of the moving space map at the time of stopping, and the control device includes the first sensor. When an obstacle or the like is detected in the moving space map when the vehicle is stopped, the distance to the obstacle or the like is measured, and other distances within the same distance as the detected obstacle or the like are measured by the second sensor. If an obstacle is detected and not detected, the traveling vehicle is moved in a direction in which the obstacle is not detected, and the vehicle is stopped. Therefore, the range in which the vehicle can be stopped becomes wider.

また、前記制御装置は、停車後に点灯手段を点灯させるので、周囲に走行車両が停車状態にあることを知らせることができ、より安全になる。   Moreover, since the said control apparatus lights a lighting means after a stop, it can notify that a driving | running | working vehicle is a stop state to the circumference | surroundings, and becomes safer.

また、前記停車時姿勢補助手段は、通常時は格納され、停車時に突出するので、通常走行時に邪魔になることがない。   Further, the posture assisting means at the time of stopping is stored at the normal time and protrudes at the time of the stopping, so that it does not get in the way during normal driving.

以下、本発明の好ましい実施の形態について図面を参照して説明する。図1(a)は、本発明の第1実施形態における走行車両1の正面図であり、図1(b)は、走行車両1の側面図である。なお、図1では、乗員Pが座席11aに着座した状態を示している。また、図1の矢印U−D,L−R,F−Bは、走行車両1の上下方向、左右方向、前後方向をそれぞれ示している。   Hereinafter, preferred embodiments of the present invention will be described with reference to the drawings. FIG. 1A is a front view of the traveling vehicle 1 in the first embodiment of the present invention, and FIG. 1B is a side view of the traveling vehicle 1. In addition, in FIG. 1, the passenger | crew P has shown the state seated on the seat 11a. In addition, arrows UD, LR, and FB in FIG. 1 indicate the up-down direction, the left-right direction, and the front-rear direction of the traveling vehicle 1, respectively.

まず、走行車両1の概略構成について説明する。走行車両1は、図1に示すように、乗員Pが乗車する乗員部11を含む車体2と、その乗員部11の下方(図1下側)に設けられる左右(一対)の車輪12L,12Rと、それら左右の車輪12L,12Rに回転駆動力を付与する回転駆動装置52(図6参照)とを主に備え、旋回時には、左右の車輪12L,12Rにキャンバ角を付与すると共に、車輪の回転駆動力に差を設け、乗員部11を旋回内輪側へ傾斜させることで旋回性能の向上と乗員Pの快適性の確保とを図ることができるように構成されている。   First, a schematic configuration of the traveling vehicle 1 will be described. As shown in FIG. 1, the traveling vehicle 1 includes a vehicle body 2 that includes an occupant portion 11 on which an occupant P rides, and left and right (a pair of) wheels 12 </ b> L and 12 </ b> R provided below the occupant portion 11 (lower side in FIG. 1). And a rotation drive device 52 (see FIG. 6) that applies a rotational drive force to the left and right wheels 12L and 12R, and provides a camber angle to the left and right wheels 12L and 12R during turning, By providing a difference in rotational driving force and inclining the occupant portion 11 toward the turning inner wheel, the turning performance can be improved and the comfort of the occupant P can be ensured.

次いで、各部の詳細構成について説明する。乗員部11は、図1に示すように、座席11a、アームレスト11b、フットレスト11cを主に備える。座席11aは、走行車両1の走行中に乗員Pが着座するための部位であり、乗員Pの尻部を支持する座面部11a1と、乗員Pの背部を支持する背面部11a2とを主に備えて構成されている。   Next, the detailed configuration of each part will be described. As shown in FIG. 1, the occupant portion 11 mainly includes a seat 11a, an armrest 11b, and a footrest 11c. The seat 11a is a part for the occupant P to be seated while the traveling vehicle 1 is traveling. The seat 11a mainly includes a seat surface portion 11a1 for supporting the butt portion of the occupant P and a back surface portion 11a2 for supporting the back portion of the occupant P. Configured.

座席11aの左右両側(矢印L側及び矢印R側)には、図1に示すように、乗員Pの上腕節を支持するための一対のアームレスト11bが設けられている。アームレスト11bの一方(矢印R側)には、ジョイスティック装置51が取着されている。乗員Pは、ジョイスティック装置51を操作して、走行車両1の走行状態(例えば、進行方向、走行速度、旋回方向、或いは、旋回半径など)を指示する。   As shown in FIG. 1, a pair of armrests 11 b for supporting the upper arm nodes of the occupant P are provided on both the left and right sides (the arrow L side and the arrow R side) of the seat 11 a. A joystick device 51 is attached to one side (arrow R side) of the armrest 11b. The occupant P operates the joystick device 51 to instruct the traveling state of the traveling vehicle 1 (for example, the traveling direction, the traveling speed, the turning direction, or the turning radius).

座席11aの前方側(矢印F側)下方には、図1に示すように、乗員Pの足部を支持するためのフットレスト11cが配設されている。また、座席11aの後方側(矢印B側)には、ケース11dが配設され、座席11の底面側(矢印D側)には、バッテリー装置(図示せず)などが配設されている。   As shown in FIG. 1, a footrest 11c for supporting the foot of the occupant P is disposed below the seat 11a on the front side (arrow F side). Further, a case 11d is disposed on the rear side (arrow B side) of the seat 11a, and a battery device (not shown) is disposed on the bottom surface side (arrow D side) of the seat 11.

なお、バッテリー装置は、後述する回転駆動装置52及びアクチュエータ装置53の駆動源である(いずれも図2参照)。また、ケース11dには、後述する制御装置70(図2参照)、各種センサ装置或いはインバータ装置(いずれも図示せず)などが収納されている。   The battery device is a drive source for a rotation drive device 52 and an actuator device 53 described later (both are shown in FIG. 2). Further, the case 11d accommodates a control device 70 (see FIG. 2), various sensor devices or inverter devices (none of which are shown), which will be described later.

左右の車輪12L,12Rは、後述するリンク機構30に支持されており、リンク機構30は、後述する連結リンク40を介して、乗員部11に連結されている(図6及び図7参照)。詳細構成については、後述する。   The left and right wheels 12L and 12R are supported by a link mechanism 30 described later, and the link mechanism 30 is connected to the occupant portion 11 via a connection link 40 described later (see FIGS. 6 and 7). The detailed configuration will be described later.

また、リンク機構30の下部には、停車時姿勢補助手段の一例としての補助バー90が設けられ、乗員Pが降車した後や走行時の走行車両1の転倒を防止する。   Further, an auxiliary bar 90 as an example of a stopping posture assisting unit is provided below the link mechanism 30 to prevent the traveling vehicle 1 from falling over after the occupant P gets off or during traveling.

次いで、図2を参照して、走行車両1の電気的構成について説明する。図2は、走行車両1の電気的構成を示したブロック図である。   Next, the electrical configuration of the traveling vehicle 1 will be described with reference to FIG. FIG. 2 is a block diagram showing an electrical configuration of the traveling vehicle 1.

制御装置70は、走行車両1の各部を制御するための制御装置であり、図2に示すように、CPU71、記憶手段の一例としてのROM72及びRAM73を備え、これらはバスライン74を介して入出力ポート75に接続されている。また、入出力ポート75には、ジョイスティック装置51等の複数の装置が接続されている。   The control device 70 is a control device for controlling each part of the traveling vehicle 1. As shown in FIG. 2, the control device 70 includes a CPU 71, a ROM 72 and a RAM 73 as examples of storage means, and these are input via a bus line 74. It is connected to the output port 75. A plurality of devices such as a joystick device 51 are connected to the input / output port 75.

CPU71は、バスライン74により接続された各部を制御する演算装置である。 ROM72は、CPU71により実行される制御プログラムや固定値データ等を格納した書き換え不能な不揮発性のメモリであり、本実施形態では、停車時移動空間マップ72aを含んでいる。RAM73は、制御プログラムの実行時に各種のワークデータやフラグ等を書き換え可能に記憶するためのメモリである。   The CPU 71 is an arithmetic unit that controls each unit connected by the bus line 74. The ROM 72 is a non-rewritable nonvolatile memory that stores a control program executed by the CPU 71, fixed value data, and the like, and includes a moving space map 72a when the vehicle is stopped in this embodiment. The RAM 73 is a memory for storing various work data, flags and the like in a rewritable manner when executing the control program.

操作装置の一例としてのジョイスティック装置51は、上述したように、走行車両1を運転する際に乗員Pが操作する装置であり、乗員Pにより操作される操作レバー(図1参照)と、その操作レバーの操作状態を検出するための前後センサ51a及び左右センサ51bと、それら各センサ51a,51bの検出結果を処理してCPU71に出力する処理回路(図示せず)とを主に備えている。   As described above, the joystick device 51 as an example of the operation device is a device that is operated by the occupant P when driving the traveling vehicle 1, an operation lever (see FIG. 1) operated by the occupant P, and its operation It mainly includes a front / rear sensor 51a and a left / right sensor 51b for detecting the operation state of the lever, and a processing circuit (not shown) that processes the detection results of the sensors 51a and 51b and outputs them to the CPU 71.

前後センサ51aは、操作レバーの前後方向(矢印F−B方向、図1参照)への操作状態(操作量)を検出するためのセンサであり、CPU71は、前後センサ51aの検出結果(操作レバーの前後操作量)に基づいて、回転駆動装置52の駆動状態を制御する。これにより、走行車両1は、乗員P示指示した走行速度で走行される。   The front-rear sensor 51a is a sensor for detecting an operation state (operation amount) in the front-rear direction of the operation lever (arrow FB direction, see FIG. 1). The CPU 71 detects the detection result of the front-rear sensor 51a (operation lever The driving state of the rotary drive device 52 is controlled on the basis of the front-rear operation amount. Thereby, the traveling vehicle 1 travels at the traveling speed indicated by the occupant P.

左右センサ51bは、操作レバーの左右方向(矢印L−R方向、図1参照)への操作状態(操作量)を検出するためのセンサであり、CPU71は、左右センサ51bの検出結果(操作レバーの左右操作量)に基づいて、回転駆動装置52とアクチュエータ装置53との駆動状態をそれぞれ制御する。これにより、走行車両1は、運転者が指示した旋回半径で旋回される。   The left / right sensor 51b is a sensor for detecting the operation state (operation amount) of the operation lever in the left / right direction (arrow LR direction, see FIG. 1). The CPU 71 detects the detection result (operation lever) of the left / right sensor 51b. The left and right operation amounts), the drive states of the rotary drive device 52 and the actuator device 53 are controlled. Thus, the traveling vehicle 1 is turned at the turning radius instructed by the driver.

即ち、操作レバーが左右方向に操作されると、CPU71は、左右センサ51bの検出結果に基づいて、旋回方向と旋回半径とを判断し、左右の車輪12L,12Rが旋回内側へ傾斜されるように、アクチュエータ装置53を駆動制御すると共に(図8参照)、旋回半径に応じて左右の車輪12L,12Rが差動されるように、回転駆動装置52を駆動制御する。その結果、左右の車輪12L,12Rにキャンバ角が付与されると共に、乗員部11が旋回内側へ傾斜され、旋回性能の向上と乗員Pの快適性の確保とが達成される。   That is, when the operating lever is operated in the left-right direction, the CPU 71 determines the turning direction and turning radius based on the detection result of the left-right sensor 51b, so that the left and right wheels 12L, 12R are tilted inward of the turning. In addition, the actuator device 53 is driven and controlled (see FIG. 8), and the rotary drive device 52 is driven and controlled so that the left and right wheels 12L and 12R are differentiated according to the turning radius. As a result, camber angles are imparted to the left and right wheels 12L and 12R, and the occupant portion 11 is tilted inward of the turn, thereby improving the turning performance and ensuring the comfort of the occupant P.

なお、このように、本発明の走行車両1では、左右の車輪12L,12Rにキャンバ角を付与して、キャンバスラストを発生させると共に、左右林の回転駆動力に差を設けることにより、走行車両1を旋回させる。よって、本実施の形態では、左右の車輪12L,12Rの中心線は互いに平行に保持されており、左右に操舵されることはない。但し、操舵機構を設けても良い。   As described above, in the traveling vehicle 1 according to the present invention, the camber angle is given to the left and right wheels 12L and 12R to generate the canvas last, and the difference in the rotational driving force between the left and right forests is provided. Rotate 1 Therefore, in the present embodiment, the center lines of the left and right wheels 12L and 12R are held parallel to each other and are not steered to the left and right. However, a steering mechanism may be provided.

回転駆動装置52は、左右の車輪12L,12Rを回転駆動させるための駆動装置であり、左の車輪12Lに回転駆動力を付与するLモータ52Lと、右の車輪12Rに回転駆動力を付与するRモータ52Rと、それら各モータ52L,52RをCPU71からの命令に基づいて駆動制御する駆動回路及び駆動源(いずれも図示せず)とを主に備えて構成されている。   The rotational drive device 52 is a drive device for rotationally driving the left and right wheels 12L and 12R. The rotational motor 52L applies rotational drive force to the left wheel 12L, and applies rotational drive force to the right wheel 12R. The motor mainly includes an R motor 52R, and a drive circuit and a drive source (both not shown) that drive and control the motors 52L and 52R based on a command from the CPU 71.

アクチュエータ装置53は、後述するリンク機構30を屈伸させるための駆動装置であり、リンク機構30の前方側(図7参照、矢印F側)に配設されるFアクチュエータ53Fとリンク機構30の後方側(図7参照、矢印B側)に配設されるBアクチュエータ53Bと、それら各アクチュエータ53L,53RをCPU71からの命令に基づいて駆動制御する駆動回路及び駆動源(いずれも図示せず)とを主に備えている。   The actuator device 53 is a drive device for bending and extending a link mechanism 30 described later, and an F actuator 53F disposed on the front side of the link mechanism 30 (see FIG. 7, arrow F side) and the rear side of the link mechanism 30. (See FIG. 7, arrow B side) B actuator 53B, and a drive circuit and a drive source (none of which are shown) for driving and controlling each of the actuators 53L and 53R based on a command from the CPU 71 Mainly prepared.

なお、本実施の形態では、各アクチュエータ53F,53Bが伸縮式の電動アクチュエータ、即ち、ボールねじ機構(外周面に螺旋状のねじ溝を有するねじ軸と、そのねじ軸のねじ溝に対応する螺旋状のねじ溝を内周面に有しねじ軸に嵌合されるナットと、それらナットとねじ軸の両ねじ溝の間に転勤可能に装填された多数の転動体と、ねじ軸又はナットを回転駆動する電動モータとを備え、ねじ軸又はナットが電動モータにより回転駆動されることで、ねじ軸がナットに対して相対移動する機構)を利用した伸縮可能な電動アクチュエータとして構成されている。   In the present embodiment, each actuator 53F, 53B is a telescopic electric actuator, that is, a ball screw mechanism (a screw shaft having a helical thread groove on the outer peripheral surface and a spiral corresponding to the thread groove of the screw shaft. A nut having a thread-like thread groove on the inner peripheral surface, fitted to the screw shaft, a large number of rolling elements loaded so as to be able to transfer between both nut grooves of the screw shaft and the screw shaft or nut. An electric motor that rotates, and is configured as an electric actuator that can be extended and contracted using a mechanism in which the screw shaft or the nut moves relative to the nut when the screw shaft or the nut is rotationally driven by the electric motor.

乗員検知装置54は、乗員部11に備えた座席11aの座面部11a1下に配置する重量センサ等を配置することにより構成する。また、乗員部11に赤外線センサ等を配置してもよい。   The occupant detection device 54 is configured by disposing a weight sensor or the like disposed below the seat surface portion 11a1 of the seat 11a provided in the occupant portion 11. Further, an infrared sensor or the like may be disposed on the occupant portion 11.

降車手続手段の一例としての降車スイッチ55は、回転駆動装置52やアクチュエータ装置53等の電源を切断するスイッチで、乗員Pが降車し、走行制御を停止し、走行車両を停車させる際に使用する。   The dismounting switch 55 as an example of dismounting procedure means is a switch that cuts off the power supply of the rotary drive device 52, the actuator device 53, etc., and is used when the occupant P gets off, stops traveling control, and stops the traveling vehicle. .

タイマ56は、後述する停車時制御の際に使用するもので、乗員検知装置54が乗員Pを検出せず、且つ、降車スイッチ55による電源OFFが実行されない場合にカウントを行うもので、乗員Pの降車が一時的なものかを判断するために使用される。   The timer 56 is used for stop-time control, which will be described later, and counts when the occupant detection device 54 does not detect the occupant P and the power-off by the getting-off switch 55 is not executed. It is used to judge whether getting off is temporary.

周辺監視装置57は、前方センサ57a及び後方センサ57bを有し、走行車両1周辺の障害物Oの有無を確認するための装置であり、例えば、レーザ、ミリ波、超音波等のレーダやカメラ等による画像処理により確認する。前方センサ57aは走行車両1の前方を、後方センサ57bは車両1の後方を監視する。なお、本実施形態では、説明を簡易にするため、前方センサ57aと後方センサ57bという構成にしたが、後述する停車時移動空間マップ72aに基づき、当該停車時移動空間マップ72aの内側を検出する第1センサと、停車時移動空間マップ72aの外側を検出する第2センサとして構成することも可能である。   The peripheral monitoring device 57 includes a front sensor 57a and a rear sensor 57b, and is a device for confirming the presence or absence of an obstacle O around the traveling vehicle 1. For example, a radar or a camera such as a laser, millimeter wave, or ultrasonic wave Confirm by image processing such as. The front sensor 57a monitors the front of the traveling vehicle 1, and the rear sensor 57b monitors the rear of the vehicle 1. In the present embodiment, the front sensor 57a and the rear sensor 57b are configured to simplify the description, but the inside of the stop-time moving space map 72a is detected based on a stop-time moving space map 72a described later. It is also possible to configure the first sensor and a second sensor that detects the outside of the moving space map 72a when the vehicle is stopped.

点灯手段の一例としての警告灯58は、走行車両1が停車状態となった時に点灯させ、周囲に走行車両1の停車状態を知らせるものである。   The warning lamp 58 as an example of the lighting means is turned on when the traveling vehicle 1 is stopped and informs the surrounding state of the traveling vehicle 1.

図2に示す他の入出力装置59としては、例えば、走行車両1の走行状態(走行速度や走行距離など)を検出する検出装置、その検出装置により検出された走行状態を表示して乗員Pに報知する表示装置(図示せず)、或いは、走行車両1に作用する加速度を検出する加速度センサなどが例示される。   As another input / output device 59 shown in FIG. 2, for example, a detection device that detects the traveling state (traveling speed, traveling distance, etc.) of the traveling vehicle 1, the traveling state detected by the detecting device, and the occupant P A display device (not shown) for informing the vehicle or an acceleration sensor for detecting acceleration acting on the traveling vehicle 1 is exemplified.

次いで、図3を参照して、L及びRモータ52L,52Rについて説明する。図3(a)は、Rモータ52Rの正面図であり、図3(b)は、Rモータ52Rの側面図である。なお、Lモータ52LとRモータ52Rとは互いに同一に構成されるものであるので、Lモータ52Lについての説明は省略する。   Next, the L and R motors 52L and 52R will be described with reference to FIG. FIG. 3A is a front view of the R motor 52R, and FIG. 3B is a side view of the R motor 52R. Note that the L motor 52L and the R motor 52R are configured in the same manner, and thus the description of the L motor 52L is omitted.

Rモータ52Rは、上述したように、右の車輪12Rに回転駆動力を付与するための駆動装置であり、電動モータとして構成されている。また、Rモータ52Rは、いわゆるインホイールモータとして構成され、図3に示すように、走行車両1の外方側(矢印R側)にはハブ52aが、走行車両1の内方側(矢印L側)には上部及び下部軸支プレート52b,52cが、それぞれ配設されている。   As described above, the R motor 52R is a drive device for applying a rotational driving force to the right wheel 12R, and is configured as an electric motor. Further, the R motor 52R is configured as a so-called in-wheel motor, and as shown in FIG. 3, a hub 52a is provided on the outer side (arrow R side) of the traveling vehicle 1 and the inner side (arrow L) of the traveling vehicle 1. The upper and lower pivot plates 52b and 52c are respectively disposed on the side).

ハブ52aは、右の車輪12Rのホイール12Raがハブナット及びハブボルトにより締結固定される部位であり(図6及び図7参照)、図3(a)に示すように、Rモータ52Rの駆動軸(図示せず)の軸心Oと同心の円板状に形成されている。Rモータ52Rの駆動軸が回転駆動されると、その回転が、ハブ52aを介して、ホイール12Ra伝達され、右の車輪12Rが回転駆動される。   The hub 52a is a portion to which the wheel 12Ra of the right wheel 12R is fastened and fixed by a hub nut and a hub bolt (see FIGS. 6 and 7). As shown in FIG. 3A, the drive shaft (see FIG. It is formed in a disc shape concentric with the axis O (not shown). When the drive shaft of the R motor 52R is rotationally driven, the rotation is transmitted to the wheel 12Ra via the hub 52a, and the right wheel 12R is rotationally driven.

上部軸支プレート52b及び下部軸支プレート52cは、後述する上部リンク31及び下部リンク32の端部をそれぞれ軸支するための部材であり(図6及び図7参照)、図3に示すように、Rモータ52Rの側面(矢印L側面)に溶接固定されている。また、上部及び下部軸支プレート52b,52cには、上部及び下部リンク3 1,32を軸支するための貫通孔52b1,52c1がそれぞれ穿設されている。   The upper pivot support plate 52b and the lower pivot support plate 52c are members for pivotally supporting end portions of an upper link 31 and a lower link 32 described later (see FIGS. 6 and 7), as shown in FIG. , And fixed to the side surface (side surface of the arrow L) of the R motor 52R by welding. The upper and lower shaft support plates 52b and 52c are provided with through holes 52b1 and 52c1 for supporting the upper and lower links 31 and 32, respectively.

なお、上部及び下部軸支プレート52b,52cは、図3(b)に示すように、それぞれ一対が所定間隔を隔てつつ互いに対向して配設されている。本実施の形態では、これら両対向間隔(矢印F−B方向才法)が互いに等しい寸法に設定されている。   As shown in FIG. 3B, a pair of the upper and lower shaft support plates 52b and 52c are arranged to face each other with a predetermined distance therebetween. In the present embodiment, these opposing intervals (arrow FB direction method) are set to the same size.

また、本実施の形態では、上部軸支プレート52bの貫通孔52b1と下部軸支プレート52cの貫通孔52c1とを結ぶ仮想線がRモータ52Rの軸心Oと直交するように構成されている。これにより、後述するように、リンク機構30を4節の平行リンク機構として構成することができる(図8参照)。   In the present embodiment, the imaginary line connecting the through hole 52b1 of the upper shaft support plate 52b and the through hole 52c1 of the lower shaft support plate 52c is configured to be orthogonal to the axis O of the R motor 52R. Thereby, as will be described later, the link mechanism 30 can be configured as a four-node parallel link mechanism (see FIG. 8).

次いで、図4を参照して、上部リンク31及び下部リンク32について説明する。図4(a)は、上部リンク31及び下部リンク32の正面図であり、図4(b)は、上部リンク31及び下部リンク32の上面図である。   Next, the upper link 31 and the lower link 32 will be described with reference to FIG. 4A is a front view of the upper link 31 and the lower link 32, and FIG. 4B is a top view of the upper link 31 and the lower link 32.

上部リンク31及び下部リンク32は、R及びLモータ52R,52Lに両端が軸支され、それらR及びLモータ52R,52Lと共に4節のリンク機構を構成するための部材であり(図6乃至図8参照)、図4に示すように、互いに同一の形状、即ち、正面視略矩形の板状体として構成されている。   The upper link 31 and the lower link 32 are members that are pivotally supported by the R and L motors 52R and 52L, and constitute a four-node link mechanism together with the R and L motors 52R and 52L (FIGS. 6 to 6). 8), as shown in FIG. 4, they are configured as plate-like bodies having the same shape, that is, substantially rectangular in front view.

なお、上部及び下部リンク31,32の両端に穿設される貫通孔33R,33Lは、R及びLモータ52R,52Lの上部軸支プレート52b(貫通孔52b1)に軸支される部位であり、上部及び下部リンク31,32の長手方向(図4左右方向)中央部に穿設される貫通孔33Cは、後述する連結リンク40に軸支される部位である(図6乃至図8参照)。   The through holes 33R and 33L drilled at both ends of the upper and lower links 31 and 32 are portions that are pivotally supported by the upper shaft support plates 52b (through holes 52b1) of the R and L motors 52R and 52L. A through-hole 33C drilled in the central portion in the longitudinal direction (left-right direction in FIG. 4) of the upper and lower links 31 and 32 is a portion that is pivotally supported by a connecting link 40 described later (see FIGS. 6 to 8).

また、本実施の形態では、2枚の上部リンク31と2枚の下部リンク32との両端をそれぞれRモータ52R及びLモータ52Lに軸支して、リンク機構30を構成する。詳細については、後述する(図6及び図7参照)。   In the present embodiment, the link mechanism 30 is configured by pivotally supporting both ends of the two upper links 31 and the two lower links 32 with the R motor 52R and the L motor 52L, respectively. Details will be described later (see FIGS. 6 and 7).

次いで、図5を参照して、連結リンク40について説明する。図5(a)は、連結リンク40の正面図であり、図5(b)は、連結リンク40の側面図であり、図5(c)は、連結リンク40の上面図である。   Next, the connecting link 40 will be described with reference to FIG. 5A is a front view of the connecting link 40, FIG. 5B is a side view of the connecting link 40, and FIG. 5C is a top view of the connecting link 40. FIG.

連結リンク40は、リンク機構30と乗員部11とを連結するための部材であり、連結部材41と乗員支持部材42とを主に備える。連結部材41は、上部及び下部リンク31,32との連結部となる部位であり、図5(b)に示すように、側面視略U字状に形成され、その上端部が後述する乗員支持部42に接続されている。   The connection link 40 is a member for connecting the link mechanism 30 and the occupant portion 11, and mainly includes a connection member 41 and an occupant support member 42. The connecting member 41 is a portion that becomes a connecting portion between the upper and lower links 31 and 32, and is formed in a substantially U shape in a side view as shown in FIG. Connected to the unit 42.

なお、図5(a)に示すように、連結部材41の上方(矢印U側)に穿設される貫通孔43aは、上部リンク31の貫通孔33Cに軸支される部位であり、連結部材41の下方(矢印D側)に穿設される貫通孔43bは、下部リンク32の貫通孔33Cに軸支される部位である(図6乃至図8参照)。   As shown in FIG. 5A, the through hole 43a formed above the connecting member 41 (arrow U side) is a part that is pivotally supported by the through hole 33C of the upper link 31, and the connecting member A through hole 43b drilled below 41 (arrow D side) is a part pivotally supported by the through hole 33C of the lower link 32 (see FIGS. 6 to 8).

乗員支持部42は、乗員部11(座席11a)を底面側(矢印D側、図6参照)から支持するための部材であり、図5(a)に示すように、正面視略U字状に形成される一対の部材が、図5(b)及び図5(c)に示すように、棒状体により連結され一体化されている。   The occupant support part 42 is a member for supporting the occupant part 11 (seat 11a) from the bottom surface side (arrow D side, see FIG. 6). As shown in FIG. As shown in FIGS. 5B and 5C, the pair of members formed in is connected and integrated by a rod-shaped body.

次いで、図6及び図7を参照して、リンク機構30の詳細構成について説明する。図6は、リンク機構30の正面図であり、図7は、リンク機構30の上面図である。なお、図6及び図7では、図面を簡略化して理解を容易とするために、アームレスト11bやフットレスト11cなどの図示が省略されると共に、左右の車輪12L,12Rや連結リンク40などが断面視されている。   Next, the detailed configuration of the link mechanism 30 will be described with reference to FIGS. 6 and 7. FIG. 6 is a front view of the link mechanism 30, and FIG. 7 is a top view of the link mechanism 30. 6 and 7, the armrest 11b, the footrest 11c, etc. are not shown in order to simplify the drawings for easy understanding, and the left and right wheels 12L, 12R, the connecting link 40, etc. are viewed in cross section. Has been.

図6及び図7に示すように、上部リンク31の両端がRモータ52R及びLモータ52Lの上部軸支プレート52bに回転可能に軸支され、同様に、下部リンク32の両端がRモータ52R及びLモータ52Lの下部軸支プレート52cにそれぞれ回転可能に軸支されることで、これら上部及び下部リンク3 1,32とR及びLモータ52R,52Lとにより、4節のリンク機構30が平行リンクとして構成される。   As shown in FIGS. 6 and 7, both ends of the upper link 31 are rotatably supported by the upper shaft support plate 52b of the R motor 52R and the L motor 52L, and similarly, both ends of the lower link 32 are connected to the R motor 52R and By being rotatably supported by the lower shaft support plate 52c of the L motor 52L, the upper and lower links 31 and 32 and the R and L motors 52R and 52L allow the four-link mechanism 30 to be parallel links. Configured as

ここで、本実施の形態では、図6及び図7に示すように、一対のモータ装置(即ち、L及びRモータ52L,52R)が左右の車輪12L,12Rに回転駆動力を付与する回転駆動装置として機能するように構成したので、例えば、デファレンシヤル装置を設けると共にそのデファレンシヤル装置と左右の車輪12L,12Rとを等速ジョイントにより連結するといった複雑な構成を設けることなく、左右の車輪12L,12Rを差動させることができる。   Here, in this embodiment, as shown in FIGS. 6 and 7, a pair of motor devices (that is, the L and R motors 52L and 52R) rotate and apply a rotational driving force to the left and right wheels 12L and 12R. Since the device is configured to function as a device, for example, the left and right wheels 12L and 12R are provided without providing a complicated configuration in which a differential device is provided and the differential device and the left and right wheels 12L and 12R are connected by a constant velocity joint. Can be made differential.

同時に、本実施の形態では、かかる一対のモータ装置(L及びRモータ52L,52R)が回転駆動装置と左右(一対)の車輪支持体とを兼用する構成としたので、部品点数を低減して、構造を簡素化することができる。その結果、軽量化や部品・組立コストの削減を図ることができる。   At the same time, in the present embodiment, the pair of motor devices (L and R motors 52L and 52R) is configured to serve as both the rotation drive device and the left and right (a pair of) wheel supports, thereby reducing the number of parts. The structure can be simplified. As a result, it is possible to reduce weight and reduce parts / assembly costs.

また、図6及び図7に示すように、連結リンク40は、連結部材41が上部リンク31及び上部リンク32に軸支されると共に、乗員支持部材42が乗員部11(座席11a)を底面側から支持する。これにより、後述するように、リンク機構30の屈伸に伴って、連結リンク40を傾斜させることができ、その結果、乗員部11を旋回内輪側へ傾斜させることができる(図8参照)。   As shown in FIGS. 6 and 7, the connection link 40 includes a connection member 41 that is pivotally supported by the upper link 31 and the upper link 32, and an occupant support member 42 that supports the occupant 11 (seat 11 a) on the bottom side. Support from. Thereby, as will be described later, the connecting link 40 can be inclined as the link mechanism 30 bends and stretches, and as a result, the occupant portion 11 can be inclined toward the turning inner wheel (see FIG. 8).

また、図6及び図7に示すように、リンク機構30の前方側(矢印F側)及び後方側(矢印B側)には、Fアクチュエータ53F及びBアクチュエータ53Bがそれぞれ配設されている。F及びBアクチュエータ53F,53Bは、上述したように、リンク機構30を屈伸させるための駆動装置であり、その両端が4節のリンク機構30の互いに隣り合わない支持軸に接続されている。   As shown in FIGS. 6 and 7, an F actuator 53F and a B actuator 53B are provided on the front side (arrow F side) and the rear side (arrow B side) of the link mechanism 30, respectively. As described above, the F and B actuators 53 </ b> F and 53 </ b> B are driving devices for bending and extending the link mechanism 30, and both ends thereof are connected to non-adjacent support shafts of the four-link mechanism 30.

即ち、図6及び図7に示すように、Fアクチュエータ53Fは、その下端(本体節側)がRモータ52Rの下部軸支プレート52cに支持軸80Fcを介して軸支される一方、その上端側(ロッド側)がLモータ52Lの上部軸支プレート52bに支持軸80Fbを介して軸支される。これにより、Fアクチュエータ53Fが4節のリンク機構30の対角線上にたすき掛けされる。   That is, as shown in FIGS. 6 and 7, the F actuator 53F has its lower end (main body node side) supported on the lower shaft support plate 52c of the R motor 52R via the support shaft 80Fc, while its upper end side. The (rod side) is pivotally supported on the upper pivot support plate 52b of the L motor 52L via the support shaft 80Fb. As a result, the F actuator 53F is knocked on the diagonal line of the four-node link mechanism 30.

また、図7に示すように、Bアクチュエータ53Bは、その下端(本体節側)がLモータ52Lの下部軸支プレート52cに支持軸80Bdを介して軸支される一方、その上端側(ロッド側)がRモータ52Rの上部軸支プレート52bに支持軸80Baを介して軸支される。これにより、Bアクチュエータ53Bが4節のリンク機構30の対角線上にたすき掛けされる。また、これらF及びBアクチュエータ53F,53Bが互いに交差する向きに配置される。   As shown in FIG. 7, the B actuator 53B has a lower end (main body node side) pivotally supported by a lower shaft support plate 52c of the L motor 52L via a support shaft 80Bd, and an upper end side (rod side). ) Is supported on the upper shaft support plate 52b of the R motor 52R via the support shaft 80Ba. As a result, the B actuator 53B is knocked on the diagonal line of the four-node link mechanism 30. Further, the F and B actuators 53F and 53B are arranged so as to cross each other.

このように、F及びBアクチュエータ53F,53Bの両端を4節のリンク機構30の互いに隣り合わない支持軸に接続(即ち、4節のリンク機構30の対角線上にたすき掛け)したので、力の作用点(例えば、図6に示すように、Fアクチュエータ53Fであれば、支持軸80Fb及び支持軸80Fc)から回転中心(Fアクチュエータ53Fの両端が接続されない残りの支持軸80Fa及び支持軸80Fd)までの距離を最大として、その分、リンク機構30の屈伸に必要な駆動力を小さくすることができる。   In this way, both ends of the F and B actuators 53F and 53B are connected to the support shafts that are not adjacent to each other in the four-node link mechanism 30 (that is, they are struck on the diagonal line of the four-node link mechanism 30). From the action point (for example, as shown in FIG. 6, in the case of the F actuator 53F, the support shaft 80Fb and the support shaft 80Fc) to the rotation center (the remaining support shaft 80Fa and the support shaft 80Fd to which both ends of the F actuator 53F are not connected). As a result, the driving force necessary for bending and stretching the link mechanism 30 can be reduced accordingly.

その結果、リンク機構30の屈伸をスムーズ(即ち、高速高精度)に行うことができると共に、アクチュエータ(F及びBアクチュエータ53F,53B)に要求される駆動性能を低く抑えることができるので、アクチュエータやその駆動源などを小型化して、軽量化と部品コストの削滅とを図ることができる。   As a result, the link mechanism 30 can be bent and stretched smoothly (that is, at high speed and high accuracy) and the drive performance required for the actuators (F and B actuators 53F and 53B) can be kept low. By reducing the size of the drive source and the like, it is possible to reduce the weight and the cost of parts.

また、上記した力の作用点から回転中心までの距離を長くするべくアームをリンク機構30に更に設ける場合には、そのアームの分だけ重量が嵩むと共に、リンク機構30の屈伸時にアームやアクチュエータがリンク機構の外形よりも外方に突出し、小型化を図ることができない。   Further, when an arm is further provided in the link mechanism 30 so as to increase the distance from the point of application of the force to the center of rotation, the weight increases by the amount of the arm, and the arm and the actuator are not bent when the link mechanism 30 is bent and extended. It projects outward from the outer shape of the link mechanism and cannot be downsized.

これに対し、本実施の形態のように、アクチュエータ(F及びBアクチュエータ53F,53B)の両端をリンク機構の対角線上にたすき掛けする構成であれば、アームを設けることなく上記の距離を最大とすることができると共に、リンク機構30の屈伸時にアクチュエータがリンク機構の外形から外方に突出することを回避して、小型化を図ることができる。   On the other hand, if the configuration is such that the ends of the actuators (F and B actuators 53F and 53B) are knocked on the diagonal of the link mechanism as in the present embodiment, the above distance is maximized without providing an arm. In addition, the actuator can be prevented from protruding outward from the outer shape of the link mechanism when the link mechanism 30 is bent and stretched, and the size can be reduced.

また、上述したように、一対のアクチュエータ(F及びBアクチュエータ53F,53B)を互いに交差する向きに配置したので、これらを互いに同方向に配置する場合と比較して、リンク機構30をいずれの方向へも均等に屈伸させ、旋回動作の安定性を確保することができる。   Further, as described above, since the pair of actuators (F and B actuators 53F and 53B) are arranged so as to cross each other, the link mechanism 30 can be moved in any direction as compared with the case where they are arranged in the same direction. Can be bent evenly, ensuring the stability of the turning motion.

例えば、1のアクチュエータを4節のリンク機構30の対角線上にたすき掛けする構成では、リンク機構30を中立位置から1の方向(例えば、右旋回に対応)へ屈伸させるべく、アクチュエータを伸長させると、その伸長に伴って、力の作用方向とリンク機構20の節との成す角度(例えば、図8(b)において、Fアクチュエータ53FとLモータ52Lとの成す角度)が漸次O゜に近づく。   For example, in a configuration in which one actuator is put on the diagonal line of the four-node link mechanism 30, the actuator is extended so that the link mechanism 30 bends and extends from the neutral position to one direction (for example, corresponding to a right turn). With this extension, the angle formed by the direction of the force and the node of the link mechanism 20 (for example, the angle formed by the F actuator 53F and the L motor 52L in FIG. 8B) gradually approaches O °. .

即ち、アクチュエータからリンク機構30に作用する力の内のリンク機構30の節を回転させるための力成分(即ち、1の節の回転中心と力の作用点とを接続する仮想線に対して直交する方向の力成分、例えば、図8(b)において、Lモータ52Lを1の節とした場合には、その1の節の回転中心は支持軸80Fdであり、力の作用点は支持軸80bとなる。よって、仮想線は、これら支持軸80Fdと支持軸80Fbを接続する線となる)の割合が減少される。   That is, the force component for rotating the node of the link mechanism 30 among the forces acting on the link mechanism 30 from the actuator (that is, orthogonal to the imaginary line connecting the rotation center of one node and the action point of the force). For example, in FIG. 8B, when the L motor 52L has one node, the center of rotation of the one node is the support shaft 80Fd, and the point of action of the force is the support shaft 80b. Therefore, the ratio of the virtual line becomes a line connecting the support shaft 80Fd and the support shaft 80Fb) is reduced.

一方、リンク機構30を中立位置から他の方向(左旋回に対応)へ屈伸させるべく、アクチュエータを短縮させると、その短縮に伴って、力の作用方向とリンク機構30の節との成す角度が漸次9 0゜ に近づく。   On the other hand, when the actuator is shortened so that the link mechanism 30 bends and stretches from the neutral position to the other direction (corresponding to the left turn), the angle formed between the direction of the force and the node of the link mechanism 30 is reduced. Gradually approaching 90 °.

即ち、アクチュエータからリンク機構30に作用する力の内のリンク機構30の節を回転させるための力成分(即ち、1の節の回転中心と力の作用点とを接続する仮想線に対して直交する方向の力成分)の割合が増加される。   That is, the force component for rotating the node of the link mechanism 30 among the forces acting on the link mechanism 30 from the actuator (that is, orthogonal to the imaginary line connecting the rotation center of one node and the action point of the force). The ratio of the force component in the direction to be increased.

このように、リンク機構30を屈伸させる場合、アクチュエータを伸長させる工程では、短縮させる工程よりも大きな駆動力が必要とされる(言い換えれば、アクチュエータを短縮させる工程は、伸長させる工程よりも少ない駆動力でリンク機構30を屈伸させることができる)。   Thus, when the link mechanism 30 is bent and stretched, the step of extending the actuator requires a larger driving force than the step of shortening (in other words, the step of shortening the actuator requires less driving than the step of extending. The link mechanism 30 can bend and stretch with force).

従って、アクチュエータ(F及びBアクチュエータ53F,53B)を一対備える場合、これら一対のアクチュエータを互いに同方向に配置したのでは、リンク機構30を1の方向へ屈伸させる(即ち、アクチュエータを伸長させる)工程と他の方向へ屈伸させる(即ち、アクチュエータを短縮させる)工程とに要する駆動力がそれぞれ異なることとなるため、リンク機構30の屈伸量や屈伸速度を両方向(即ち、右旋回及び左旋回)で高精度に一致させることが困難となる。   Accordingly, when a pair of actuators (F and B actuators 53F and 53B) is provided, the step of bending and extending the link mechanism 30 in the direction of 1 (that is, extending the actuator) if the pair of actuators are arranged in the same direction. Since the driving force required for the step of bending and stretching in the other direction (that is, shortening the actuator) is different, the amount of bending and stretching and the rate of bending and stretching of the link mechanism 30 are different in both directions (that is, right turn and left turn). This makes it difficult to match with high accuracy.

その結果、リンク機構30の屈伸、即ち、走行車両1の旋回動作が不安定となり、乗員Pの操作感や旋回性能の悪化を招くという不具合が生じる。更に、アクチュエータの作動制御が複雑化して、制御コストの増大を招く。   As a result, the bending and stretching of the link mechanism 30, that is, the turning operation of the traveling vehicle 1, becomes unstable, causing a problem that the operability of the passenger P and the turning performance are deteriorated. Further, the operation control of the actuator becomes complicated, and the control cost increases.

これに対し、本実施形態では、一対のアクチュエータ(F及びBアクチュエータ53F,53B)を互いに交差する向きに配置したので、リンク機構30のいずれの方向への屈伸も同じ駆動力で行うことができ、屈伸動作(旋回性能)の安定性を確保することができると共に、CPU71の制御コストの削減を図ることができる。   On the other hand, in this embodiment, since the pair of actuators (F and B actuators 53F and 53B) are arranged so as to intersect each other, the link mechanism 30 can be bent and stretched in any direction with the same driving force. In addition, it is possible to ensure the stability of the bending operation (turning performance) and to reduce the control cost of the CPU 71.

なお、本実施の形態では、図6及び図7に示すように、F及びBアクチュエータ53F,53Bの本体節側がロッド側よりも下方に位置するように配置した。これにより、重量が嵩む部位を走行車両1の下方に位置させ、走行車両1の重心位置を下げることができるので、その分、旋回性能の向上を図ることができる。   In the present embodiment, as shown in FIGS. 6 and 7, the F and B actuators 53F and 53B are arranged such that the main body node side is located below the rod side. As a result, since the portion where the weight is increased can be positioned below the traveling vehicle 1 and the center of gravity of the traveling vehicle 1 can be lowered, the turning performance can be improved accordingly.

図6及び図7に示すように、リンク機構30の前方側(矢印F側)及び後方側(矢印B側)には、弾性ばね装置60F,60Bがそれぞれ配設されている。これら弾性ばね装置60F,60Bは、リンク機構30がいずれの方向へ屈伸された場合でも、そのリンク機構30に付勢力を付勢して中立位置へ復帰させるための駆動装置であり、金属製のコイルスプリングとして構成されている。   As shown in FIGS. 6 and 7, elastic spring devices 60F and 60B are disposed on the front side (arrow F side) and the rear side (arrow B side) of the link mechanism 30, respectively. These elastic spring devices 60F and 60B are drive devices for energizing the link mechanism 30 to return it to the neutral position regardless of the direction in which the link mechanism 30 is bent or stretched. It is configured as a coil spring.

これら弾性ばね装置60F,60Bは、互いに同一材料から同一の形状に構成されており、上述したF及びBアクチュエータ53F,53Bの場合と同様に、その両端が4節のリンク機構30の互いに隣り合わない支持軸に接続されている。   These elastic spring devices 60F and 60B are made of the same material and have the same shape, and, as in the case of the F and B actuators 53F and 53B described above, the both ends of the link mechanism 30 having four nodes are adjacent to each other. Not connected to the support shaft.

即ち、図6及び図7に示すように、弾性ばね装置60Fは、その下端側がLモータ52Lの下部軸支プレート52cに支持軸80Fdを介して軸支される一方、その上端側がRモータ52Rの上部軸支プレート52bに支持軸80Faを介して軸支される。これにより、弾性ばね装置60Fが、Fアクチュエータ53Fと直交しつつ、4節のリンク機構30の対角線上にたすき掛けされる。   That is, as shown in FIGS. 6 and 7, the elastic spring device 60F has its lower end supported on the lower shaft support plate 52c of the L motor 52L via the support shaft 80Fd, and its upper end connected to the R motor 52R. The upper shaft support plate 52b is supported by a support shaft 80Fa. As a result, the elastic spring device 60F is knocked on the diagonal line of the four-node link mechanism 30 while being orthogonal to the F actuator 53F.

また、図7に示すように、弾性ばね装置60Bは、その下端がRモータ52Rの下部軸支プレート52cに支持軸80Bcを介して軸支される一方、その上端側がLモータ52Lの上部軸支プレート52bに支持軸80Bbを介して軸支される。これにより、弾性ばね装置60Bが、Bアクチュエータ53Bと直交しつつ、4節のリンク機構30の対角線上にたすき掛けされる。また、これら弾性ばね装置60F,60Bも互いに交差する向きに配置される。   As shown in FIG. 7, the elastic spring device 60B has a lower end pivotally supported by a lower pivot support plate 52c of the R motor 52R via a support shaft 80Bc, and an upper end side supported by the upper pivot support of the L motor 52L. It is pivotally supported on the plate 52b via a support shaft 80Bb. As a result, the elastic spring device 60B is knocked on the diagonal line of the four-node link mechanism 30 while being orthogonal to the B actuator 53B. Further, these elastic spring devices 60F and 60B are also arranged in a direction crossing each other.

このように、本実施の形態では、弾性ばね装置60F,60Bを備え、リンク機構30がいずれの方向へ屈伸される場合でも、そのリンク機構30へ付勢力を付勢して中立位置へ復帰させることができるので、F及びBアクチュエータ53F,53Bを常時駆動してリンク機構30を中立位置に保持することを不要とすることができる。よって、リンク機構30を中立位置に保持するための制御及び駆動を不要として、制御コスト及び駆動コストの削減を図ることができる。   As described above, in the present embodiment, the elastic spring devices 60F and 60B are provided, and even when the link mechanism 30 is bent or stretched in any direction, the biasing force is applied to the link mechanism 30 to return to the neutral position. Therefore, it is unnecessary to constantly drive the F and B actuators 53F and 53B to hold the link mechanism 30 in the neutral position. Therefore, the control and drive for holding the link mechanism 30 in the neutral position are not required, and the control cost and drive cost can be reduced.

また、F及びBアクチュエータ53F,53Bの駆動は、リンク機構30をいずれかの方向へ屈伸させる場合のみ行えば良く、リンク機構30を中立位置へ復帰させるための駆動を不要とすることができるので、その分、駆動コストの削減を図ることができる。但し、中立位置への復帰工程においても、F及びBアクチュエータ53F,53Bを駆動するように構成しても良い。これにより、復帰工程の高速化や旋回状態の安定化を図ることができる。   The F and B actuators 53F and 53B need only be driven when the link mechanism 30 is bent or stretched in any direction, and the drive for returning the link mechanism 30 to the neutral position can be made unnecessary. Therefore, the driving cost can be reduced accordingly. However, the F and B actuators 53F and 53B may be driven also in the step of returning to the neutral position. As a result, it is possible to speed up the return process and stabilize the turning state.

更に、本実施の形態では、上述したように、弾性ばね装置60F,60Bを互いに交差する向きに配置したので、上述したアクチュエータ(F及びBアクチュエータ53F,53B)の場合と同様に、互いに同方向に配置する場合と比較して、リンク機構30の中立位置への復帰動作や保持動作を安定して行うことができる。   Furthermore, in the present embodiment, as described above, the elastic spring devices 60F and 60B are arranged so as to intersect with each other, and therefore, in the same direction as the actuators (F and B actuators 53F and 53B) described above. Compared with the case where it arrange | positions, the return operation | movement to the neutral position of the link mechanism 30 and a holding | maintenance operation | movement can be performed stably.

次いで、このように構成されたリンク機構30の動作について説明する。図8は、リンク機構30の屈伸動作を説明するための模式図であり、リンク機構30の正面図に対応する。なお、図8では、R及びLモータ52R,52L等が模式的に図示されると共に、弾性ばね部材60F等の図示が省略されている。   Next, the operation of the link mechanism 30 configured as described above will be described. FIG. 8 is a schematic diagram for explaining a bending / extending operation of the link mechanism 30 and corresponds to a front view of the link mechanism 30. In FIG. 8, the R and L motors 52R, 52L and the like are schematically illustrated, and the elastic spring member 60F and the like are not illustrated.

図8(a)に示すように、リンク機構30が中立位置にある場合には、左右の車輪12L,12Rのキャンバ角はO゜である。また、連結リンク40の傾斜角もO゜である。そして、Fアクチュエータ53Fが伸長駆動されると、目8(b)に示すように、リンク機構30が屈伸され、左右の車輪12L,12Rに所定のキャンバ角θR,θLが付与されると共に、連結リンク40に所定の傾斜角θCが付与される。   As shown in FIG. 8A, when the link mechanism 30 is in the neutral position, the camber angles of the left and right wheels 12L, 12R are O °. The inclination angle of the connecting link 40 is also 0 °. When the F actuator 53F is driven to extend, the link mechanism 30 is bent and stretched as shown in the eye 8 (b), and predetermined camber angles θR and θL are given to the left and right wheels 12L and 12R. A predetermined inclination angle θC is given to the link 40.

なお、本実施の形態では、リンク機構30が平行リンク機構として構成されているので、キャンバ角θR,θLと傾斜角θCとは全て同値となる。また、Fアクチュエータ53Fが伸長駆動(短絡駆動)される場合には、Bアクチュエータ53Bは短絡駆動(伸長駆動)される。   In the present embodiment, since the link mechanism 30 is configured as a parallel link mechanism, the camber angles θR, θL and the inclination angle θC all have the same value. When the F actuator 53F is driven to extend (short circuit drive), the B actuator 53B is driven to short circuit (extension drive).

次に、走行車両1の停車時制御について説明する。まず、本実施形態の停車時制御における停車について説明する。図9は走行車両1の走行制御時と停車時とを示す。図9(a)は通常の走行制御時であり、図9(b)は停車時である。   Next, stop control of the traveling vehicle 1 will be described. First, stop in the stop time control of the present embodiment will be described. FIG. 9 shows when the traveling vehicle 1 is traveling and stopped. FIG. 9A shows a normal traveling control, and FIG. 9B shows a stop.

本実施形態の停車時制御における停車とは、図9(b)に示すように、走行車両1を車輪12及び停車時姿勢補助手段90により3点以上で接地させることにより、静的な安定を保持することをいう。この場合、走行駆動のための電源はOFFとし、通常の走行制御は実行しない。   As shown in FIG. 9 (b), the stop in the stop time control of this embodiment means that the traveling vehicle 1 is grounded at three or more points by the wheels 12 and the stop time posture assisting means 90, thereby achieving static stability. It means holding. In this case, the power for driving is turned off and normal driving control is not executed.

図10及び図11は、本実施形態のフローチャートを示す。図10はメイン処理、図11はサブルーチンの自動停車処理である。まず、ステップ1で、通常走行制御を実行する(ST1)。次に、ステップ2で、降車スイッチ55がONとなったか判断する(ST2)。   10 and 11 show flowcharts of the present embodiment. FIG. 10 shows the main process, and FIG. 11 shows the automatic stop process of the subroutine. First, in step 1, normal travel control is executed (ST1). Next, in step 2, it is determined whether the getting-off switch 55 is turned on (ST2).

ここで、先に降車スイッチ55がONとされた場合を説明する。降車スイッチ55がONとされた場合、ステップ11で、ジョイスティック装置51の操作を無効とする(ST11)。次に、ステップ12で、周辺監視装置57の前方センサ57aの値を取得する(ST12)。   Here, a case where the getting-off switch 55 is turned on first will be described. When the getting-off switch 55 is turned on, the operation of the joystick device 51 is invalidated at step 11 (ST11). Next, in step 12, the value of the front sensor 57a of the periphery monitoring device 57 is acquired (ST12).

続いて、ステップ13で、前方センサ57aの値を取得した結果、障害物Of等のある位置と停車に伴い走行車両1が傾斜又は移動する停車時移動空間マップ72aとを比較し、停車時移動空間マップ72a内に障害物Of等が存在しないことを確認する(ST13)。停車時移動空間マップ72aとは、図12に示すように、走行車両1が、停車のために傾斜又は移動することにより、通過・占有する空間を表す三次元データのことである。なお、余裕を持たせるためにマージンを加え、通過・占有する空間より大きい空間を停車時移動空間マップ72aとしてもよい。   Subsequently, as a result of acquiring the value of the front sensor 57a in step 13, the position of the obstacle Of etc. is compared with the moving space map 72a at the time of stopping where the traveling vehicle 1 inclines or moves as the vehicle stops, and moves at the time of stopping. It is confirmed that no obstacle Of exists in the space map 72a (ST13). The stop-time moving space map 72a is three-dimensional data representing a space that the traveling vehicle 1 passes and occupies when the traveling vehicle 1 tilts or moves for stopping as shown in FIG. In addition, in order to give a margin, a margin may be added, and a space larger than a space that passes and occupies may be used as the stop-time moving space map 72a.

停車時移動空間マップ72a内に障害物Of等が存在しないことを確認した場合、ステップ14で、走行車両1を停車させ、乗員が降車できるようにする(ST14)。   When it is confirmed that there is no obstacle Of or the like in the moving space map 72a when the vehicle is stopped, the traveling vehicle 1 is stopped in step 14 so that the occupant can get off (ST14).

停車時移動空間マップ72a内に障害物Of等が存在した場合、ステップ21で、周辺監視装置57の後方センサ57bにより後方の障害物Or等までの距離Dの値を取得する(ST21)。   If there is an obstacle Of or the like in the moving space map 72a when the vehicle is stopped, the value of the distance D to the rear obstacle Or or the like is acquired by the rear sensor 57b of the periphery monitoring device 57 in step 21 (ST21).

次に、ステップ22で、後方の安全を確認する(ST22)。後方の安全の確認方法は、図13に示すように、まず、ステップ13で前方センサ57aが確認した障害物Of等までの距離と、停車時移動空間マップ72aとを比較して、停車するために必要な後進距離Lを算出する。次に、ステップ21で周辺監視装置57の後方センサ57bが取得した後方の障害物Or等までの距離Dと、停車するために必要な後進距離Lとを比較して、D>Lの関係があるか判断する。   Next, in step 22, the rear safety is confirmed (ST22). As shown in FIG. 13, the safety confirmation method for the rear is to first stop the vehicle by comparing the distance to the obstacle Of and the like confirmed by the front sensor 57a in step 13 with the moving space map 72a when stopped. Calculate the reverse distance L required for. Next, the distance D to the rear obstacle Or obtained by the rear sensor 57b of the periphery monitoring device 57 in step 21 is compared with the reverse distance L necessary for stopping, and the relationship of D> L is established. Judge if there is.

D>Lの関係となり、後方の安全を確認できた場合、ステップ23で、障害物Of等を避けるために後方に移動する(ST23)。その後、ステップ14に進み、走行車両1を停車させる。   If D> L and the rear safety is confirmed, in step 23, the vehicle moves backward to avoid the obstacle Of and the like (ST23). Then, it progresses to step 14 and the traveling vehicle 1 is stopped.

D>Lの関係とならず、後方の安全を確認できなかった場合、ステップ31で、「移動させてください」等の警告メッセージを出力する(ST31)。次に、ステップ32で、降車スイッチ55がOFFとなっているか確認する(ST32)。降車スイッチ55がOFFとなっていた場合、ステップ33で、ジョイスティック装置51を有効にする(ST33)。その後、ステップ1の通常走行制御に戻る。降車スイッチ55がOFFとなっていなかった場合、ステップ12に戻り、障害物Of等が移動しているか、周辺監視装置57により再び障害物Of等の有無を検出する。   If the relationship of D> L is not satisfied and the rear safety cannot be confirmed, a warning message such as “Please move” is output in step 31 (ST31). Next, in step 32, it is confirmed whether the getting-off switch 55 is OFF (ST32). If the getting-off switch 55 is OFF, the joystick device 51 is validated in step 33 (ST33). Thereafter, the process returns to the normal travel control in step 1. If the getting-off switch 55 is not OFF, the process returns to step 12 to detect whether the obstacle Of or the like is moving or the surroundings monitoring device 57 again detects the presence or absence of the obstacle Of or the like.

次に、ステップ2で、降車スイッチ55がONとなったか判断した結果、降車スイッチ55がONとされていない場合を説明する。   Next, the case where the getting-off switch 55 is not turned on as a result of determining whether the getting-off switch 55 is turned on in Step 2 will be described.

降車スイッチ55がONとされていない場合、ステップ3で、乗員検知装置54の値を取得する(ST3)。次に、ステップ4で、乗員検知装置54の値を取得した結果、乗員が降車しているかどうか判断する(ST4)。乗員が降車している場合、ステップ5で、サブルーチンの自動停車処理制御に入る(ST5)。乗員が降車していない場合は、ステップ1に戻り、通常走行制御を実行する。   When the getting-off switch 55 is not turned ON, the value of the occupant detection device 54 is acquired in step 3 (ST3). Next, in step 4, as a result of obtaining the value of the occupant detection device 54, it is determined whether or not the occupant is getting off (ST4). If the occupant is getting off, the automatic stop processing control of the subroutine is entered at step 5 (ST5). If the occupant is not getting off, the routine returns to step 1 and normal traveling control is executed.

次に、図11に示すステップ5の自動停車処理制御を説明する。まず、ステップ101で、タイマ56をスタートさせる(ST101)。次に、ステップ102で、ジョイスティック装置51を無効にする(ST102)。続いて、ステップ103で、周囲に警告を知らせる点灯手段としての警告灯58をONとする(ST103)。次に、ステップ104で、乗員検知装置54の値を取得する(ST104)。そして、ステップ105で、乗員が再び走行車両1に乗車したかを判断する(ST105)。   Next, the automatic stop processing control in step 5 shown in FIG. 11 will be described. First, in step 101, the timer 56 is started (ST101). Next, in step 102, the joystick device 51 is invalidated (ST102). Subsequently, in step 103, the warning lamp 58 as a lighting means for notifying the surroundings of the warning is turned on (ST103). Next, in step 104, the value of the occupant detection device 54 is acquired (ST104). In step 105, it is determined whether the occupant has boarded the traveling vehicle 1 again (ST105).

ここで、乗員が再び走行車両1に乗車した場合、ステップ121で、ジョイスティック装置51を有効にする(ST121)。そして、ステップ122で、戻り値を再乗車とし(ST122)、自動停車処理を終了する。   If the occupant gets on the traveling vehicle 1 again, the joystick device 51 is validated in step 121 (ST121). In step 122, the return value is set as a re-boarding (ST122), and the automatic stopping process is terminated.

乗員が再び走行車両1に乗車していなかった場合、ステップ106で、タイマ56により一定時間経過したかを判断する(ST106)。一定時間経過していなかった場合、ステップ104に戻る。   If the occupant has not boarded the traveling vehicle 1 again, it is determined in step 106 whether or not a fixed time has elapsed by the timer 56 (ST106). If the predetermined time has not elapsed, the process returns to step 104.

一定時間経過していた場合、次に、ステップ107で、周辺監視装置57の前方センサ57aの値を取得する(ST107)。   If the predetermined time has elapsed, in step 107, the value of the front sensor 57a of the periphery monitoring device 57 is acquired (ST107).

続いて、ステップ108で、前方センサ57aの値を取得した結果、障害物Of等のある位置と停車に伴い走行車両1が傾斜又は移動する停車時移動空間マップ72aとを比較し、停車時移動空間マップ72a内に障害物Of等が存在しないことを確認する(ST108)。停車時移動空間マップ72a内に障害物Of等が存在しないことを確認した場合、ステップ109で、走行車両1を停車させ、乗員が降車できるようにする(ST109)。   Subsequently, as a result of acquiring the value of the front sensor 57a in step 108, the position of the obstacle Of etc. is compared with the moving space map 72a at the time of stopping where the traveling vehicle 1 inclines or moves as the vehicle stops, and moves at the time of stopping. It is confirmed that there is no obstacle Of in the space map 72a (ST108). When it is confirmed that there is no obstacle Of or the like in the moving space map 72a when the vehicle is stopped, the traveling vehicle 1 is stopped in step 109 so that the passenger can get off (ST109).

停車時移動空間マップ72a内に障害物Of等が存在した場合、ステップ131で、周辺監視装置57の後方センサ57bにより後方の障害物Or等までの距離Dの値を取得する(ST131)。次に、ステップ132で、後方の安全を確認する(ST132)。後方の安全の確認方法は、ステップ22と同様に、図13に示すように、まず、ステップ108で前方センサ57aが確認した障害物Of等までの距離と、停車時移動空間マップ72aとを比較して、停車するために必要な後進距離Lを算出する。次に、ステップ21で周辺監視装置57の後方センサ57bが取得した後方の障害物Or等までの距離Dと、停車するために必要な後進距離Lとを比較して、D>Lの関係があるか判断する。   If there is an obstacle Of or the like in the moving space map 72a when the vehicle is stopped, the value of the distance D to the rear obstacle Or or the like is acquired by the rear sensor 57b of the periphery monitoring device 57 in step 131 (ST131). Next, in step 132, the rear safety is confirmed (ST132). As shown in FIG. 13, the method for confirming the safety behind the vehicle is as shown in FIG. 13. First, the distance to the obstacle Of etc. confirmed by the front sensor 57a in step 108 is compared with the moving space map 72a when stopped. Then, the reverse distance L required for stopping is calculated. Next, the distance D to the rear obstacle Or obtained by the rear sensor 57b of the periphery monitoring device 57 in step 21 is compared with the reverse distance L necessary for stopping, and the relationship of D> L is established. Judge if there is.

D>Lの関係となり、後方の安全を確認できた場合、ステップ133で、障害物Of等を避けるために後方に移動する(ST133)。その後、ステップ109に進み、走行車両1を停車させる。D>Lの関係とならず、後方の安全を確認できなかった場合、ステップ104に戻る。   If the relationship of D> L is satisfied and the rear safety can be confirmed, in step 133, the vehicle moves backward to avoid the obstacle Of and the like (ST133). Then, it progresses to step 109 and the traveling vehicle 1 is stopped. If the relationship of D> L is not satisfied and the rear safety cannot be confirmed, the process returns to step 104.

ステップ109で走行車両1を停止させた後、ステップ110で、電源をOFFとする(ST110)。続いて、ステップ111で、戻り値を電源OFFとし(ST111)、自動停車処理を終了する。   After stopping the traveling vehicle 1 in step 109, the power is turned off in step 110 (ST110). Subsequently, in step 111, the return value is turned off (ST111), and the automatic stopping process is terminated.

再び、図10に示すメイン処理に戻り、ステップ6で、ステップ5の自動停車処理の結果、戻り値が再乗車であるか判断する(ST6)。戻り値が再乗車である場合、ステップ1の通常走行制御に戻る。戻り値が再乗車でなく、電源OFFとなる場合、制御を終了する。   Again, returning to the main process shown in FIG. 10, it is determined in step 6 whether the return value is a re-boarding as a result of the automatic stop process in step 5 (ST6). If the return value is a re-ride, the process returns to the normal travel control in step 1. If the return value is not a re-boarding and the power is turned off, the control is terminated.

また、他の実施形態として、図14に示すように、停車時姿勢補助手段90を、通常走行時は、格納されているが、停車時制御の際に突出し接地することで、走行車両1の姿勢を保持し停車させるようにしてもよい。図14(a)は、補助脚91、図14(b)は、補助輪92を示す。さらに、図15に示すように、前後2本の補助脚93a,93bを突出し、接地するように構成してもよい。   Further, as another embodiment, as shown in FIG. 14, the stationary posture assisting means 90 is stored during normal traveling, but protrudes and comes into contact with the stationary vehicle 1 during the stationary control. The posture may be maintained and stopped. FIG. 14A shows an auxiliary leg 91, and FIG. 14B shows an auxiliary wheel 92. Further, as shown in FIG. 15, the two front and rear auxiliary legs 93a and 93b may be protruded and grounded.

このように、本実施形態の走行車両1では、乗員が降車スイッチ55の手続きをしないまま降車し、且つ、乗員検知装置54が乗員を検知しなかった場合、走行車両1を停車させ、停車時姿勢補助手段90により姿勢を補助する制御装置70と、を備えたので、燃料等のエネルギの無駄がなくなり、外乱により動いてしまうこともなくなる。   As described above, in the traveling vehicle 1 of the present embodiment, when the occupant gets off without performing the procedure of the dismount switch 55 and the occupant detection device 54 does not detect the occupant, the traveling vehicle 1 is stopped and the vehicle is stopped. Since the posture assisting means 90 includes the control device 70 that assists the posture, energy such as fuel is not wasted, and the device is not moved by disturbance.

また、停車時に操縦装置であるジョイスティック装置51を無効にするので、誤って何かが触れてしまっても、暴走することがない。   In addition, since the joystick device 51 that is the control device is invalidated when the vehicle is stopped, even if something touches by mistake, it will not run away.

また、タイマ56により所定時間カウントされた後、走行車両1を停車させるので、落とした物の拾得や買い物等で乗員が一時的に降りる場合には、走行車両1を停車させることがなく、再び乗車する際に何ら操作をする必要がない。   In addition, since the traveling vehicle 1 is stopped after being counted for a predetermined time by the timer 56, when the occupant temporarily gets off by picking up a dropped item or shopping, the traveling vehicle 1 is not stopped again. There is no need to do anything when getting on.

また、走行車両1の所定範囲を監視する周辺監視装置57をさらに備え、制御装置70は、周辺監視装置57が、所定範囲内に何も検知しなかった場合に、走行車両1を停車させるので、障害物Of等に衝突する危険を防止することができる。   In addition, it further includes a periphery monitoring device 57 that monitors a predetermined range of the traveling vehicle 1, and the control device 70 stops the traveling vehicle 1 when the periphery monitoring device 57 detects nothing within the predetermined range. Further, it is possible to prevent the danger of colliding with an obstacle Of.

また、制御装置70は、走行車両1が停車時に通過・占有する停車時移動空間マップ72aを記憶したROM72を有し、所定範囲は、停車時移動空間マップ72aであるので、迅速に演算することができる。   Further, the control device 70 has a ROM 72 that stores a stop-time moving space map 72a that the traveling vehicle 1 passes and occupies when stopped, and the predetermined range is the stop-time moving space map 72a. Can do.

また、前方センサ57aが停車時移動空間マップ72a内に障害物Of等を検知した場合、前方における障害物Of等までの距離を計測し、後方センサ72bにより、前方における障害物Of等までの距離と同じ距離内に他の障害物Orが存在するか検知し、検知しなかった場合、走行車両1を後方に移動させて停車するので、停車させることのできる範囲がより広くなる。   Further, when the front sensor 57a detects an obstacle Of or the like in the moving space map 72a when the vehicle is stopped, the distance to the obstacle Of etc. in the front is measured, and the distance to the obstacle Of etc. in the front is measured by the rear sensor 72b. If other obstacles Or are present within the same distance, and if they are not detected, the traveling vehicle 1 is moved backward and stopped, so the range in which the vehicle can be stopped becomes wider.

また、停車後に点灯手段を点灯させるので、周囲に走行車両1が停車状態にあることを知らせることができ、より安全になる。   Further, since the lighting means is turned on after the vehicle stops, it is possible to inform the surroundings that the traveling vehicle 1 is in a stopped state, and it becomes safer.

また、停車時姿勢補助手段90は、通常時は格納され、停車時に突出するので、通常走行時に邪魔になることがない。   Further, the stationary posture assisting means 90 is stored in the normal time and protrudes when the vehicle is stopped, so that it does not get in the way during normal driving.

(a)は、本発明の第1実施の形態における車両の正面図であり、(b)は、車両の側面図である。(A) is a front view of the vehicle in 1st Embodiment of this invention, (b) is a side view of a vehicle. 車両の電気的構成を示したブロック図である。1 is a block diagram showing an electrical configuration of a vehicle. (a)は、Rモータの正面図であり、(b)は、Rモータの側面図である。(A) is a front view of R motor, (b) is a side view of R motor. (a)は、上部リンク及び下部リンクの正面図であり、(b)は、上部リンク及び下部リンクの上面図である。(A) is a front view of an upper link and a lower link, (b) is a top view of an upper link and a lower link. (a)は、連結リンクの正面図であり、(b)は、連結リンクの側面図であり、(c)は、連結リンクの上面図である。(A) is a front view of a connection link, (b) is a side view of a connection link, (c) is a top view of a connection link. リンク機構の正面図である。It is a front view of a link mechanism. リンク機構の上面図である。It is a top view of a link mechanism. リンク機構の屈伸動作を説明するための模式図であり、(a)は中立位置にある状態を、(b)は屈伸された状態を、それぞれ示している。It is a schematic diagram for demonstrating the bending operation of a link mechanism, (a) has shown the state in a neutral position, (b) has each shown the bent state. 本実施形態の停車状態を示す図である。It is a figure which shows the stop state of this embodiment. 本実施形態のメイン処理のフローチャートである。It is a flowchart of the main process of this embodiment. 本実施形態のサブルーチンのフローチャートである。It is a flowchart of a subroutine of the present embodiment. 本実施形態の停車時移動空間マップを示す図である。It is a figure which shows the movement space map at the time of a stop of this embodiment. 本実施形態の後方安全確認方法を示す図である。It is a figure which shows the back safety confirmation method of this embodiment. 他の実施形態として停車時姿勢補助手段を示す図である。It is a figure which shows a posture assistance means at the time of a stop as other embodiment. 他の実施形態として停車時姿勢補助手段を示す図である。It is a figure which shows a posture assistance means at the time of a stop as other embodiment.

符号の説明Explanation of symbols

1…走行車両、2…車体、11…乗員部、11a…座席、12…車輪、30…リンク機構、51…ジョイスティック装置(操作手段)、52…回転駆動装置、53…アクチュエータ装置(車体左右傾斜装置)、54…乗員検知装置、55…降車スイッチ、56…タイマ、57…周辺監視装置、58・・・点灯手段、70…制御装置、71…CPU、72…ROM、72a…停車時移動空間マップ、73…RAM、74…バスライン、75…入出力ポート、90…補助バー(停車時姿勢補助手段)、91…補助脚(停車時姿勢補助手段)、92…補助輪(停車時姿勢補助手段)、93a,93b…補助脚(停車時姿勢補助手段)   DESCRIPTION OF SYMBOLS 1 ... Traveling vehicle, 2 ... Vehicle body, 11 ... Passenger part, 11a ... Seat, 12 ... Wheel, 30 ... Link mechanism, 51 ... Joystick device (operation means), 52 ... Rotation drive device, 53 ... Actuator device (Body left-right inclination) Device), 54 ... occupant detection device, 55 ... drop-off switch, 56 ... timer, 57 ... periphery monitoring device, 58 ... lighting means, 70 ... control device, 71 ... CPU, 72 ... ROM, 72a ... moving space when stopped Map 73 ... RAM 74 ... Bus line 75 ... Input / output port 90 ... Auxiliary bar (posture assistance means when stopped) 91 ... Auxiliary leg (posture assistance means when stopped) 92 ... Auxiliary wheel (posture assistance when stopped) Means), 93a, 93b ... Auxiliary legs (stop posture assistance means)

Claims (6)

車体と、
前記車体に回転可能に支持された車輪と、
を有する走行車両において、
停車時に前記走行車両の姿勢を補助する停車時姿勢補助手段と、
乗員の有無を検知する乗員検知装置と、
乗員が手続きをすることで走行車両を停車させる降車手続手段と、
乗員が前記降車手続手段の手続きをしないまま降車し、且つ、前記乗員検知手段が乗員を検知しなかった場合、前記走行車両を停車させ、前記停車時姿勢補助手段により姿勢を補助する制御装置と、
前記走行車両の所定範囲を監視する周辺監視装置と、
を備え、
前記制御装置は、
前記走行車両が、前記車輪による走行時から、前記車輪及び前記停車時姿勢補助手段によって3点以上で接地する停車時へ移行する際、前記車体及び前記車輪が傾斜又は移動することにより、通過・占有する停車時移動空間マップを記憶した記憶手段を有し、
前記周辺監視装置が、前記停車時移動空間マップ内に何も検知しなかった場合に、前記走行車両を停車させる
ことを特徴とする走行車両。
The car body,
A wheel rotatably supported by the vehicle body;
In a traveling vehicle having
Stopping assistance means for assisting the posture of the traveling vehicle when the vehicle is stopped;
An occupant detection device that detects the presence or absence of an occupant;
A getting-off procedure means for stopping the traveling vehicle by the passenger's procedure,
A control device that, when an occupant gets off without performing the procedure of the getting-off procedure means, and when the occupant detection means does not detect an occupant, stops the traveling vehicle and assists the posture by the stopping posture assistance means; ,
A periphery monitoring device for monitoring a predetermined range of the traveling vehicle;
With
The controller is
When the traveling vehicle shifts from traveling by the wheel to stopping when the wheel and the stopping posture assisting means are grounded at three or more points, the vehicle body and the wheel are inclined or moved, Having a storage means for storing the occupied space map when stopped;
The traveling vehicle, wherein the traveling monitoring device stops the traveling vehicle when nothing is detected in the stop space moving space map .
前記制御装置は、停車時に操縦装置を無効にすることを特徴とする請求項1に記載の走行車両。   The traveling vehicle according to claim 1, wherein the control device disables the control device when the vehicle is stopped. 前記乗員検知手段が乗員を検知しなかった時点からカウントするタイマを備え、
前記制御手段は、前記タイマにより所定時間カウントされた後、前記走行車両を停車させることを特徴とする請求項2に記載の走行車両。
A timer for counting from the time when the occupant detection means did not detect the occupant,
The traveling vehicle according to claim 2, wherein the control means stops the traveling vehicle after being counted for a predetermined time by the timer.
前記周辺監視装置は、前記停車時移動空間マップ内を監視する第1センサと、前記停車時移動空間マップ外を監視する第2センサとを有し、
前記制御装置は、前記第1センサが前記停車時移動空間マップ内に障害物等を検知した場合、前記障害物等までの距離を計測し、前記第2センサにより、前記検知した障害物等までの距離と同じ距離内に他の障害物が存在するか検知し、検知しなかった場合、前記走行車両を障害物が検知されない方向に移動させて停車することを特徴とする請求項1乃至請求項3のいずれか1つに記載の走行車両。
The periphery monitoring device has a first sensor that monitors the inside of the moving space map at the time of stopping, and a second sensor that monitors the outside of the moving space map at the time of stopping,
When the first sensor detects an obstacle or the like in the moving space map when stopped, the control device measures the distance to the obstacle or the like, and the second sensor detects the obstacle or the like. detecting whether other obstacles are in the same distance in the distance, if not detected, claims 1 to, characterized in that the traveling vehicle obstacle stops is moved in a direction that is not detected Item 4. The traveling vehicle according to any one of items 3 to 3 .
前記制御装置は、停車後に点灯手段を点灯させることを特徴とする請求項1乃至請求項4のいずれか1つに記載の走行車両。 The traveling vehicle according to any one of claims 1 to 4, wherein the control device lights the lighting means after the vehicle stops. 前記停車時姿勢補助手段は、通常時は格納され、停車時に突出することを特徴とする請求項1乃至請求項5のいずれか1つに記載の走行車両。 The traveling vehicle according to any one of claims 1 to 5, wherein the stopping posture assisting means is stored in a normal state and protrudes when the vehicle stops.
JP2006323566A 2006-11-30 2006-11-30 Traveling vehicle Expired - Fee Related JP4844740B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2006323566A JP4844740B2 (en) 2006-11-30 2006-11-30 Traveling vehicle

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2006323566A JP4844740B2 (en) 2006-11-30 2006-11-30 Traveling vehicle

Publications (2)

Publication Number Publication Date
JP2008137422A JP2008137422A (en) 2008-06-19
JP4844740B2 true JP4844740B2 (en) 2011-12-28

Family

ID=39599368

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2006323566A Expired - Fee Related JP4844740B2 (en) 2006-11-30 2006-11-30 Traveling vehicle

Country Status (1)

Country Link
JP (1) JP4844740B2 (en)

Families Citing this family (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP4862801B2 (en) * 2007-10-22 2012-01-25 トヨタ自動車株式会社 Coaxial motorcycle and control method thereof
JP5131076B2 (en) * 2008-07-29 2013-01-30 トヨタ自動車株式会社 Coaxial motorcycle and control method thereof
JP5065206B2 (en) * 2008-09-02 2012-10-31 トヨタ自動車株式会社 Mobile body, inverted mobile body, and control method thereof
JP5104731B2 (en) * 2008-11-12 2012-12-19 株式会社エクォス・リサーチ vehicle
JP2010125969A (en) * 2008-11-27 2010-06-10 Toyota Motor Corp Movable body
JP2010167807A (en) * 2009-01-20 2010-08-05 Toyota Motor Corp Travel device and method of controlling the same
JP5262935B2 (en) * 2009-04-07 2013-08-14 トヨタ自動車株式会社 Coaxial motorcycle
JP5430317B2 (en) * 2009-09-23 2014-02-26 本田技研工業株式会社 Control device for inverted pendulum type vehicle
WO2011106767A2 (en) 2010-02-26 2011-09-01 Segway Inc. Apparatus and methods for control of a vehicle
JP5708441B2 (en) * 2011-10-28 2015-04-30 トヨタ自動車株式会社 Electric vehicle
JP6011386B2 (en) * 2013-02-14 2016-10-19 トヨタ自動車株式会社 MOBILE BODY, MOBILE BODY CONTROL METHOD AND CONTROL PROGRAM
JP6314700B2 (en) * 2014-07-01 2018-04-25 株式会社豊田自動織機 vehicle

Family Cites Families (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0556504A (en) * 1991-08-26 1993-03-05 Sanyo Electric Co Ltd Electric vehicle
JP2003063340A (en) * 2001-08-28 2003-03-05 Aisin Seiki Co Ltd Driving assistance device
JP4422415B2 (en) * 2003-01-17 2010-02-24 トヨタ自動車株式会社 Motorcycle
JP2005335678A (en) * 2004-04-28 2005-12-08 Yamaha Motor Co Ltd Vehicle, vehicle control device and control method
JP4821093B2 (en) * 2004-05-27 2011-11-24 トヨタ自動車株式会社 Vehicle equipment
JP2006160082A (en) * 2004-12-07 2006-06-22 Sony Corp Traveling apparatus and control method thereof
JP4155311B2 (en) * 2006-06-12 2008-09-24 トヨタ自動車株式会社 Traveling device and vehicle control method for parallel motorcycle

Also Published As

Publication number Publication date
JP2008137422A (en) 2008-06-19

Similar Documents

Publication Publication Date Title
JP5019026B2 (en) Traveling vehicle
JP4844740B2 (en) Traveling vehicle
JP4333398B2 (en) Wheelbase variable vehicle
JPWO2007052676A1 (en) vehicle
JP4310462B2 (en) vehicle
JP4894589B2 (en) vehicle
JP2011046287A (en) Coaxial motorcycle and method of controlling the same
JP6737963B2 (en) Motorcycle
JP2014000923A (en) Vehicle
JP4894792B2 (en) vehicle
JP2011025877A (en) Bicycle
JP4844194B2 (en) vehicle
JP2011031762A (en) Moving vehicle and control program thereof
JP5157728B2 (en) vehicle
JP2007223399A (en) vehicle
JP6183324B2 (en) Inverted two-wheeled mobile body and control method thereof
JP4780178B2 (en) vehicle
JP2010241280A (en) Coaxial motorcycle
JP2011046275A (en) Vehicle
JP4687309B2 (en) vehicle
JP4798382B2 (en) Traveling vehicle
JP2010030440A (en) Coaxial two-wheeled vehicle and its control method
JP4844369B2 (en) vehicle
JP4752542B2 (en) vehicle
JP5561744B2 (en) car

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20090224

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20110415

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20110511

A521 Written amendment

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20110711

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

A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20110927

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

Free format text: PAYMENT UNTIL: 20141021

Year of fee payment: 3

R150 Certificate of patent (=grant) or registration of utility model

Free format text: JAPANESE INTERMEDIATE CODE: R150

LAPS Cancellation because of no payment of annual fees