[go: up one dir, main page]
More Web Proxy on the site http://driver.im/

JPH1165654A - Unmanned carrier - Google Patents

Unmanned carrier

Info

Publication number
JPH1165654A
JPH1165654A JP9215365A JP21536597A JPH1165654A JP H1165654 A JPH1165654 A JP H1165654A JP 9215365 A JP9215365 A JP 9215365A JP 21536597 A JP21536597 A JP 21536597A JP H1165654 A JPH1165654 A JP H1165654A
Authority
JP
Japan
Prior art keywords
fsm
taxiway
state machine
obstacle
finite state
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.)
Pending
Application number
JP9215365A
Other languages
Japanese (ja)
Inventor
Toru Kamata
徹 鎌田
Koichi Oikawa
浩一 及川
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.)
Fujitsu Ltd
Original Assignee
Fujitsu 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 Fujitsu Ltd filed Critical Fujitsu Ltd
Priority to JP9215365A priority Critical patent/JPH1165654A/en
Publication of JPH1165654A publication Critical patent/JPH1165654A/en
Pending legal-status Critical Current

Links

Landscapes

  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

PROBLEM TO BE SOLVED: To ensure realtime performance, algorithmic simplicity, and functionality extension simplification, with respect to an unmanned carrier traveling along a guide path. SOLUTION: This carrier is provided with a guiding FSM(finite state machine) 28 for performing operation of reducing position deflection with respect to a guide path at the time of detecting the guide path, avoiding an FSM 27 for performing an operation for avoiding an obstacle at the time of detecting the obstacle, a storing action FSM 29 for storing the evading of the obstacle and performing an operation in a direction opposite to the operation performed for avoiding the obstacle, and an attitude correcting FSM 30 for performing an operation for reducing an attitude angular deflection around a vertical shaft against the guide path during guide path withdrawal. The priority order is set in the order of the escaping FSM 27, the guiding FSM 28, the storing action FSM 29, and the attitude correcting FSM 30, and at the time of an operation by an FSM whose priority order is higher, the operation by an FSM whose priority order is lower is suppressed.

Description

【発明の詳細な説明】DETAILED DESCRIPTION OF THE INVENTION

【0001】[0001]

【発明の属する技術分野】本発明は、磁気誘導路などの
誘導路に沿って走行する無人搬送車(automaticguided
vehicle)に関する。
BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to an automatic guided vehicle that travels along a guideway such as a magnetic guideway.
vehicle).

【0002】[0002]

【従来の技術】従来、磁気誘導路などの誘導路に沿って
走行する無人搬送車を誘導路上に複数台運行させる場
合、運行を統括する上位システムが、各無人搬送車の位
置を把握し、各無人搬送車に適切な運行経路を逐一指示
することにより、無人搬送車同士の衝突を防止するよう
にしていた。
2. Description of the Related Art Conventionally, when a plurality of automatic guided vehicles running along a taxiway such as a magnetic taxiway are operated on a taxiway, a host system that supervises the operation grasps the position of each automatic guided vehicle, By instructing each AGV one by one on an appropriate operation route, collisions between AGVs are prevented.

【0003】しかし、この運行方法では、運行経路計
画のアルゴリズムが複雑であり、上位システムの負荷が
大きい、運行経路のレイアウトや無人搬送車の台数の
変更等の度に、上位システムの運行経路計画用プログラ
ムを変更する必要がある、という問題点があった。
However, in this operation method, the operation route planning algorithm is complicated, and the load on the host system is large. Whenever the layout of the operation route or the number of automatic guided vehicles is changed, the operation route planning of the host system is performed. There is a problem that it is necessary to change the application program.

【0004】そこで、また、従来、上位システムを無人
搬送車の管理から解放するために、無人搬送車に障害物
を検出するためのセンサを備えさせ、走行中に障害物と
遭遇した場合には、センサを使用して徐行、停止を行う
という運行方法が提案されている。
Therefore, conventionally, in order to release the host system from the management of the automatic guided vehicle, the automatic guided vehicle is provided with a sensor for detecting an obstacle. There has been proposed an operation method of performing slow driving and stopping using a sensor.

【0005】しかし、この運行方法では、障害物が除
去されない限り、無人搬送車は停止したままとなり、運
行効率が低下する、停止した無人搬送車が他の無人搬
送車にとっては障害物となり、渋滞の原因となる、とい
う問題点があった。
However, in this operation method, unless the obstacle is removed, the automatic guided vehicle remains stopped, and the operation efficiency is reduced. The stopped automatic guided vehicle becomes an obstacle for other automatic guided vehicles and congestion occurs. Cause a problem.

【0006】ここに、上位システムを無人搬送車の管理
から解放し、かつ、円滑な運行を行うためには、無人搬
送車が、自律的に、無人搬送車同士の衝突を回避し、障
害物を回避した後、再び、元の誘導路に復帰する必要が
ある。
Here, in order to release the host system from the management of the automatic guided vehicle and to perform smooth operation, the automatic guided vehicle autonomously avoids collisions between the automatic guided vehicles and removes obstacles. After avoiding, it is necessary to return to the original taxiway again.

【0007】従来、これを実現するために、(1.誘導
行動として)誘導路に対する位置偏差(偏心)の認識
→位置偏差量から方向変換角と速度の算出→駆動系
への指令→(2.前方物体を回避するために、右側への
誘導路離脱行動として)無人搬送車による進行方向環
境の認識→進行方向環境の無人搬送車内部でのモデル
化→回避方向の算出などの行動計画立案→行動計画
に基づいた方向変換角と速度の算出→駆動系への指令
→(3.誘導路を離脱した状態で、左側方物体を回避す
る行動として)無人搬送車による進行方向環境の認識
→無人搬送車による左側方環境の認識→進行方向環
境の無人搬送車内部でのモデル化→左側方環境の無人
搬送車内部でのモデル化→進行方向の算出などの行動
計画立案→行動計画に基づいた方向変換角と速度の算
出→駆動系への指令→(4.物体を回避後、誘導路に
復帰する行動として)無人搬送車による進行方向環境
の認識→無人搬送車による左側方環境の認識→進行
方向環境の無人搬送車内部でのモデル化→左側方環境
の無人搬送車内部でのモデル化→内部センサによる姿
勢の認識→誘導路への方向の算出などの行動計画立案
→行動計画に基づいた方向変換角と速度の算出→駆
動系への指令という、直列的な処理が行われていた。
Conventionally, in order to realize this, (1. guidance action) recognition of a position deviation (eccentricity) with respect to a guideway → calculation of a direction change angle and a speed from a position deviation amount → command to a drive system → (2 Recognition of the traveling direction environment by the unmanned guided vehicle → modeling of the traveling direction environment inside the unmanned guided vehicle → calculation of the avoiding direction, etc. → Calculation of the direction change angle and speed based on the action plan → Command to the driving system → (3. Recognition of the traveling direction environment by the automatic guided vehicle (as an action to avoid the left object while leaving the taxiway) → Recognition of left side environment by unmanned guided vehicle → Modeling of traveling direction environment inside unmanned guided vehicle → Modeling of left side environment inside unmanned guided vehicle → Formulation of action plan such as calculation of traveling direction → Based on action plan Direction change angle and speed Calculation → command to the drive train → (4. as an action to return to the taxiway after avoiding the object) recognition of the traveling direction environment by the automatic guided vehicle → recognition of the left environment by the automatic guided vehicle → unmanned of the traveling direction environment Modeling inside the guided vehicle → Modeling the left side environment inside the unmanned guided vehicle → Recognizing the posture by the internal sensor → Formulating an action plan such as calculating the direction to the taxiway → The direction conversion angle based on the action plan A serial process of calculating the speed → instructing the drive system has been performed.

【0008】[0008]

【発明が解決しようとする課題】しかし、この運行方法
では、誘導路や環境の認識、環境のモデル化、行動計
画の立案、方向変換角・速度の算出を行う必要があり、
リアルタイム性が無く、無人搬送車が走行しながらの円
滑な障害物回避や誘導路への復帰が困難である、アル
ゴリズムが複雑であり、このため、信頼性が低く、か
つ、開発コストを要するばかりでなく、機能の拡張時に
は、全ての処理系に変更を加える必要がある、直列的
な処理を行うことから、ある処理系のトラブルが全体と
して致命的なトラブルにつながってしまう、という問題
点があった。
However, in this operation method, it is necessary to recognize the taxiway and the environment, model the environment, draft an action plan, and calculate the direction change angle and speed.
There is no real-time capability, it is difficult to avoid obstacles smoothly and return to the taxiway while the automatic guided vehicle is traveling, and the algorithm is complicated, so it is low in reliability and requires only development costs In addition, when expanding functions, it is necessary to make changes to all processing systems.Since serial processing is performed, a problem in a certain processing system leads to a fatal trouble as a whole. there were.

【0009】本発明は、かかる点に鑑み、誘導路を離脱
して他の無人搬送車との衝突を回避し、再び誘導路に復
帰することを自律的に行うことができ、しかも、リアル
タイム性と、アルゴリズムの簡素性による信頼性の向上
及び開発コストの低減化と、機能拡張の容易性と、一部
の処理のトラブルが全体としての致命的なトラブルにつ
ながらない可能性とを確保することができるようにした
無人搬送車を提供することを目的とする。
In view of the above, the present invention can autonomously return to the taxiway by leaving the taxiway and avoiding collision with another automatic guided vehicle, and return to the taxiway again. And to improve reliability and reduce development costs through the simplicity of the algorithm, ensure ease of function expansion, and ensure that some processing troubles do not lead to fatal troubles as a whole. It is an object of the present invention to provide an automatic guided vehicle capable of performing such operations.

【0010】[0010]

【課題を解決するための手段】本発明中、第1の発明
は、誘導路を検出すると、誘導路に対する位置偏差が許
容範囲内となるように操縦(方向変換操作)を行う第1
の有限状態マシン(以下、FSM[finite state machi
ne]という)と、障害物を検出すると、障害物を回避す
るように操縦を行う第2のFSMと、障害物を回避した
ことを記憶し、障害物の回避のためにした操縦とは逆向
きの操縦を行う第3のFSMと、誘導路を離脱中におけ
る誘導路に対する鉛直軸回りの姿勢角偏差を減らすよう
に操縦を行う第4のFSMとを備え、第2のFSMを第
1優先順位、第1のFSMを第2優先順位、第3のFS
Mを第3優先順位、第4のFSMを第4優先順位とし、
優先順位が上位のFSMによる操縦時には、優先順位が
下位のFSMによる操縦を抑制するように動作するとい
うものである。
According to a first aspect of the present invention, when a taxiway is detected, a steering operation (direction changing operation) is performed so that a positional deviation from the taxiway is within an allowable range.
Finite state machine (FSM)
ne]), the second FSM that steers to avoid an obstacle when an obstacle is detected, and the operation that avoids the obstacle by memorizing that the obstacle has been avoided, A third FSM for maneuvering in a direction, and a fourth FSM for maneuvering so as to reduce a posture angle deviation about a vertical axis with respect to the taxiway while leaving the taxiway, and the second FSM is given first priority. Priority, first FSM second priority, third FS
M is the third priority, the fourth FSM is the fourth priority,
At the time of maneuvering by the higher priority FSM, the operation is performed so as to suppress the maneuvering by the lower priority FSM.

【0011】本発明中、第1の発明によれば、障害物を
検出しない限り、誘導路に沿って走行し、障害物を検出
したときは、誘導路を離脱して障害物を回避し、障害物
を回避した後は、誘導路上に復帰する、という走行を自
律的に行うことができる。
According to the first aspect of the present invention, the vehicle travels along a taxiway unless an obstacle is detected. When an obstacle is detected, the vehicle leaves the taxiway to avoid the obstacle. After avoiding the obstacle, the vehicle can return to the taxiway autonomously.

【0012】本発明中、第2の発明は、第1の発明にお
いて、第1のFSMは、状態として、誘導路に対する位
置偏差が左側に許容範囲を越えている場合に実行する右
旋回と、誘導路に対する位置偏差が右側に許容範囲を越
えている場合に実行する左旋回と、誘導路に対する位置
偏差が許容範囲内である場合に実行する旋回停止とを有
し、第2のFSMは、状態として、障害物を検出した場
合に実行する右旋回と、障害物を検出しない場合に実行
する旋回停止とを有し、第3のFSMは、状態として、
回避記憶がある場合に実行する左旋回と、回避記憶がな
い場合に実行する旋回停止とを有し、第4のFSMは、
状態として、誘導路に対する鉛直軸回りの姿勢角偏差が
左向きの場合に実行する右旋回と、誘導路に対する鉛直
軸回りの姿勢角偏差が右向きの場合に実行する左旋回
と、誘導路に対する鉛直軸回りの姿勢角偏差がない場合
に実行する旋回停止とを有しているというものである。
According to a second aspect of the present invention, in the first aspect, the first FSM includes, as a state, a right turn which is executed when the positional deviation with respect to the taxiway exceeds an allowable range to the left. The second FSM has a left turn to be executed when the position deviation with respect to the taxiway is outside the allowable range to the right, and a turn stop to be executed when the position deviation with respect to the taxiway is within the allowable range. The state includes a right turn to be performed when an obstacle is detected and a stop to be performed when no obstacle is detected. The third FSM has the following states:
The fourth FSM includes a left turn to be executed when there is an avoidance memory and a turn stop to be executed when there is no avoidance memory.
As the state, a right turn is performed when the attitude angle deviation around the vertical axis with respect to the taxiway is left, a left turn is performed when the attitude angle deviation around the vertical axis with respect to the taxiway is right, and a vertical turn with respect to the taxiway. And a turning stop executed when there is no deviation of the attitude angle around the axis.

【0013】本発明中、第2の発明によれば、障害物を
検出しない限り、誘導路に沿って走行し、障害物を検出
したときは、誘導路を右側に離脱して障害物を回避し、
障害物を回避した後は、誘導路上に復帰する、という走
行を自律的に行うことができる。
According to the second aspect of the present invention, the vehicle travels along the taxiway unless an obstacle is detected. When an obstacle is detected, the vehicle departs from the taxiway to the right to avoid the obstacle. And
After avoiding the obstacle, the vehicle can return to the taxiway autonomously.

【0014】本発明中、第3の発明は、第1の発明にお
いて、第1のFSMは、状態として、誘導路に対する位
置偏差が左側に許容範囲を越えている場合に実行する右
旋回と、誘導路に対する位置偏差が右側に許容範囲を越
えている場合に実行する左旋回と、誘導路に対する位置
偏差が許容範囲内である場合に実行する旋回停止とを有
し、第2のFSMは、状態として、障害物を検出した場
合に実行する左旋回と、障害物を検出しない場合に実行
する旋回停止とを有し、第3のFSMは、状態として、
回避記憶がある場合に実行する右旋回と、回避記憶がな
い場合に実行する旋回停止とを有し、第4のFSMは、
状態として、誘導路に対する鉛直軸回りの姿勢角偏差が
左向きの場合に実行する右旋回と、誘導路に対する鉛直
軸回りの姿勢角偏差が右向きの場合に実行する左旋回
と、誘導路に対する鉛直軸回りの姿勢角偏差がない場合
に実行する旋回停止とを有しているというものである。
According to a third aspect of the present invention, in the first aspect, the first FSM includes, as a state, a right turn to be executed when the positional deviation with respect to the taxiway exceeds an allowable range to the left. The second FSM has a left turn to be executed when the position deviation with respect to the taxiway is outside the allowable range to the right, and a turn stop to be executed when the position deviation with respect to the taxiway is within the allowable range. The state includes a left turn to be performed when an obstacle is detected and a turn stop to be performed when no obstacle is detected.
The fourth FSM has a right turn to be executed when there is an avoidance memory and a stop to be executed when there is no avoidance memory.
As a state, a right turn is performed when the attitude angle deviation around the vertical axis with respect to the taxiway is left, a left turn is performed when the attitude angle deviation around the vertical axis with respect to the taxiway is right, and a vertical turn with respect to the taxiway. And a turning stop executed when there is no deviation of the attitude angle around the axis.

【0015】本発明中、第3の発明によれば、障害物を
検出しない限り、誘導路に沿って走行し、障害物を検出
したときは、誘導路を左側に離脱して障害物を回避し、
障害物を回避した後は、誘導路上に復帰する、という走
行を自律的に行うことができる。
According to the third aspect of the present invention, the vehicle travels along the taxiway unless an obstacle is detected. When an obstacle is detected, the vehicle departs from the taxiway to the left to avoid the obstacle. And
After avoiding the obstacle, the vehicle can return to the taxiway autonomously.

【0016】[0016]

【発明の実施の形態】図1は本発明の一実施形態を示す
概念図である。図1中、1は車体、2は車体1の前部、
3は車体1の後部、4は自在輪からなる左前輪、5は自
在輪からなる右前輪、6は左後輪、7は右後輪、8は左
後輪6を駆動する左後輪駆動モータ、9は右後輪7を駆
動する右後輪駆動モータである。
FIG. 1 is a conceptual diagram showing one embodiment of the present invention. In FIG. 1, 1 is a vehicle body, 2 is a front part of the vehicle body 1,
3 is a rear part of the vehicle body 1, 4 is a left front wheel made of a free wheel, 5 is a right front wheel made of a free wheel, 6 is a left rear wheel, 7 is a right rear wheel, and 8 is a left rear wheel driving a left rear wheel 6. The motor 9 is a right rear wheel drive motor for driving the right rear wheel 7.

【0017】本発明の一実施形態においては、左後輪6
及び右後輪7を、それぞれ、独立に駆動することができ
るので、左後輪6及び右後輪7の回転数と回転方向を等
しくすれば直進走行、一方だけを回転させれば旋回、回
転方向を反対にすれば急旋回が可能である。
In one embodiment of the present invention, the left rear wheel 6
And the right rear wheel 7 can be driven independently of each other, so that if the rotation speed and the rotation direction of the left rear wheel 6 and the right rear wheel 7 are equal, the vehicle travels straight, and if only one of them rotates, the vehicle turns and rotates. If the direction is reversed, a sharp turn is possible.

【0018】また、10は車体1の鉛直軸回りの姿勢を
検出する車体姿勢検出用ジャイロ、11は磁気誘導路1
2を検出する磁気誘導路検出用磁気センサである。
Reference numeral 10 denotes a gyro for detecting the attitude of the vehicle body 1 about a vertical axis, and 11 denotes a magnetic guideway 1.
2 is a magnetic sensor for detecting a magnetic guide path for detecting the magnetic field No. 2.

【0019】磁気誘導路検出用磁気センサ11は、磁気
誘導路12に対する磁気誘導路検出用磁気センサ11の
位置偏差量に比例する電圧を出力するように構成されて
いる。例えば、磁気誘導路検出用磁気センサ11の中央
が磁気誘導路12の中央に一致していれば、出力電圧が
5Vとなり、±100mmの幅で左右に位置偏差するに
従って3〜7Vの範囲で出力電圧が比例変化するように
構成されている。
The magnetic guideway detecting magnetic sensor 11 is configured to output a voltage proportional to the positional deviation of the magnetic guideway detecting magnetic sensor 11 with respect to the magnetic guideway 12. For example, if the center of the magnetic guideway detecting magnetic sensor 11 coincides with the center of the magnetic guideway 12, the output voltage becomes 5V, and the output voltage is in the range of 3 to 7V as the position is deviated left and right with a width of ± 100 mm. The voltage is configured to change proportionally.

【0020】また、13は車体1の正面に位置する物体
を非接触で検出する正面物体検出用赤外線センサ、14
は正面物体検出用赤外線センサ13の物体検出エリアで
ある。
Reference numeral 13 denotes an infrared sensor for detecting a front object which detects an object located in front of the vehicle body 1 in a non-contact manner;
Is an object detection area of the infrared sensor 13 for detecting a front object.

【0021】また、15は車体1の左前方に位置する物
体を非接触で検出する左前方物体検出用赤外線センサ、
16は左前方物体検出用赤外線センサ15の物体検出エ
リアである。
Reference numeral 15 denotes an infrared sensor for detecting a left front object which detects an object located on the left front of the vehicle body 1 in a non-contact manner.
Reference numeral 16 denotes an object detection area of the left front object detection infrared sensor 15.

【0022】また、17は車体1の左側方に位置する物
体を非接触で検出する左側方物体検出用赤外線センサ、
18は左側方物体検出用赤外線センサ17の物体検出エ
リアである。
An infrared sensor 17 for detecting an object located on the left side of the vehicle body 1 in a non-contact manner,
Reference numeral 18 denotes an object detection area of the left-side object detection infrared sensor 17.

【0023】これら正面物体検出用赤外線センサ13、
左前方物体検出用赤外線センサ15及び左側方物体検出
用赤外線センサ17は、物体を検出すると各々の電圧出
力が変化するように構成されている。
These infrared sensors 13 for detecting front objects,
The infrared sensor 15 for detecting the left front object and the infrared sensor 17 for detecting the left object are configured such that their respective voltage outputs change when an object is detected.

【0024】また、19は車体1に搭載された制御装置
部であり、20は車体姿勢検出用ジャイロ10、磁気誘
導路検出用磁気センサ11、正面物体検出用赤外線セン
サ13、左前方物体検出用赤外線センサ15及び左側方
物体検出用赤外線センサ17から出力されるアナログ信
号からなる検出信号をデジタル信号に変換するA/D変
換器である。
Reference numeral 19 denotes a control unit mounted on the vehicle body 1. Reference numeral 20 denotes a gyro 10 for detecting the posture of the vehicle body, a magnetic sensor 11 for detecting a magnetic guide path, an infrared sensor 13 for detecting a front object, and a left front object detection. This is an A / D converter that converts a detection signal consisting of an analog signal output from the infrared sensor 15 and the left-side object detection infrared sensor 17 into a digital signal.

【0025】また、21はA/D変換器20から出力さ
れるデジタル信号化された検出信号が入力される車体制
御用計算機、22は車体制御用計算機21により使用さ
れるメモリである。
Reference numeral 21 denotes a vehicle control computer to which a digitalized detection signal output from the A / D converter 20 is input, and reference numeral 22 denotes a memory used by the vehicle control computer 21.

【0026】また、23は車体制御用計算機21から出
力されるデジタル信号からなる左後輪駆動モータ制御信
号、右後輪駆動モータ制御信号及びジャイロ制御信号を
アナログ信号化するD/A変換器である。
Reference numeral 23 denotes a D / A converter for converting the left rear wheel drive motor control signal, the right rear wheel drive motor control signal, and the gyro control signal, which are digital signals output from the vehicle body control computer 21, into analog signals. is there.

【0027】また、24はD/A変換器23から出力さ
れるアナログ信号からなる左後輪駆動モータ制御信号S
Lに基づいて左後輪駆動モータ8を制御する左後輪駆動
モータ制御装置、25はD/A変換器23から出力され
るアナログ信号からなる右後輪駆動モータ制御信号SR
に基づいて右後輪駆動モータ9を制御する右後輪駆動モ
ータ制御装置である。
Reference numeral 24 denotes a left rear wheel drive motor control signal S consisting of an analog signal output from the D / A converter 23.
The left rear wheel drive motor control device 25 controls the left rear wheel drive motor 8 based on L. The right rear wheel drive motor control signal SR composed of an analog signal output from the D / A converter 23
Is a right rear wheel drive motor control device that controls the right rear wheel drive motor 9 based on the following.

【0028】また、本発明の一実施形態は、4個のFS
Mを備えている。第1のFSMは、磁気誘導路12を検
出すると、磁気誘導路12に対する車体1の位置偏差量
を減らすように操縦を行うFSMであり、以下、誘導F
SMという。この誘導FSMは、磁気誘導路検出用磁気
センサ11を使用して実現される。
In one embodiment of the present invention, four FSs
M is provided. The first FSM is an FSM that, when the magnetic guideway 12 is detected, performs steering so as to reduce the amount of positional deviation of the vehicle body 1 with respect to the magnetic guideway 12.
It is called SM. This guidance FSM is realized using a magnetic sensor 11 for detecting a magnetic guidance path.

【0029】図2は誘導FSMの状態遷移図であり、誘
導FSMは、旋回停止、左旋回及び右旋回の3個の状態
を有しており、磁気誘導路12に対する左側への位置偏
差が大である場合には車体1の右旋回を実行し、磁気誘
導路12に対する右側への位置偏差が大である場合には
車体1の左旋回を実行し、磁気誘導路12に対する位置
偏差が小である場合には旋回停止を実行する。
FIG. 2 is a state transition diagram of the guidance FSM. The guidance FSM has three states of turning stop, left turning, and right turning, and the positional deviation to the left with respect to the magnetic guide path 12 is different. If it is large, a right turn of the vehicle body 1 is executed, and if the positional deviation to the right with respect to the magnetic guide path 12 is large, a left turn of the vehicle body 1 is executed, and the positional deviation with respect to the magnetic guide path 12 is reduced. If it is small, the turning stop is executed.

【0030】第2のFSMは、障害物を検出すると、障
害物を回避するように操縦を行うFSMであり、以下、
回避FSMという。この回避FSMは、正面物体検出用
センサ13、左前方物体検出用センサ15及び左側方物
体検出用センサ17を使用して実現される。
The second FSM is an FSM that, when an obstacle is detected, steers so as to avoid the obstacle.
It is called avoidance FSM. This avoidance FSM is realized using the front object detection sensor 13, the left front object detection sensor 15, and the left object detection sensor 17.

【0031】図3は回避FSMの状態遷移図であり、回
避FSMは、旋回停止及び右旋回の2個の状態を有して
おり、障害物を検出すると、車体1の右旋回を実行し、
障害物を検出しない場合には車体1の旋回停止を実行す
る。
FIG. 3 is a state transition diagram of the avoidance FSM. The avoidance FSM has two states of turning stop and turning right. When an obstacle is detected, the turning right of the vehicle body 1 is executed. And
When no obstacle is detected, the turning of the vehicle body 1 is stopped.

【0032】第3のFSMは、障害物を回避したことを
記憶し、障害物の回避のためにした操縦とは逆向きの操
縦を行うFSMであり、以下、記憶行動FSMという。
この記憶行動FSMは、メモリ22を回避記憶手段とし
て実現される。
The third FSM is a FSM that stores information that an obstacle has been avoided and performs a steering operation in a direction opposite to the steering operation for avoiding the obstacle.
This storage behavior FSM is realized using the memory 22 as an avoidance storage unit.

【0033】図4は記憶行動FSMの状態遷移図であ
り、記憶行動FSMは、旋回停止及び左旋回の2個の状
態を有しており、回避記憶があると、車体1の左旋回を
実行し、回避記憶がない場合には、車体1の旋回停止を
実行する。
FIG. 4 is a state transition diagram of the memory action FSM. The memory action FSM has two states, a turning stop and a left turn. If there is no avoidance memory, the turning of the vehicle body 1 is stopped.

【0034】第4のFSMは、磁気誘導路12を離脱中
における磁気誘導路12に対する鉛直軸回りの姿勢角偏
差を減らすように操縦を行うFSMであり、以下、姿勢
修正FSMという。この姿勢修正FSMは、車体姿勢検
出用ジャイロを使用して実現される。
The fourth FSM is an FSM that performs steering so as to reduce an attitude angle deviation about a vertical axis with respect to the magnetic guide path 12 while leaving the magnetic guide path 12, and is hereinafter referred to as an attitude correction FSM. This attitude correction FSM is realized using a gyro for detecting the attitude of the vehicle body.

【0035】図5は姿勢修正FSMの状態遷移図であ
り、姿勢修正FSMは、磁気誘導路12に対する鉛直軸
回りの姿勢角偏差が左向きの場合には右旋回を実行し、
磁気誘導路12に対する鉛直軸回りの姿勢角偏差が右向
きの場合には左旋回を実行し、磁気誘導路12に対する
鉛直軸回りの姿勢角偏差がない場合には旋回停止を実行
する。
FIG. 5 is a state transition diagram of the attitude correction FSM. The attitude correction FSM executes a right turn when the attitude angle deviation around the vertical axis with respect to the magnetic guide path 12 is left.
When the attitude angle deviation around the vertical axis with respect to the magnetic guide path 12 is rightward, the left turn is executed, and when there is no attitude angle deviation around the vertical axis with respect to the magnetic guide path 12, the turn stop is executed.

【0036】図6はFSMの抑制方法をモデル化した図
であり、図6中、27は回避FSM、28は誘導FS
M、29は記憶行動FSM、30は姿勢修正FSM、3
1、32、33、34は抑制ノード、35は車体1の駆
動系である。
FIG. 6 is a diagram modeling a method of suppressing the FSM. In FIG. 6, 27 is the avoidance FSM, and 28 is the induced FS.
M, 29 are memory behavior FSM, 30 is posture correction FSM, 3
1, 32, 33, and 34 are suppression nodes, and 35 is a drive system of the vehicle body 1.

【0037】抑制ノード31、32、33、34は、入
力端B側から旋回指令が入力されない場合には、入力端
B側からの指令を出力する状態とし、入力端A側から旋
回指令が入力される場合には、入力端A側からの旋回指
令を優先して出力するというものである。
When the turning command is not input from the input end B, the suppression nodes 31, 32, 33, and 34 are set to output the command from the input end B, and the turning command is input from the input end A. In such a case, the turning command from the input end A is output with priority.

【0038】そこで、例えば、回避FSM27、誘導F
SM28、記憶行動FSM29、姿勢修正FSM30の
いずれもが旋回指令を出力しない場合には、前進指令が
駆動系に伝達され、前進行動が行われることになる。
Therefore, for example, the avoidance FSM 27, the lead F
If none of the SM28, the memory action FSM29, and the posture correction FSM30 output a turning command, the forward command is transmitted to the drive system, and the forward action is performed.

【0039】そして、例えば、前進行動中に姿勢修正F
SM30から旋回指定が出力されると、前進行動が抑制
され、姿勢修正FSM30から出力される旋回指令が抑
制ノード33、34を介して駆動系35に伝達され、姿
勢修正FSM30による車体1の操縦が行われることに
なる。
Then, for example, during the forward movement, the posture correction F
When the turning instruction is output from the SM 30, the forward action is suppressed, the turning command output from the attitude correction FSM 30 is transmitted to the drive system 35 via the suppression nodes 33 and 34, and the operation of the vehicle body 1 by the attitude correction FSM 30 is controlled. Will be done.

【0040】また、例えば、姿勢修正FSM30による
車体1の操縦中に記憶行動FSM29から旋回指令が出
力すると、記憶行動FSM29から出力される旋回指令
が抑制ノード32、33、34を介して駆動系35に伝
達され、記憶行動FSM29による車体1の操縦が行わ
れることになる。
For example, when a turning command is output from the storing action FSM 29 during the operation of the vehicle body 1 by the attitude correcting FSM 30, the turning command output from the storing action FSM 29 is transmitted to the drive system 35 via the suppression nodes 32, 33, 34. And the steering of the vehicle body 1 by the memory action FSM 29 is performed.

【0041】また、例えば、記憶行動FSM29による
車体1の操縦中に誘導FSM28から旋回指令が出力す
ると、誘導FSM28から出力される旋回指令が抑制ノ
ード31、32、33、34を介して駆動系35に伝達
され、誘導FSM28による車体1の操縦が行われるこ
とになる。
Further, for example, when a turn command is output from the guidance FSM 28 during the operation of the vehicle body 1 by the memory action FSM 29, the turn command output from the guidance FSM 28 is transmitted to the drive system 35 via the suppression nodes 31, 32, 33, 34. And the steering of the vehicle body 1 by the guidance FSM 28 is performed.

【0042】また、例えば、誘導FSM28による車体
1の操縦中に回避FSM27から旋回指令が出力する
と、回避FSM27から出力される旋回指令が抑制ノー
ド31、32、33、34を介して駆動系35に伝達さ
れ、回避FSM27による車体1の操縦が行われること
になる。
For example, when a turn command is output from the avoidance FSM 27 during the operation of the vehicle body 1 by the guidance FSM 28, the turn command output from the avoidance FSM 27 is transmitted to the drive system 35 via the suppression nodes 31, 32, 33, 34. Then, the vehicle body 1 is steered by the avoidance FSM 27.

【0043】即ち、本発明の一実施形態においては、回
避FSM27が第1優先順位、誘導FSM28が第2優
先順位、記憶行動FSM29が第3優先順位、姿勢修正
FSM30が第4優先順位とされ、優先順位が上位のF
SMによる操縦時には、優先順位が下位のFSMによる
操縦を抑制するように構成されている。
That is, in one embodiment of the present invention, the avoidance FSM 27 has the first priority, the guidance FSM 28 has the second priority, the memory action FSM 29 has the third priority, and the posture correction FSM 30 has the fourth priority. F with the highest priority
At the time of maneuvering by the SM, it is configured to suppress maneuvering by the FSM having a lower priority.

【0044】図7は本発明の一実施形態の走行例を示す
図である。図7中、38は本発明の一実施形態の無人搬
送車、39は磁気誘導路12上の障害物であり、矢印
は、無人搬送車38の走行方向を示している。
FIG. 7 is a diagram showing a running example of one embodiment of the present invention. 7, reference numeral 38 denotes an automatic guided vehicle according to one embodiment of the present invention, reference numeral 39 denotes an obstacle on the magnetic guide path 12, and arrows indicate the traveling direction of the automatic guided vehicle 38.

【0045】ここに、無人搬送車38は、起動時に、正
確に前方を向いており、磁気誘導路検出用磁気センサ1
1の出力が5Vであり、前方の障害物39を検出しない
場合には、回避FSM27、誘導FSM28、記憶行動
FSM29、姿勢修正FSM30は発現しないので、前
進する。
Here, when the automatic guided vehicle 38 is started, it is correctly directed forward, and the magnetic sensor 1 for detecting a magnetic guide path is used.
If the output of 1 is 5V and the obstacle 39 ahead is not detected, the avoidance FSM 27, the guidance FSM 28, the memory action FSM 29, and the posture correction FSM 30 do not appear, and the vehicle moves forward.

【0046】そして、磁気誘導路検出用磁気センサ11
の出力電圧が3V以上、5V未満となると、誘導FSM
28が発現すると同時に前進が抑制され、無人搬送車3
8は、右旋回を行い、磁気誘導路12に対する位置偏差
を減らす行動をとる。
Then, the magnetic sensor 11 for detecting the magnetic guide path is provided.
When the output voltage becomes 3 V or more and less than 5 V, the induction FSM
At the same time, the advancement is suppressed, and the automatic guided vehicle 3
8 performs an action of making a right turn and reducing a positional deviation with respect to the magnetic guide path 12.

【0047】また、磁気誘導路検出用磁気センサ11の
出力電圧が5Vを越え、7V未満となると、誘導FSM
28が発現すると同時に前進が抑制され、無人搬送車3
8は、左旋回を行い、磁気誘導路12に対する位置偏差
を減らす行動をとる。なお、車体姿勢検出用ジャイロ1
0は、誘導FSM28が発現中は、リセットされる。
When the output voltage of the magnetic sensor 11 for detecting a magnetic guidance path exceeds 5 V and becomes less than 7 V, the induction FSM
At the same time, the advancement is suppressed, and the automatic guided vehicle 3
8 performs an action of making a left turn and reducing a positional deviation with respect to the magnetic guide path 12. In addition, the gyro 1 for body posture detection
0 is reset while induced FSM28 is expressed.

【0048】その後、正面物体検出用赤外線センサ13
が障害物39を検出すると、回避FSM27が発現する
と同時に誘導FSM28による操縦及び前進が抑制さ
れ、無人搬送車38は、右旋回を行い、障害物39を右
側通行で回避する行動をとる。この時、右側に回避した
ことは、メモリ22に記憶される。
Thereafter, the infrared sensor 13 for detecting a front object
Detects the obstacle 39, the avoidance FSM 27 appears, and at the same time, the steering and forward movement by the guidance FSM 28 are suppressed, and the automatic guided vehicle 38 makes a right turn and takes an action to avoid the obstacle 39 on the right. At this time, the avoidance to the right is stored in the memory 22.

【0049】そして、正面物体検出用赤外線センサ1
3、左前方物体検出用赤外線センサ15及び左側方物体
検出用赤外線センサ17が障害物39を検出しなくなる
と、メモリ22の記憶、即ち、障害物39の回避のため
に右旋回をした記憶により、記憶行動FSM29が発現
し、障害物39に沿う方向で姿勢を制御する。
Then, the infrared sensor 1 for detecting a front object
3. When the infrared sensor 15 for detecting the left front object and the infrared sensor 17 for detecting the left object no longer detect the obstacle 39, the memory 22 is stored, that is, the memory is turned right to avoid the obstacle 39. As a result, the memory behavior FSM 29 appears, and the posture is controlled in the direction along the obstacle 39.

【0050】そして、無人搬送車38が右側通行で障害
物39を回避中に左側方物体検出用赤外線センサ17が
障害物39を検出すると、回避FSM27が発現し、記
憶行動FSM29による操縦が抑制され、無人搬送車3
8の左側の障害物39の回避が確実に行われる。
If the left object detecting infrared sensor 17 detects the obstacle 39 while the automatic guided vehicle 38 is avoiding the obstacle 39 while traveling on the right side, the avoidance FSM 27 appears and the steering by the memory action FSM 29 is suppressed. , Automatic guided vehicle 3
Avoidance of the obstacle 39 on the left side of 8 is ensured.

【0051】このようにして、無人搬送車38は、記憶
行動FSM29と回避FSM27によって、障害物39
を右側通行で回避していくが、障害物39を通り過ぎる
と、無人搬送車38は、正面物体検出用赤外線センサ1
3、左前方物体検出用赤外線センサ15及び左側方物体
検出用赤外線センサ17のいずれかからも出力がなくな
り、メモリ22の記憶による記憶行動FSM29により
磁気誘導路12への復帰に向かう。
In this way, the automatic guided vehicle 38 moves the obstacle 39 by the memory action FSM 29 and the avoidance FSM 27.
Is passed on the right side, but when passing the obstacle 39, the automatic guided vehicle 38
3. There is no output from either the left front object detection infrared sensor 15 or the left side object detection infrared sensor 17, and the operation returns to the magnetic guide path 12 by the storage behavior FSM29 stored in the memory 22.

【0052】そして、磁気誘導路検出用磁気センサ11
による磁気誘導路12の検出により、誘導FSM28が
発現すると、無人搬送車38は、磁気誘導路12に沿っ
て走行することになる。なお、磁気誘導路検出用磁気セ
ンサ11の磁気誘導路12の検出により、メモリ22の
記憶はクリアされる。
Then, the magnetic sensor 11 for detecting the magnetic guide path is provided.
When the guidance FSM 28 is generated by the detection of the magnetic guide path 12 by the, the automatic guided vehicle 38 travels along the magnetic guide path 12. The storage of the memory 22 is cleared by the detection of the magnetic guide path 12 by the magnetic sensor 11 for magnetic guide path detection.

【0053】なお、磁気誘導路12への進入角度の深さ
が原因で無人搬送車38が磁気誘導路12を越えた場合
は、メモリ22の記憶のクリアにより、記憶行動FSM
29は消え、車体姿勢検出用ジャイロ10による姿勢修
正FSM30が発現する。即ち、磁気誘導路12に対す
る車体姿勢検出用ジャイロ10の出力角度により、姿勢
修正FSM30が発現し、無人搬送車38は磁気誘導路
12の向きへと姿勢を修正する。
When the automatic guided vehicle 38 exceeds the magnetic guideway 12 due to the depth of the angle of entry into the magnetic guideway 12, the memory action of the FSM is cleared by clearing the memory 22.
29 disappears, and the posture correction FSM 30 by the vehicle body posture detection gyro 10 appears. That is, the posture correction FSM 30 is expressed by the output angle of the vehicle body posture detecting gyro 10 with respect to the magnetic guide path 12, and the automatic guided vehicle 38 corrects the posture to the direction of the magnetic guide path 12.

【0054】そして、磁気誘導路検出用磁気センサ11
の磁気誘導路12の検出により、誘導FSM28が発現
すると、以後、無人搬送車38は、磁気誘導路12に沿
って走行することになる。
Then, the magnetic sensor 11 for detecting the magnetic guide path is provided.
When the guidance FSM 28 is generated by the detection of the magnetic guide path 12, the automatic guided vehicle 38 travels along the magnetic guide path 12 thereafter.

【0055】このように、本発明の一実施形態によれ
ば、障害物39を検出しない限り、磁気誘導路12に沿
って走行し、障害物39を検出したときは、磁気誘導路
12を右側に離脱して障害物39を回避し、障害物39
を回避した後は、磁気誘導路12上に復帰する、という
走行を自律的に行うことができる。
As described above, according to the embodiment of the present invention, the vehicle travels along the magnetic guide path 12 unless the obstacle 39 is detected. To avoid the obstacle 39,
After avoiding, the vehicle can return autonomously to the magnetic guideway 12 to perform autonomously.

【0056】したがって、無人搬送車38の運行を管理
する上位システムは無人搬送車38の衝突回避のための
運行経路計画をする必要がなく、運行経路のレイアウト
や無人搬送車38の台数の変更に伴うプログラムの変更
も容易になると共に、障害物39による運行効率の低下
や渋滞を防ぐことができる。
Therefore, the host system for managing the operation of the automatic guided vehicle 38 does not need to plan an operation route for avoiding the collision of the automatic guided vehicle 38, and can change the layout of the operation route and the number of the automatic guided vehicles 38. The accompanying program can be easily changed, and it is possible to prevent a decrease in operating efficiency and traffic congestion due to the obstacle 39.

【0057】また、本発明の一実施形態によれば、衝突
防止に必要な処理をマルチタスク的に行うことができる
ようにされているので、従来の無人搬送車が処理時間を
要していた環境の認識、行動の計画といった制御プロセ
スが不要となり、環境の変化に対して高速なレスポンス
で対応することができるので、リアルタイム性を確保す
ることができる。
Further, according to one embodiment of the present invention, since the processing required for preventing collision can be performed in a multitasking manner, the conventional automatic guided vehicle requires a processing time. Control processes such as environment recognition and action planning are not required, and it is possible to respond to changes in the environment with a high-speed response, so that real-time properties can be ensured.

【0058】また、本発明の一実施形態によれば、回避
FSM27、誘導FSM28、記憶行動FSM29及び
姿勢修正FSM30は、それぞれ、対応する赤外線セン
サ又はジャイロからの検出信号を判定して、車体1の行
動パターンを選択すれば足りるとされているので、アル
ゴリズムを簡単化し、信頼性の向上及び開発コストの低
減化を図ることができる。
According to one embodiment of the present invention, the avoidance FSM 27, the guidance FSM 28, the memory behavior FSM 29, and the attitude correction FSM 30 each determine a detection signal from a corresponding infrared sensor or gyro, and Since it is sufficient to select an action pattern, the algorithm can be simplified, reliability can be improved, and development cost can be reduced.

【0059】また、本発明の一実施形態によれば、機能
拡張時は、FSMを追加し、抑制関係を設定するだけで
良く、機能拡張による既存のシステムの変更は不要とな
るので、機能拡張の容易性を確保することができる。
Further, according to the embodiment of the present invention, when the function is extended, it is only necessary to add the FSM and set the suppression relation, and it is not necessary to change the existing system by the function extension. Easiness can be ensured.

【0060】また、本発明の一実施形態によれば、回避
FSM27、誘導FSM28、記憶行動FSM29及び
姿勢修正FSM30は、マルチタスク的に動作して行動
するので、一部のFSMが異常動作を起こしても、他の
FSMが正常動作をすることによって、致命的な故障に
至らずに済む可能性がある。
According to one embodiment of the present invention, the avoidance FSM 27, the guidance FSM 28, the memory behavior FSM 29, and the posture correction FSM 30 operate and operate in a multitasking manner, so that some of the FSMs cause abnormal operation. However, a normal operation of another FSM may prevent a catastrophic failure.

【0061】なお、本発明の一実施形態においては、右
側通行で障害物を回避するようにした場合について説明
したが、この代わりに、左側通行で障害物を回避するよ
うにしても良い。
In the embodiment of the present invention, the case where the obstacle is avoided on the right-hand side has been described. Alternatively, the obstacle may be avoided on the left-hand side.

【0062】[0062]

【発明の効果】以上のように、本発明によれば、誘導路
を離脱して他の無人搬送車との衝突を回避し、再び誘導
路に復帰することを自律的に行うことができ、しかも、
これらFSMで行うことができるので、リアルタイム性
と、アルゴリズムの簡素性による信頼性の向上及び開発
コストの低減化と、機能拡張の容易性と、一部の処理の
トラブルが全体としての致命的なトラブルにつながらな
い可能性とを確保することができる。
As described above, according to the present invention, it is possible to autonomously leave the taxiway, avoid collision with another automatic guided vehicle, and return to the taxiway again. Moreover,
Since these can be performed by the FSM, real-time performance, improvement of reliability and simplification of the algorithm due to simplicity of the algorithm, reduction of development cost, easiness of function expansion, and troubles in some processing are fatal as a whole Possibility of not causing trouble can be secured.

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

【図1】本発明の一実施形態を示す概念図である。FIG. 1 is a conceptual diagram showing one embodiment of the present invention.

【図2】本発明の一実施形態が備える誘導FSMの状態
遷移図である。
FIG. 2 is a state transition diagram of a guided FSM included in an embodiment of the present invention.

【図3】本発明の一実施形態が備える回避FSMの状態
遷移図である。
FIG. 3 is a state transition diagram of an avoidance FSM included in an embodiment of the present invention.

【図4】本発明の一実施形態が備える記憶行動FSMの
状態遷移図である。
FIG. 4 is a state transition diagram of a memory behavior FSM included in an embodiment of the present invention.

【図5】本発明の一実施形態が備える姿勢修正FSMの
状態遷移図である。
FIG. 5 is a state transition diagram of a posture correction FSM provided in an embodiment of the present invention.

【図6】本発明の一実施形態が備えるFSMの抑制方法
をモデル化した図である。
FIG. 6 is a diagram modeling a method of suppressing FSM provided in an embodiment of the present invention.

【図7】本発明の一実施形態の走行例を示す図である。FIG. 7 is a diagram showing a running example of one embodiment of the present invention.

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

2 車体の前部 3 車体の後部 4 左前輪 5 右前輪 8 左後輪駆動モータ 9 右後輪駆動モータ 10 車体姿勢検出用ジャイロ 11 磁気誘導路検出用磁気センサ 13 正面物体検出用赤外線センサ 15 左前方物体検出用赤外線センサ 17 左側方物体検出用赤外線センサ 20 A/D変換器 21 車体制御用計算機 22 メモリ 23 D/A変換器 24 左後輪駆動モータ制御装置 25 右後輪駆動モータ制御装置 2 Front part of vehicle body 3 Rear part of vehicle body 4 Left front wheel 5 Right front wheel 8 Left rear wheel drive motor 9 Right rear wheel drive motor 10 Gyro for body posture detection 11 Magnetic sensor for magnetic guideway detection 13 Infrared sensor for front object detection 15 Left Infrared sensor for front object detection 17 Infrared sensor for left object detection 20 A / D converter 21 Body control computer 22 Memory 23 D / A converter 24 Left rear wheel drive motor control device 25 Right rear wheel drive motor control device

Claims (3)

【特許請求の範囲】[Claims] 【請求項1】誘導路を検出すると、前記誘導路に対する
位置偏差が許容範囲内となるように操縦を行う第1の有
限状態マシンと、 障害物を検出すると、障害物を回避するように操縦を行
う第2の有限状態マシンと、 障害物を回避したことを記憶し、障害物の回避のために
した操縦とは逆向きの操縦を行う第3の有限状態マシン
と、 前記誘導路を離脱中における前記誘導路に対する鉛直軸
回りの姿勢角偏差を減らすように操縦を行う第4の有限
状態マシンとを備え、 前記第2の有限状態マシンを第1優先順位、前記第1の
有限状態マシンを第2優先順位、前記第3の有限状態マ
シンを第3優先順位、前記第4の有限状態マシンを第4
優先順位とし、優先順位が上位の有限状態マシンによる
操縦時には、優先順位が下位の有限状態マシンによる操
縦を抑制するように動作することを特徴とする無人搬送
車。
1. A first finite state machine for maneuvering when a taxiway is detected so that a positional deviation with respect to the taxiway is within an allowable range, and a maneuvering for avoiding an obstacle when an obstacle is detected. A second finite state machine that performs a steering operation, a third finite state machine that stores information that an obstacle has been avoided, and performs a steering operation in a direction opposite to a steering operation that is performed to avoid an obstacle, and leaves the taxiway. A fourth finite state machine that steers so as to reduce a posture angle deviation around a vertical axis with respect to the taxiway, wherein the second finite state machine has first priority, and the first finite state machine has In the second priority, the third finite state machine in the third priority, and the fourth finite state machine in the fourth priority.
An unmanned guided vehicle, wherein the automatic guided vehicle operates so as to suppress the steering by the finite state machine having the lower priority when the finite state machine having the higher priority is operated.
【請求項2】前記第1の有限状態マシンは、状態とし
て、前記誘導路に対する位置偏差が左側に許容範囲を越
えている場合に実行する右旋回と、前記誘導路に対する
位置偏差が右側に許容範囲を越えている場合に実行する
左旋回と、前記誘導路に対する位置偏差が許容範囲内で
ある場合に実行する旋回停止とを有し、 前記第2の有限状態マシンは、状態として、障害物を検
出した場合に実行する右旋回と、障害物を検出しない場
合に実行する旋回停止とを有し、 前記第3の有限状態マシンは、状態として、回避記憶が
ある場合に実行する左旋回と、回避記憶がない場合に実
行する旋回停止とを有し、 前記第4の有限状態マシンは、状態として、前記誘導路
に対する鉛直軸回りの姿勢角偏差が左向きの場合に実行
する右旋回と、前記誘導路に対する鉛直軸回りの姿勢角
偏差が右向きの場合に実行する左旋回と、前記誘導路に
対する鉛直軸回りの姿勢角偏差がない場合に実行する旋
回停止とを有していることを特徴とする請求項1記載の
無人搬送車。
2. The state machine according to claim 1, wherein the first finite state machine executes a right turn when the positional deviation with respect to the taxiway exceeds an allowable range on the left and a positional deviation with respect to the taxiway on the right. A left turn to be executed when the position exceeds the allowable range, and a turn stop to be executed when the positional deviation with respect to the taxiway is within the allowable range. The second finite state machine has a fault as a state. The third finite state machine has a right turn that is executed when an obstacle is detected and a turn stop that is executed when no obstacle is detected. The fourth finite state machine has a state in which, when the attitude angle deviation about the vertical axis with respect to the taxiway is left, the clockwise rotation is executed. Times and on the taxiway A left turn performed when the posture angle deviation around the vertical axis is rightward, and a rotation stop performed when there is no posture angle deviation around the vertical axis with respect to the taxiway. Item 6. The automatic guided vehicle according to Item 1.
【請求項3】前記第1の有限状態マシンは、状態とし
て、前記誘導路に対する位置偏差が左側に許容範囲を越
えている場合に実行する右旋回と、前記誘導路に対する
位置偏差が右側に許容範囲を越えている場合に実行する
左旋回と、前記誘導路に対する位置偏差が許容範囲内で
ある場合に実行する旋回停止とを有し、 前記第2の有限状態マシンは、状態として、障害物を検
出した場合に実行する左旋回と、障害物を検出しない場
合に実行する旋回停止とを有し、 前記第3の有限状態マシンは、状態として、回避記憶が
ある場合に実行する右旋回と、回避記憶がない場合に実
行する旋回停止とを有し、 前記第4の有限状態マシンは、状態として、前記誘導路
に対する鉛直軸回りの姿勢角偏差が左向きの場合に実行
する右旋回と、前記誘導路に対する鉛直軸回りの姿勢角
偏差が右向きの場合に実行する左旋回と、前記誘導路に
対する鉛直軸回りの姿勢角偏差がない場合に実行する旋
回停止とを有していることを特徴とする請求項1記載の
無人搬送車。
3. The first finite state machine includes, as states, a right turn executed when the position deviation with respect to the taxiway exceeds an allowable range on the left side, and a position turn with respect to the taxiway on the right side. A left turn to be executed when the position exceeds the allowable range, and a turn stop to be executed when the positional deviation with respect to the taxiway is within the allowable range. The second finite state machine has a fault as a state. The third finite state machine has a left turn to execute when an object is detected and a stop to execute when no obstacle is detected, and the third finite state machine executes a right turn when there is an avoidance memory as a state. The fourth finite state machine has a state in which, when the attitude angle deviation about the vertical axis with respect to the taxiway is left, the clockwise rotation is executed. Times and on the taxiway A left turn performed when the posture angle deviation around the vertical axis is rightward, and a rotation stop performed when there is no posture angle deviation around the vertical axis with respect to the taxiway. Item 6. The automatic guided vehicle according to Item 1.
JP9215365A 1997-08-11 1997-08-11 Unmanned carrier Pending JPH1165654A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP9215365A JPH1165654A (en) 1997-08-11 1997-08-11 Unmanned carrier

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP9215365A JPH1165654A (en) 1997-08-11 1997-08-11 Unmanned carrier

Publications (1)

Publication Number Publication Date
JPH1165654A true JPH1165654A (en) 1999-03-09

Family

ID=16671094

Family Applications (1)

Application Number Title Priority Date Filing Date
JP9215365A Pending JPH1165654A (en) 1997-08-11 1997-08-11 Unmanned carrier

Country Status (1)

Country Link
JP (1) JPH1165654A (en)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2022042165A (en) * 2020-09-02 2022-03-14 新明工業株式会社 Unmanned running cart and carrying system using unmanned running cart
JPWO2022149285A1 (en) * 2021-01-08 2022-07-14

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2022042165A (en) * 2020-09-02 2022-03-14 新明工業株式会社 Unmanned running cart and carrying system using unmanned running cart
JPWO2022149285A1 (en) * 2021-01-08 2022-07-14

Similar Documents

Publication Publication Date Title
CN108473132B (en) Parking assistance system, parking assistance method, and program
US9182762B2 (en) Autonomous moving body, its control method, and control system
US8170739B2 (en) Path generation algorithm for automated lane centering and lane changing control system
JP6599543B2 (en) Automated guided vehicle
RU2749529C1 (en) Vehicle control system
JPH057724B2 (en)
US10597029B2 (en) Dynamic parking using an assistance system
JP5299756B2 (en) vehicle
EP3900509B1 (en) Field operation vehicle
JP2000305625A (en) Automatic traveling car
KR20220121186A (en) Vehicle control method, vehicle control system, and vehicle
US11639855B2 (en) Setting device and setting method of traveling route
JP2000276232A (en) Obstacle evasion controller for autonomous-travel working vehicle
JP3706669B2 (en) Vehicle steering system
US11708091B2 (en) Vehicle traveling control system and vehicle control system
JPH1165654A (en) Unmanned carrier
CN113696902A (en) Vehicle control system, vehicle control method, computer device, medium, and vehicle
JP2658056B2 (en) Autonomous traveling vehicle control device
US20230182726A1 (en) Vehicle control device and obstacle avoidance control method
CN111176285B (en) Method and device for planning travel path, vehicle and readable storage medium
CN112947487A (en) Automatic guide vehicle and curve path tracking method and control device thereof
JP3761286B2 (en) Robot control method, control device, storage medium, and robot
JP2777281B2 (en) Turning control method of automatic guided vehicle
JP2021015414A (en) Unmanned carrier
JP3355378B2 (en) Automatic guided vehicle system

Legal Events

Date Code Title Description
A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20060608

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20061010

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20061208

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20070612

A02 Decision of refusal

Free format text: JAPANESE INTERMEDIATE CODE: A02

Effective date: 20071016