JP2003330542A - Movement control method of omnidirectional moving vehicle - Google Patents

Movement control method of omnidirectional moving vehicle

Info

Publication number
JP2003330542A
JP2003330542A JP2002135509A JP2002135509A JP2003330542A JP 2003330542 A JP2003330542 A JP 2003330542A JP 2002135509 A JP2002135509 A JP 2002135509A JP 2002135509 A JP2002135509 A JP 2002135509A JP 2003330542 A JP2003330542 A JP 2003330542A
Authority
JP
Japan
Prior art keywords
movement
vehicle
section
moving
omnidirectional
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.)
Withdrawn
Application number
JP2002135509A
Other languages
Japanese (ja)
Inventor
Shinya Kataoka
信哉 片岡
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.)
Sanyo Electric Co Ltd
Original Assignee
Sanyo Electric 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 Sanyo Electric Co Ltd filed Critical Sanyo Electric Co Ltd
Priority to JP2002135509A priority Critical patent/JP2003330542A/en
Publication of JP2003330542A publication Critical patent/JP2003330542A/en
Withdrawn legal-status Critical Current

Links

Landscapes

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

Abstract

<P>PROBLEM TO BE SOLVED: To provide a movement control method of an omnidirectional moving vehicle, in which the omnidirectional moving vehicle moving with combining rotation and movement to an prescribed direction can conduct movement approximate to an ideal translational rotation movement. <P>SOLUTION: The omnidirectional moving vehicle includes an omnidirectional wheel, and can move to a prescribed direction while rotating the vehicle by controlling rotation speed of the omnidirectional wheel. In this case, all moving zone is divided to a plurality of small zones (step S3), the number of which is decided from angle of the rotation of the vehicle, the moving speed of the vehicle is calculated for each small zone (step S9), the rotation speed of the omnidirectional wheel is calculated from the moving speed of the vehicle found by the calculation (step S11), and a servo motor is controlled so that the rotation speed of the omnidirectional wheel accords with a value found by the calculation (step S13). Thus, this vehicle can move with always recognizing an object, which is in a direction of a camera and a certain angle, within the view of the camera because it can conduct an approximate translational rotation movement which is less different from the ideal translational rotation movement in all the moving zones. <P>COPYRIGHT: (C)2004,JPO

Description

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

【0001】[0001]

【発明の属する技術分野】この発明は、全方向移動車両
の移動制御方法に関し、特に例えばオムニホイルなどの
操舵を必要としない車輪を用いた、全方向移動車両の移
動制御方法に関する。
BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to a movement control method for an omnidirectional vehicle, and more particularly to a movement control method for an omnidirectional vehicle using wheels such as omni wheels that do not require steering.

【0002】[0002]

【従来技術】従来から、移動車両において、自由度の高
い移動ができるようにするために、任意の方向に移動で
きる全方向移動車両の開発が進められている(特開平8
−305440号、特開2000−357048、特開
2001−97221など参照)。このような全方位移
動車両に向きが固定してカメラを搭載し、その全方向移
動車両を直線的に移動させる場合、カメラの向きとある
角度をなす方向に存在する対象物を常にカメラの視野内
に捕らえながら移動することができないという問題があ
った。
2. Description of the Related Art Conventionally, an omnidirectional vehicle that can move in any direction has been developed in order to allow a mobile vehicle to move with a high degree of freedom.
-305440, JP-A-2000-357048, JP-A-2001-97221, etc.). When a camera with a fixed orientation is mounted on such an omnidirectional vehicle and the omnidirectional vehicle is moved linearly, an object existing in a direction that forms an angle with the direction of the camera is always viewed by the camera. There was a problem that I could not move while being caught inside.

【0003】このような問題は、図11に示すように、
全方向移動車両2が移動開始地点から移動終了地点まで
自転しながら所定の方向へ移動する理想的な並進回転移
動をできれば生じない。
Such a problem is as shown in FIG.
This does not occur if the omnidirectional vehicle 2 can perform an ideal translational rotation movement in which it moves in a predetermined direction while rotating from the movement start point to the movement end point.

【0004】しかし、実際には全方向移動車両2を並進
回転移動させようとしても、図12に示すような旋回移
動となってしまう。これは、全方向移動車両2に理想的
な並進回転移動をさせようとすると車輪の回転速度を連
続的に変える必要があるが、一般的に使用されている制
御装置を用いて車輪の回転速度を連続的に変化させるこ
とは困難なため、所定の時間ごとに車輪の回転速度を変
えているからである。
However, in reality, even if the omnidirectional vehicle 2 is to be translated and rotated, the vehicle will turn as shown in FIG. This is because it is necessary to continuously change the rotation speed of the wheels in order to make the omnidirectional vehicle 2 perform an ideal translational rotation movement. However, the rotation speed of the wheels needs to be changed by using a commonly used control device. This is because it is difficult to change continuously, and the rotation speed of the wheels is changed every predetermined time.

【0005】そこで、全方向移動車両2を自転させなが
ら所定の方向へ移動させる場合、所定の方向への移動と
その場での自転とを組み合わせて移動させていた。すな
わち、所定の方向へ移動しているときは自転させず、自
転しているときは所定の方向へ移動させないというよう
に、所定の方向への移動とその場での自転のいずれか一
方の動作のみを行うようにして移動させていた。
Therefore, when the omnidirectional vehicle 2 is rotated in a predetermined direction while rotating, the combination of movement in the predetermined direction and rotation on the spot is used. That is, either one of movement in a predetermined direction and rotation on the spot, such as not rotating when moving in a predetermined direction and not moving in a predetermined direction when rotating I was moving only to do so.

【0006】[0006]

【発明が解決しようとする課題】しかしながら、上述の
ような全方向移動車両の移動制御方法には、以下のよう
な問題がある。すなわち、車両に固定されたカメラを搭
載した車両が移動するとき、カメラの向きとある角度を
なす方向に存在する対象物を常にカメラの視野内に捕ら
えながら移動することができないという問題があった。
However, the above-described movement control method for an omnidirectional vehicle has the following problems. That is, when a vehicle equipped with a camera fixed to the vehicle moves, there is a problem that an object existing in a direction forming an angle with the direction of the camera cannot always be moved while being caught in the field of view of the camera. .

【0007】それゆえに、この発明の主たる目的は、自
転と所定の方向への移動を組み合わせながら移動する全
方向移動車両が理想的な並進回転移動に近い移動をする
ことができる全方向移動車両の移動制御方法を提供する
ことである。
Therefore, a main object of the present invention is to provide an omnidirectional vehicle capable of moving an omnidirectional vehicle that moves while combining rotation and movement in a predetermined direction close to an ideal translational rotational movement. It is to provide a movement control method.

【0008】[0008]

【課題を解決するための手段】この発明は、自転しなが
ら所定の方向へ移動する全方向移動車両の移動制御方法
であって、全移動区間を全方向移動車両の全移動区間の
自転角度によって決まる数の複数の小区間に分割するス
テップと、各小区間ごとの自転角度に基づいて前記全方
向移動車両の車輪の第1回転速度を求めるステップと、
各小区間ごとに前記車輪の回転速度を前記第1回転速度
となるように制御するステップとを含む、全方向移動車
両の移動制御方法である。
SUMMARY OF THE INVENTION The present invention is a movement control method for an omnidirectional vehicle that moves in a predetermined direction while rotating, in which the entire traveling section is controlled by the rotation angle of the entire traveling section of the omnidirectional vehicle. Dividing into a fixed number of small sections, and determining a first rotation speed of a wheel of the omnidirectional vehicle based on the rotation angle of each small section,
Controlling the rotation speed of the wheel to become the first rotation speed for each small section.

【0009】[0009]

【作用】この発明においては、全方向移動車両が自転し
ながら所定の方向に移動する場合に、全移動区間を移動
開始時から移動終了時までの全方向移動車両の自転角度
によって決まる数の複数の小区間に分割する。そして、
各小区間ごとの自転角度に基づいて、各小区間における
車輪の回転速度を計算し、車輪の回転速度が計算した値
となるように制御して旋回運動をさせることができる。
According to the present invention, when an omnidirectional vehicle moves in a predetermined direction while rotating, a plurality of omnidirectional vehicles determined by the rotation angle of the omnidirectional vehicle from the start of movement to the end of movement in the entire movement section. It is divided into small sections. And
The rotation speed of the wheel in each small section is calculated based on the rotation angle of each small section, and the turning motion can be controlled by controlling the rotation speed of the wheel to be the calculated value.

【0010】全移動区間の自転角度をあらかじめ定めた
角度ごとに複数の小区間に分割するので、各小区間ごと
の回転速度の計算が容易になる。
Since the rotation angle of the entire moving section is divided into a plurality of small sections for each predetermined angle, the rotation speed of each small section can be calculated easily.

【0011】このあらかじめ定めた角度は、0°より大
きく5°以下の範囲の角度であることが好ましい。全移
動区間をこの範囲の角度で複数の小区間に分割すること
により、理想的な並進回転移動の移動経路から大きくず
れることなく移動することができる。
This predetermined angle is preferably an angle in the range of more than 0 ° and not more than 5 °. By dividing the entire movement section into a plurality of small sections at an angle within this range, it is possible to move without greatly deviating from the ideal movement path of the translational rotation movement.

【0012】小区間における車輪の回転速度は、全移動
区間の距離情報、全移動区間における全方向移動車両の
自転角度および移動時間から求めた全方向移動車両の車
両移動速度に基づいて求めるので、各小区間における車
輪の回転速度を容易に求めることができる。
Since the rotational speed of the wheel in the small section is obtained based on the distance information of the entire moving section, the rotation angle of the omnidirectional vehicle in the entire moving section, and the vehicle moving speed of the omnidirectional vehicle obtained from the moving time, The rotation speed of the wheel in each small section can be easily obtained.

【0013】所定の小区間における車輪の回転速度の制
御が終了したか否かの判断を、移動開始時から前記所定
の小区間の移動終了までに要した時間と計算により求め
た時間とを比較することによって行なうので、移動が終
了したか否かの判断を簡便に行うことができる。
The determination as to whether or not the control of the wheel rotation speed in the predetermined small section is completed is made by comparing the time required from the start of the movement to the end of the movement of the predetermined small section with the time calculated. Since it is performed by doing, it is possible to easily determine whether or not the movement is completed.

【0014】所定の小区間における車輪の回転速度の制
御が終了したか否かの判断を、移動開始時から所定の小
区間の移動が終了するまでの車輪の回転角度の測定結果
と計算により求めた回転角度とを比較することによって
行なう。したがって、路面の状態により車輪の回転速度
が計算値からずれた場合でも、移動が終了したか否かの
判断をより正確に行うことができる。
Whether or not the control of the rotation speed of the wheel in the predetermined small section is completed is determined by the measurement result and calculation of the wheel rotation angle from the start of the movement to the end of the movement in the predetermined small section. The rotation angle is compared with the rotation angle. Therefore, even if the rotational speed of the wheels deviates from the calculated value due to the condition of the road surface, it is possible to more accurately determine whether or not the movement has ended.

【0015】全移動区間を小区間に分割する際に余り区
間が生じた場合には、余り区間の距離情報、前記余り区
間における前記全方向移動車両の自転角度および移動時
間を設定し、その情報に基づいて余り区間での回転速度
を計算し、車輪の回転速度が計算した値となるように制
御する。このことにより、余り区間でも、全方向移動車
両が理想的な並進回転移動を行った場合に通る移動経路
から大きくずれることなく移動させることができる。
When a surplus section is generated when the whole traveling section is divided into small sections, distance information of the surplus section, rotation angle and traveling time of the omnidirectional vehicle in the surplus section are set, and the information is set. Based on the above, the rotation speed in the surplus section is calculated, and control is performed so that the rotation speed of the wheels becomes the calculated value. As a result, even in the surplus section, it is possible to move the omnidirectional vehicle without significantly deviating from the movement route that the vehicle travels when it makes an ideal translational rotation movement.

【0016】[0016]

【発明の効果】この発明によれば、全移動区間を自転角
度の小さい複数の小区間に分割して、各小区間ごとに旋
回移動をさせるので、全方向移動車両が理想的な並進回
転移動を行った場合に通る移動経路から大きくずれるこ
となく移動させることができる。
According to the present invention, the entire moving section is divided into a plurality of small sections each having a small rotation angle, and the turning movement is performed for each small section. It is possible to move without significantly deviating from the movement route that is taken when performing.

【0017】この発明の上述の目的,その他の目的,特
徴および利点は、図面を参照して行う以下の実施例の詳
細な説明から一層明らかとなろう。
The above-mentioned objects, other objects, features and advantages of the present invention will become more apparent from the detailed description of the following embodiments made with reference to the drawings.

【0018】[0018]

【実施例】図1に示すこの実施例の全方向移動車両(以
下、単に「車両」ということがある)10は、円盤状の
台車12を含み、この台車12の下面には、オムニホイ
ルを組み合わせた車輪14が設けられており、全方向移
動車両10を前後左右任意の方向に動かすことができ
る。台車12の上面には円筒形をした車両本体16が設
けられている。この車両本体16には、全方向移動車両
10に移動方向などの命令を外部から入力する操作部1
8、および物を把持したり操作したりできるマニュピレ
ータ20が設けられている。
DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS An omnidirectional vehicle (hereinafter sometimes simply referred to as "vehicle") 10 of this embodiment shown in FIG. 1 includes a disk-shaped carriage 12, and an underside of the carriage 12 is an omniwheel. The wheels 14 are provided so that the omnidirectional vehicle 10 can be moved in any of the front, rear, left and right directions. A vehicle body 16 having a cylindrical shape is provided on the upper surface of the carriage 12. The vehicle body 16 includes an operation unit 1 for inputting a command such as a moving direction to the omnidirectional vehicle 10 from outside.
8 and a manipulator 20 capable of gripping and manipulating objects.

【0019】また、全方向移動車両10の移動方向、移
動終了地点などを示すランドマークを取り込んだり、目
標物までの距離計測を行なったりするためにカメラ22
が、その向きを車両本体16に固定して取り付けられて
いる。なお、カメラ22はステレオ距離計測が行なえる
ように2台搭載されている。
Further, the camera 22 is used to capture landmarks indicating the moving direction of the omnidirectional vehicle 10, the moving end point, etc., and to measure the distance to the target.
However, the direction is fixed and attached to the vehicle body 16. Two cameras 22 are mounted so that stereo distance measurement can be performed.

【0020】次に、この実施例で使用するオムニホイル
およびそれを車輪14として用いた全方向移動車両10
について説明する。オムニホイルとは、車輪の外周にフ
リーローラを複数個設けた特殊な車輪をいい、接地面に
おいて円周方向には確実に推進力を伝え、その垂直方向
つまり回転軸方向には力が伝わらない摩擦ゼロに近い車
輪である。
Next, the omni-wheel used in this embodiment and the omnidirectional vehicle 10 using the omni-wheel as the wheels 14 will be described.
Will be described. An omni-wheel is a special wheel that has multiple free rollers on the outer circumference of the wheel, and reliably transmits propulsive force in the circumferential direction on the ground contact surface, and friction that does not transmit force in the vertical direction, that is, the rotational axis direction. It is a wheel close to zero.

【0021】図2に示すように、車輪14はオムニホイ
ル24を2個組み合わせたもので、各オムニホイル24
は3個のフリーローラ26がその外周に沿って互いの距
離が等しくなるように配置されおり、各フリーローラ2
6の長さはそれぞれオムニホイル24の円周の1/3程
度である。
As shown in FIG. 2, the wheel 14 is a combination of two omni-wheels 24.
Are arranged such that the three free rollers 26 are arranged at equal distances from each other along the outer circumference thereof.
The length of 6 is about 1/3 of the circumference of the omni foil 24.

【0022】また、車輪14は各オムニホイル24の回
転軸28を共通にして組み合わせたもので、一方のオム
ニホイル24のフリーローラ26と他方のオムニホイル
24のフリーローラ26とは重ならないように配置され
ている。すなわち、車輪として用いた場合に、常にいず
れかのオムニホイル24のフリーローラ26が必ず路面
に接するように配置されている。
The wheel 14 is a combination of the rotary shafts 28 of the respective omni wheels 24, and is arranged so that the free roller 26 of one omni wheel 24 and the free roller 26 of the other omni wheel 24 do not overlap. There is. That is, when used as a wheel, the free roller 26 of any one of the omni wheels 24 is arranged so as to always come into contact with the road surface.

【0023】なお、この実施例ではフリーローラをその
外周上に隙間なく配置したオムニホイルも使用できる
が、その場合は単独で車輪として使用する。また、この
実施例が適用される他の車輪としては、フリーローラが
外周とある角度をもって取り付けられているメカナムホ
イルなどがある。
In this embodiment, an omniwheel having free rollers arranged on its outer circumference without any gap can be used, but in that case, it is used alone as a wheel. Further, as another wheel to which this embodiment is applied, there is a mecanum wheel in which a free roller is attached at an angle with the outer circumference.

【0024】図3に示すように、全方向移動車両10の
台車12には3個の車輪14が、その外周に沿って正三
角形をなすように取り付けられている。
As shown in FIG. 3, three wheels 14 are attached to the bogie 12 of the omnidirectional vehicle 10 so as to form an equilateral triangle along the outer periphery thereof.

【0025】図4に示すように、全方向移動車両10の
移動制御装置30は、全方向移動車両10の移動を制御
しているコンピュータ32を含み、コンピュータ32に
は、操作部18とモータドライバ34が接続されてい
る。さらに、モータドライバ34はサーボモータ36に
対して駆動信号を送り、サーボモータ36は車輪14を
回転駆動する。また、車輪14にはエンコーダ38が連
結されており、エンコーダ38の出力はコンピュータ3
2にフィードバックされる。
As shown in FIG. 4, the movement control device 30 for the omnidirectional vehicle 10 includes a computer 32 that controls the movement of the omnidirectional vehicle 10. The computer 32 includes an operation unit 18 and a motor driver. 34 is connected. Further, the motor driver 34 sends a drive signal to the servo motor 36, and the servo motor 36 rotationally drives the wheels 14. An encoder 38 is connected to the wheels 14, and the output of the encoder 38 is the computer 3
Feedback to 2.

【0026】操作部18は外部からの移動指令をコンピ
ュータ30に入力する。コンピュータ32は、操作部1
8から入力されたデータや車両内部に格納された作業計
画に基づいた移動目標などに基づいて、全方向移動車両
10の各車輪14の回転速度を計算し、それをモータド
ライバ34に指令する。そして、モータドライバ34は
車輪14の回転速度がコンピュータ32によって計算さ
れた回転速度となるようにサーボモータ36を制御す
る。また、エンコーダ38は車輪14の回転速度を測定
してコンピュータ32にフィードバックしているので、
コンピュータ32は車輪14の回転速度の制御の適否を
判断し、不適切な場合モータードライバ34に修正指令
値を与えることができる。
The operation unit 18 inputs a movement command from the outside to the computer 30. The computer 32 is the operation unit 1
The rotation speed of each wheel 14 of the omnidirectional vehicle 10 is calculated based on the data input from 8 and the movement target based on the work plan stored inside the vehicle, and the rotation speed is instructed to the motor driver 34. Then, the motor driver 34 controls the servo motor 36 so that the rotation speed of the wheels 14 becomes the rotation speed calculated by the computer 32. Further, since the encoder 38 measures the rotation speed of the wheel 14 and feeds it back to the computer 32,
The computer 32 can judge whether the control of the rotation speed of the wheels 14 is appropriate or not, and can give a correction command value to the motor driver 34 if it is inappropriate.

【0027】図5に示すフロー図を用いて、全方向移動
車両10の移動制御方法を詳細に説明する。まず、ステ
ップS1では操作部18からの移動指令や車両内部に格
納された作業計画に基づいた移動指令に基づいて、車両
の移動パラメータを設定する。図6を参照して車両10
の移動パラメータを具体的に説明すると、車両10が自
転しながら所定の方向へ移動する場合、移動開始地点に
固定された車両座標系から見たときの移動終了地点での
車両10のX座標Xtot、Y座標Ytot、および移
動開始地点から移動終了地点までの車両の自転角度θt
ot、移動時間Ttotを設定する。ここで、矢印40
はカメラ22の向きをあらわしている。
The movement control method of the omnidirectional vehicle 10 will be described in detail with reference to the flow chart shown in FIG. First, in step S1, the movement parameter of the vehicle is set based on the movement instruction from the operation unit 18 or the movement instruction based on the work plan stored inside the vehicle. A vehicle 10 with reference to FIG.
Specifically, when the vehicle 10 rotates in a predetermined direction while rotating on its own axis, the X coordinate Xtot of the vehicle 10 at the movement end point when viewed from the vehicle coordinate system fixed at the movement start point. , Y coordinate Ytot, and rotation angle θt of the vehicle from the movement start point to the movement end point
ot and moving time Ttot are set. Where arrow 40
Indicates the orientation of the camera 22.

【0028】次に、ステップS3では移動開始地点から
移動終了地点までの全移動区間を自転角度によって決ま
る数の複数の小区間に分割する。分割する小区間の個数
Sは、あらかじめ設定しておいた各小区間ごとの自転角
度θsegを用いて次式により決定する。
Next, in step S3, the entire movement section from the movement start point to the movement end point is divided into a plurality of small sections determined by the rotation angle. The number S of small sections to be divided is determined by the following equation using the preset rotation angle θseg for each small section.

【0029】[0029]

【数1】S=θtot/θseg ここで、小区間の自転角度θsegとしては任意の値を
設定でき、この値によって理想的な並進回転移動からの
ずれが決まる。各小区間を移動中も理想的な並進回転移
動からのずれを少なくするためには、0°<θseg≦
約5°の範囲に含まれる角度が好ましい。また、この小
区間の自転角度θsegはコンピュータ32にあらかじ
め記憶させておいてもよいし、全方向移動車両10が移
動する経路の状況(道路幅の大小、障害物の有無など)
に応じて操作部18から入力してもよい。
## EQU1 ## S = .theta.tot / .theta.seg Here, an arbitrary value can be set as the rotation angle .theta.seg of the small section, and this value determines the deviation from the ideal translational rotation movement. In order to reduce the deviation from the ideal translational rotation movement even during movement in each small section, 0 ° <θseg ≦
Angles in the range of about 5 ° are preferred. Further, the rotation angle θseg of this small section may be stored in the computer 32 in advance, or the state of the route along which the omnidirectional vehicle 10 moves (road width, presence or absence of obstacles, etc.).
It may be input from the operation unit 18 in accordance with the above.

【0030】なお、全移動区間における車両の自転角度
θtotが小区間の自転角度θseg以下の場合はこの
実施例の移動制御方法で移動させても、理想的な並進回
転移動からのずれが小さいので小区間に分割する必要は
ない。
When the rotation angle θtot of the vehicle in the entire movement section is equal to or smaller than the rotation angle θseg in the small section, even if the vehicle is moved by the movement control method of this embodiment, the deviation from the ideal translational rotation movement is small. There is no need to divide into small sections.

【0031】また、小区間の個数Sを求める計算を実行
した結果、割り切れずに余りが生じた場合の余りに相当
する移動区間(以下「余り区間」という)での移動につ
いてはステップS21以降で詳しく説明する。
Further, as a result of executing the calculation for obtaining the number S of small sections, if there is a remainder that is not divisible, a movement section corresponding to the remainder (hereinafter referred to as "remainder section") will be described in detail after step S21. explain.

【0032】ステップS5では、経過時間tを「0」に
セットする。
In step S5, the elapsed time t is set to "0".

【0033】ステップS7では、小区間を表す変数iを
最初の小区間を表す「0」にセットする。
In step S7, the variable i representing the small section is set to "0" representing the first small section.

【0034】ステップS9では、各小区間での車両10
の移動速度を計算する。まず、小区間
In step S9, the vehicle 10 in each small section is
Calculate the moving speed of. First, a small section

〔0〕での車両1
0の移動速度を求める。小区間
Vehicle 1 at [0]
The moving speed of 0 is calculated. Small section

〔0〕の直線移動距離L
segは全移動区間の直線距離を小区間の個数Sに分割
することによって求められる。
Straight travel distance L of [0]
The seg is obtained by dividing the linear distance of the entire moving section into the number S of small sections.

【0035】[0035]

【数2】 [Equation 2]

【0036】次に、求めた小区間の直線移動距離Lse
gに対応する円弧に沿った旋回移動距離LRsegは、
図7に示す幾何学的な関係を利用すると
Next, the calculated straight line movement distance Lse of the small section
The turning movement distance LRseg along the arc corresponding to g is
Using the geometric relationships shown in FIG.

【0037】[0037]

【数3】 [Equation 3]

【0038】移動開始状態の車両座標系のX軸と直線移
動方向とのなす角αは、
The angle α formed between the X axis of the vehicle coordinate system in the movement start state and the linear movement direction is

【0039】[0039]

【数4】 [Equation 4]

【0040】また、円弧に沿った車両10の移動速度を
Vとすると、小区間の円弧に沿った移動距離LRseg
をその移動に要する時間Tseg(=Ttot/S)で
割れば車両10の移動速度Vが求められる。
Further, the moving speed of the vehicle 10 along the arc is
Let V be the moving distance LRseg along the arc of the small section.
Is divided by the time Tseg (= Ttot / S) required for the movement, the moving speed V of the vehicle 10 can be obtained.

【0041】[0041]

【数5】 [Equation 5]

【0042】次に、図8に示すように、Vx、Vyはそ
れぞれ車両10の移動速度VのX成分、Y成分、ωは車
両10の自転速度である。以下の説明では、車両10の
移動速度のX成分Vx、Y成分Vy、車両10の自転速
度ωをまとめて車両移動速度ということがある。また、
V1〜V3は車輪14の移動速度、ω1〜ω3は車輪1
4の回転速度であり、両者の関係は車輪14の半径をr
とすると、例えばV1=rω1の関係がある。なお、こ
のときの車両移動速度は車両10に固定された座標系を
基準にした値である。
Next, as shown in FIG. 8, Vx and Vy are the X and Y components of the moving speed V of the vehicle 10, and ω is the rotation speed of the vehicle 10. In the following description, the X component Vx, the Y component Vy, and the rotation speed ω of the moving speed of the vehicle 10 may be collectively referred to as the vehicle moving speed. Also,
V1 to V3 are moving speeds of the wheels 14, and ω1 to ω3 are wheels 1
4 is the rotation speed, and the relationship between the two is the radius of the wheel 14 r
Then, for example, there is a relationship of V1 = rω1. The vehicle moving speed at this time is a value based on the coordinate system fixed to the vehicle 10.

【0043】そこで、小区間Therefore, a small section

〔0〕での車両10の移動
速度V
Moving speed V of the vehicle 10 at [0]

〔0〕のX成分VxX component Vx of [0]

〔0〕、Y成分Vy[0], Y component Vy

〔0〕、
小区間
[0],
Small section

〔0〕での車両10の自転速度ωRotational speed ω of the vehicle 10 at [0]

〔0〕は次のよ
うになる。
[0] is as follows.

【0044】[0044]

【数6】 [Equation 6]

【0045】次に、求めた小区間Next, the obtained small section

〔0〕での車両移動速
度Vx(0)、Vy(0)、ω(0)を用いて、任意の
小区間〔i〕での車両10の移動速度のX成分Vx
〔i〕、Y成分Vy〔i〕、車両10の自転速度ω
〔i〕を求める方法について説明する。車両10は各小
区間ごとにθsegだけ自転しているので、小区間
〔i〕では小区間
Using the vehicle moving speeds Vx (0), Vy (0), and ω (0) in [0], the X component Vx of the moving speed of the vehicle 10 in an arbitrary small section [i].
[I], Y component Vy [i], rotation speed ω of the vehicle 10.
A method for obtaining [i] will be described. Since the vehicle 10 rotates by θseg for each small section, the small section [i]

〔0〕を基準に考えると(θseg*
i)だけ自転することになる。したがって、
Considering [0] as a reference (θseg *
Only i) will rotate. Therefore,

【0046】[0046]

【数7】 [Equation 7]

【0047】ステップS11では、任意の小区間〔i〕
での車輪14の回転速度ω1〔i〕〜ω3〔i〕を計算
する。ステップS9で得られた小区間〔i〕での車両1
0の移動速度のX成分Vx〔i〕、Y成分Vy〔i〕、
および自転速度ω〔i〕を用いて、車輪14の移動速度
V1〔i〕〜V3〔i〕を求めると、
In step S11, an arbitrary small section [i]
The rotational speeds ω1 [i] to ω3 [i] of the wheels 14 at are calculated. Vehicle 1 in small section [i] obtained in step S9
X component Vx [i], Y component Vy [i] of the moving speed of 0,
Using the rotation speed ω [i] and the moving speeds V1 [i] to V3 [i] of the wheels 14,

【0048】[0048]

【数8】 [Equation 8]

【0049】次に、車輪14の移動速度と回転速度の関
係を利用して車輪10の回転速度ω1〔i〕〜ω3
〔i〕を求めと、
Next, the rotational speeds ω1 [i] to ω3 of the wheels 10 are utilized by utilizing the relationship between the moving speed and the rotational speed of the wheels 14.
When [i] is calculated,

【0050】[0050]

【数9】 [Equation 9]

【0051】この車輪14の回転速度ω1〔i〕〜ω3
〔i〕は、実際にはコンピュータ32で逆キネマティク
ス計算により求められる。
Rotational speeds of the wheels 14 ω1 [i] to ω3
[I] is actually obtained by the computer 32 by inverse kinematics calculation.

【0052】ステップ13では、小区間〔i〕における
各車輪14の回転速度をS11で求めたω1〔i〕〜ω
3〔i〕となるように制御する。すなわち、逆キネマテ
ィクス計算により求められた各車輪14の回転速度ω1
〔i〕〜ω3〔i〕は、モータードライバ34に送られ
る。そして、モータードライバ34は各車輪14の回転
速度が所定の値ω1〔i〕〜ω3〔i〕を保つようにサ
ーボモータ36を制御する。
In step 13, the rotational speeds of the wheels 14 in the small section [i] are obtained in S11 from ω1 [i] to ω1.
Control is performed so as to be 3 [i]. That is, the rotation speed ω1 of each wheel 14 obtained by the inverse kinematics calculation
[I] to ω3 [i] are sent to the motor driver 34. Then, the motor driver 34 controls the servo motor 36 so that the rotation speed of each wheel 14 maintains a predetermined value ω1 [i] to ω3 [i].

【0053】このように、車両10に小区間〔i〕で車
輪14の回転速度が一定となるような移動をさせると、
車両10は小区間〔i〕で旋回移動を行なう。この旋回
移動が終了した地点では車両の向き(カメラ22の向
き)が理想的な並進回転移動を行ったときと同じにな
る。すなわち、例えば、最初の小区間
In this way, when the vehicle 10 is moved so that the rotation speed of the wheels 14 becomes constant in the small section [i],
The vehicle 10 turns in a small section [i]. At the point where this turning movement is completed, the orientation of the vehicle (the orientation of the camera 22) is the same as when the ideal translational rotation movement was performed. That is, for example, the first small section

〔0〕での旋回移
動終了地点では、移動開始時から時間Tseg=Tto
t/Sが経過しているので、X座標Xtot/S,Y座
標Ytot/S,自転角度θtot/Sだけ、並進およ
び自転した状態となっている。
At the turning movement end point in [0], the time Tseg = Tto from the start of movement.
Since t / S has elapsed, it is in a translated and rotated state by the X coordinate Xtot / S, the Y coordinate Ytot / S, and the rotation angle θtot / S.

【0054】また、各車輪14にはそれぞれエンコーダ
38が連結されているので、コンピュータ32はエンコ
ーダ38によって測定された各車輪14の回転速度が計
算によって求めた回転速度ω1〔i〕〜ω3〔i〕から
ずれている場合には、回転速度がω1〔i〕〜ω3
〔i〕となるようにサーボモータ36を制御する。
Further, since the encoders 38 are connected to the respective wheels 14, the computer 32 causes the rotational speeds of the respective wheels 14 measured by the encoder 38 to be calculated by calculating the rotational speeds ω1 [i] to ω3 [i]. ], The rotation speed is ω1 [i] to ω3
The servo motor 36 is controlled so as to obtain [i].

【0055】ステップS15では、任意の小区間〔i〕
について旋回移動が終了したか否かを判断する。この判
断は、全移動区間の移動開始時から現在までの経過時間
tと、小区間〔i〕の旋回移動終了時(Tseg*(i
+1))までの時間とを比較することによって行なう。
このステップで「NO」の場合、すなわち、経過時間t
の方が小さい場合は小区間〔i〕での旋回移動はまだ終
了していないため、各車輪14の回転速度をステップS
13で求めた車輪14の回転速度ω1〔i〕〜ω3
〔i〕になるように引き続き制御する。一方、「YE
S」の場合、すなわち、経過時間tの方が大きい場合に
は小区間〔i〕の旋回移動が終了しているので、次のス
テップS17に進む。
In step S15, an arbitrary small section [i]
It is determined whether or not the turning movement is completed. This determination is based on the elapsed time t from the start of movement of all movement sections to the present and the end of turning movement of the small section [i] (Tseg * (i
This is done by comparing the time up to +1)).
If "NO" in this step, that is, the elapsed time t
If is smaller, the turning movement in the small section [i] is not yet completed, and therefore the rotation speed of each wheel 14 is set to step S.
Rotational speeds ω1 [i] to ω3 of the wheels 14 obtained in step 13
Control is continued so as to obtain [i]. On the other hand, "YE
In the case of "S", that is, when the elapsed time t is longer, the turning movement of the small section [i] has been completed, so that the process proceeds to the next step S17.

【0056】ステップS17では、次の小区間〔i+
1〕での処理に進むため、小区間を表す変数iを(i+
1)とする。
In step S17, the next small section [i +
1], the variable i representing the small section is changed to (i +
1).

【0057】ステップS19では、ステップS3で設定
したすべての小区間で旋回移動が終了したか否かを判断
する。このステップで「NO」の場合、すなわち、小区
間の変数iの値とステップS3で求めた小区間の個数S
を比較し、変数iの値が小さい場合にはステップS9に
戻り、小区間〔i+1〕での車両10の移動速度を計算
する。一方、このステップで「YES」の場合、すなわ
ち、変数iの値と小区間の個数Sが等しい場合には、ス
テップS3で分割したすべての小区間について旋回移動
が終了しているので、次のステップS21に進む。
In step S19, it is determined whether or not the turning movement is completed in all the small sections set in step S3. In the case of "NO" in this step, that is, the value of the variable i of the small section and the number of small sections S obtained in step S3
When the value of the variable i is small, the process returns to step S9, and the moving speed of the vehicle 10 in the small section [i + 1] is calculated. On the other hand, if "YES" in this step, that is, if the value of the variable i is equal to the number S of small sections, the turning movement is completed for all the small sections divided in step S3, It proceeds to step S21.

【0058】ステップS21では、ステップS3で小区
間の個数Sを求める際に、S=θtot/θsegで割
り切れない場合、すなわち余りが出る場合であるかどう
かを判断する。そして、このステップで「NO」の場
合、すなわち余りが出ない場合は、全方向移動車両10
は全移動区間の移動終了地点まで移動しているので移動
制御を終了する。また、このステップで「YES」の場
合、すなわち、余りが出る場合には、小区間の旋回移動
を行なっただけでは全移動区間を完全に移動しておら
ず、余り区間が残っていることをあらわしている。
In step S21, when the number S of small sections is obtained in step S3, it is determined whether or not it is not divisible by S = θtot / θseg, that is, there is a remainder. If “NO” in this step, that is, if there is no remainder, the omnidirectional vehicle 10
Has moved to the movement end point of all movement sections, so movement control ends. If "YES" in this step, that is, if there is a surplus, it is confirmed that the entire traveling section has not been completely moved just by performing the turning movement of the small section, and the remaining section remains. It shows.

【0059】ステップS23では、余り区間について移
動制御することにより、全移動区間の移動終了地点まで
移動して移動制御を終了する。なお、余り区間における
移動制御については以下のステップで詳細に説明する。
In step S23, the movement control is performed for the surplus section, and the movement control is ended by moving to the movement end point of all the movement sections. The movement control in the surplus section will be described in detail in the following steps.

【0060】図9に示すフロー図を用いて、全方向移動
車両10の余り区間における移動制御方法を詳細に説明
する。余り区間における移動制御方法は、ステップS3
に相当する複数の小区間に分割するステップがない点を
除いて、上述の小区間における移動制御方法と類似した
ステップで行なわれる。
The movement control method in the surplus section of the omnidirectional vehicle 10 will be described in detail with reference to the flow chart shown in FIG. The movement control method in the surplus section is performed in step S3.
Is performed in steps similar to the movement control method in the above-described small section except that there is no step of dividing into a plurality of small sections.

【0061】図9を参照して、まずステップS23aで
は、ステップS1と同様にして、余り区間において改め
て車両10の移動パラメータを設定する。すなわち、余
り区間において、移動開始状態の車両座標系から見たと
きの移動終了状態での車両10のX座標XA、Y座標Y
Aおよび移動開始状態から移動終了状態までの間の車両
10の自転角度θA、その間の移動時間TAを設定す
る。
Referring to FIG. 9, first, in step S23a, similarly to step S1, the movement parameter of the vehicle 10 is set again in the surplus section. That is, in the surplus section, the X coordinate XA and the Y coordinate Y of the vehicle 10 in the movement end state when viewed from the vehicle coordinate system in the movement start state.
A, the rotation angle θA of the vehicle 10 from the movement start state to the movement end state, and the movement time TA during that period are set.

【0062】ステップS23bでは、ステップS3と同
様にして、余り区間における移動開始時からの経過時間
tAを「0」にセットする。
In step S23b, as in step S3, the elapsed time tA from the start of movement in the surplus section is set to "0".

【0063】ステップS23cでは、ステップS9と同
様にして、ステップS23aで求めた余り区間における
車両10の移動パラメータを使用して、車両10の移動
速度VAx、VAy、ωAを計算する。
In step S23c, the moving speeds VAx, VAy, ωA of the vehicle 10 are calculated using the moving parameters of the vehicle 10 in the surplus section obtained in step S23a, as in step S9.

【0064】ステップS23dでは、ステップS11と
同様にして、ステップS23cで求めた余り区間におけ
る車両10の移動速度VAx、VAy、ωAを使用し
て、車輪14の回転速度ωA1、ωA2、ωA3を求め
る。
In step S23d, similarly to step S11, the rotational speeds ωA1, ωA2, ωA3 of the wheels 14 are calculated using the moving speeds VAx, VAy, ωA of the vehicle 10 in the surplus section calculated in step S23c.

【0065】ステップS23eでは、車輪14の回転速
度がステップS24dで求めたωA1、ωA2、ωA3
となるようにサーボモータ36を制御する。
In step S23e, the rotational speeds of the wheels 14 are ωA1, ωA2, ωA3 obtained in step S24d.
The servo motor 36 is controlled so that

【0066】ステップS23fでは、余り区間の移動開
始時からの経過時間tAとステップS23aで設定した
余り区間の移動時間TAとを比較する。その結果、この
ステップで「NO」の場合、すなわち、tAの方が大き
い場合には余り区間の移動がまだ終わっていないので、
各車輪14の回転速度をωA1、ωA2、ωA3となる
ようにサーボモータ36によって継続して制御する。一
方、「YES」の場合、すなわち、小さい場合には余り
区間を含む全移動区間の移動が終わっているので全方向
移動車両10の移動制御を終了する。
In step S23f, the elapsed time tA from the start of movement of the surplus section and the movement time TA of the surplus section set in step S23a are compared. As a result, if “NO” in this step, that is, if tA is larger, the movement of the remaining section is not yet finished,
The rotation speed of each wheel 14 is continuously controlled by the servo motor 36 so as to be ωA1, ωA2, ωA3. On the other hand, in the case of "YES", that is, when it is smaller, the movement of all the movement sections including the remainder section has ended, so the movement control of the omnidirectional vehicle 10 is ended.

【0067】全方向移動車両10を上述の移動制御方法
によって移動させると、図10に示すように車両10は
自転角度の小さい複数の小区間(図10の場合は3個の
小区間)ごとに旋回移動するので、各小区間では理想的
な並進回転移動からのずれが少ない近似的な並進回転移
動をしていることがわかる。したがって、全移動区間で
も同様に理想的な並進回転移動からのずれが少ない近似
的な並進回転移動をしていることがわかる。ここで、矢
印40は全方向移動車両10の車両本体16に固定され
たカメラ22の向き、点線は理想的な並進回転移動、実
線はこの実施例で実現できる近似的な並進回転移動をあ
らわしている。
When the omnidirectional vehicle 10 is moved by the above-described movement control method, the vehicle 10 is divided into a plurality of small sections (three small sections in the case of FIG. 10) having small rotation angles as shown in FIG. It is understood that, since the vehicle makes a turning movement, each of the small sections makes an approximate translational rotation movement with little deviation from the ideal translational rotation movement. Therefore, it can be seen that even in the entire movement section, the similar translational rotation movement with a small deviation from the ideal translational rotation movement is similarly performed. Here, an arrow 40 indicates the direction of the camera 22 fixed to the vehicle body 16 of the omnidirectional vehicle 10, a dotted line indicates an ideal translational rotational movement, and a solid line indicates an approximate translational rotational movement that can be realized in this embodiment. There is.

【0068】したがって、車両10に固定されたカメラ
22を搭載した車両10が所定の方向へ移動するとき、
カメラ22の向き40とある角度をなす方向に存在する
対象物をカメラ22の視野内に捕らえながら移動しやす
くなる。
Therefore, when the vehicle 10 equipped with the camera 22 fixed to the vehicle 10 moves in a predetermined direction,
It becomes easy to move while catching an object existing in a direction forming an angle with the direction 40 of the camera 22 within the field of view of the camera 22.

【0069】また、車両10が任意の小区間および全移
動区間の移動が終了した地点でのカメラ22の向き40
は理想的な並進回転移動を行ったときのカメラ22の向
き40と同じ方向を向くように移動している。
Further, the direction 40 of the camera 22 at the point where the vehicle 10 has finished moving in an arbitrary small section and all moving sections.
Is moving so as to face the same direction as the direction 40 of the camera 22 when an ideal translational rotation movement is performed.

【0070】したがって、任意の小区間または全移動区
間の移動が終了した地点でカメラ22が捕らえた対象物
をマニュピレータ20によって操作する場合、従来のよ
うに所定の方向への移動とその場での自転という2段階
のステップを必要としなくなった。
Therefore, when the manipulator 20 operates the object captured by the camera 22 at the point where the movement of any small section or the entire movement section is completed, the manipulator 20 is used to move the object in a predetermined direction as in the conventional case. It no longer requires the two steps of rotation.

【0071】なお、この移動制御方法を使用する全方向
移動車両の一実施例として、3輪の全方向移動車両につ
いて説明したが、車両移動速度Vx、Vy、ωを自由に
制御することができる4輪またはそれ以上の車輪を有す
る全方向移動車両にも容易に拡張して適用することがで
きる。
Although the three-wheeled omnidirectional vehicle has been described as an example of the omnidirectional vehicle using this movement control method, the vehicle moving speeds Vx, Vy and ω can be freely controlled. It can be easily expanded and applied to an omnidirectional vehicle having four wheels or more.

【0072】また、小区間の移動が終了したか否かを判
断する方法として、ステップS15で、各小区間ごとに
車輪14が回転すべき角度(ω1〔i〕*Tseg)と
エンコーダ38を用いて測定した車輪14の回転角度と
を比較することによっても行うことができる。この回転
角度を用いて判断する方法は、車輪14が路面上のこぶ
を乗り越えるような場合等、車輪14の回転速度をステ
ップS11で計算した値に保つことができない場合に、
正確に小区間の移動の終了を判断することができる。
As a method for determining whether or not the movement of the small section is completed, in step S15, the angle (ω1 [i] * Tseg) at which the wheel 14 should rotate and the encoder 38 are used for each small section. It can also be performed by comparing the rotation angle of the wheel 14 measured by the above. The determination method using this rotation angle is performed when the rotation speed of the wheels 14 cannot be maintained at the value calculated in step S11, such as when the wheels 14 get over a bump on the road surface.
It is possible to accurately determine the end of the movement of the small section.

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

【図1】この発明の一実施例の全方向移動車両を示す図
解図である。
FIG. 1 is an illustrative view showing an omnidirectional vehicle according to an embodiment of the present invention.

【図2】図1実施例の全方向移動車両に用いられるの車
輪の一例を示す斜視図である。
FIG. 2 is a perspective view showing an example of wheels used in the omnidirectional vehicle of FIG. 1 embodiment.

【図3】図1実施例の全方向移動車両の底面を示す図解
図である。
FIG. 3 is an illustrative view showing a bottom surface of the omnidirectional vehicle of FIG. 1 embodiment.

【図4】図1実施例の移動制御装置を示すブロック図で
ある。
FIG. 4 is a block diagram showing a movement control device of FIG. 1 embodiment.

【図5】図1実施例の移動制御方法を示すフロー図であ
る。
FIG. 5 is a flowchart showing a movement control method of the embodiment in FIG.

【図6】車両の移動パラメータを示す図解図である。FIG. 6 is an illustrative view showing movement parameters of a vehicle.

【図7】小区間[Figure 7] Small section

〔0〕での車両移動速度を求めることを
示す図解図である。
It is an illustration figure which shows obtaining a vehicle moving speed in [0].

【図8】車両移動速度および車輪の回転速度を示す図解
図である。
FIG. 8 is an illustrative view showing a vehicle moving speed and a wheel rotation speed.

【図9】図1実施例における余り区間における移動制御
方法を示すフロー図である。
FIG. 9 is a flowchart showing a movement control method in a surplus section in the embodiment of FIG.

【図10】近似的な並進回転移動の図解図である。FIG. 10 is an illustrative view of an approximate translational rotation movement.

【図11】理想的な並進回転移動を示す図解図である。FIG. 11 is an illustrative view showing an ideal translational rotational movement.

【図12】旋回移動を示す図解図である。FIG. 12 is an illustrative view showing a turning movement.

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

10…全方向移動車両 14…車輪 22…カメラ 24…オムニホイル 30…制御装置 32…コンピュータ 10 ... Vehicles moving in all directions 14 ... Wheels 22 ... Camera 24 ... Omni Wheel 30 ... Control device 32 ... Computer

Claims (7)

【特許請求の範囲】[Claims] 【請求項1】自転しながら所定の方向へ移動する全方向
移動車両の移動制御方法であって、 (a) 全移動区間を前記全方向移動車両の前記全移動
区間の自転角度によって決まる数の複数の小区間に分割
するステップ、 (b)前記各小区間ごとの自転角度に基づいて前記全方
向移動車両の車輪の第1回転速度を求めるステップ、お
よび (c)前記各小区間ごとに前記車輪の回転速度を前記第
1回転速度となるように制御するステップを含む、全方
向移動車両の移動制御方法。
1. A movement control method for an omnidirectional vehicle that moves in a predetermined direction while rotating, comprising: (a) a total number of travel sections determined by the number of rotation angles of all the travel sections of the omnidirectional vehicle. Dividing into a plurality of small sections, (b) obtaining a first rotation speed of a wheel of the omnidirectional vehicle based on the rotation angle of each of the small sections, and (c) A movement control method for an omnidirectional vehicle, comprising the step of controlling the rotation speed of the wheels to be the first rotation speed.
【請求項2】前記ステップ(a)において、前記全移動
区間の自転角度をあらかじめ定めた角度ごとに分割する
ことによって前記全移動区間を複数の前記小区間に分割
する、請求項1記載の全方向移動車両の移動制御方法。
2. The entire moving section is divided into a plurality of the small sections in the step (a) by dividing the rotation angles of the entire moving section into predetermined angles. A movement control method for a directional vehicle.
【請求項3】前記あらかじめ定めた角度は、0°より大
きく5°以下の範囲の角度である、請求項2記載の全方
向移動車両の移動制御方法。
3. The movement control method for an omnidirectional vehicle according to claim 2, wherein the predetermined angle is an angle in a range of more than 0 ° and 5 ° or less.
【請求項4】前記ステップ(b)において、前記全移動
区間の距離情報、前記全移動区間における前記全方向移
動車両の自転角度および移動時間に基づいて前記全方向
移動車両の車両移動速度を求め、さらに前記車両移動速
度に基づいて前記第1回転速度を求める、請求項1ない
し3のいずれかに記載の全方向移動車両の移動制御方
法。
4. In the step (b), a vehicle moving speed of the omnidirectional moving vehicle is obtained based on distance information of the omnidirectional moving section, a rotation angle and a moving time of the omnidirectional moving vehicle in the all moving section. The movement control method for an omnidirectional vehicle according to any one of claims 1 to 3, further comprising: determining the first rotation speed based on the vehicle movement speed.
【請求項5】前記ステップ(c)において、所定の小区
間における前記車輪の回転速度の制御が終了したか否か
の判断を、移動開始時から前記所定の小区間の移動終了
までに要した時間と計算により求めた時間とを比較する
ことによって行なう、請求項1ないし4のいずれかに記
載の全方向移動車両の移動制御方法。
5. In the step (c), it is necessary to determine whether or not the control of the rotation speed of the wheel in a predetermined small section is completed from the start of the movement to the end of the movement of the predetermined small section. The movement control method for an omnidirectional vehicle according to any one of claims 1 to 4, wherein the movement control method is performed by comparing the time with a time obtained by calculation.
【請求項6】前記ステップ(c)において、所定の小区
間における前記車輪の回転速度の制御が終了したか否か
の判断を、移動開始時から前記所定の小区間の移動終了
までの前記車輪の回転角度の測定結果と計算により求め
た回転角度とを比較することによって行なう、請求項1
ないし4のいずれかに記載の全方向移動車両の移動制御
方法。
6. In the step (c), it is judged whether or not the control of the rotation speed of the wheel in a predetermined small section is completed, from the start of the movement to the end of the movement in the predetermined small section. 2. The measurement is carried out by comparing the measurement result of the rotation angle of 1 and the rotation angle obtained by calculation.
5. A movement control method for an omnidirectional vehicle according to any one of 4 to 4.
【請求項7】前記ステップ(a)において、全移動区間
を小区間に分割する際に生じた余り区間において、 (d)前記余り区間の距離情報、前記余り区間における
前記全方向移動車両の自転角度および移動時間を設定す
るステップと、 (e)ステップ(d)で求めた情報に基づいて、前記余
り区間での第2回転速度を求めるステップと、 (f)前記車輪の回転速度が前記第2回転速度となるよ
うに制御するステップとをさらに含む、請求項1ないし
6のいずれかに記載の全方向移動車両の移動制御方法。
7. In the step (a), in a remainder section generated when the entire movement section is divided into small sections, (d) distance information of the remainder section and rotation of the omnidirectional vehicle in the remainder section. An angle and a moving time are set, (e) a second rotation speed in the surplus section is obtained based on the information obtained in step (d), (f) a rotation speed of the wheel is the first The movement control method for an omnidirectional vehicle according to any one of claims 1 to 6, further comprising a step of controlling the rotation speed to be two rotation speeds.
JP2002135509A 2002-05-10 2002-05-10 Movement control method of omnidirectional moving vehicle Withdrawn JP2003330542A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2002135509A JP2003330542A (en) 2002-05-10 2002-05-10 Movement control method of omnidirectional moving vehicle

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2002135509A JP2003330542A (en) 2002-05-10 2002-05-10 Movement control method of omnidirectional moving vehicle

Publications (1)

Publication Number Publication Date
JP2003330542A true JP2003330542A (en) 2003-11-21

Family

ID=29697814

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2002135509A Withdrawn JP2003330542A (en) 2002-05-10 2002-05-10 Movement control method of omnidirectional moving vehicle

Country Status (1)

Country Link
JP (1) JP2003330542A (en)

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2011062094A1 (en) * 2009-11-20 2011-05-26 村田機械株式会社 Autonomous mobile body and control method of same
JP2011108130A (en) * 2009-11-20 2011-06-02 Murata Machinery Ltd Autonomous mobile body and control method therefor
CN108563227A (en) * 2018-04-20 2018-09-21 武汉大学 A kind of motion control method of the 2D wheeled robots based on movable castor
JP2019117584A (en) * 2017-12-27 2019-07-18 株式会社ダイヘン Mobile body
JP2019117585A (en) * 2017-12-27 2019-07-18 株式会社ダイヘン Mobile body

Cited By (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2011062094A1 (en) * 2009-11-20 2011-05-26 村田機械株式会社 Autonomous mobile body and control method of same
JP2011108129A (en) * 2009-11-20 2011-06-02 Murata Machinery Ltd Autonomous mobile body and control method therefor
JP2011108130A (en) * 2009-11-20 2011-06-02 Murata Machinery Ltd Autonomous mobile body and control method therefor
US8886385B2 (en) 2009-11-20 2014-11-11 Murata Machinery, Ltd. Autonomous mobile body and control method of same
US8948956B2 (en) 2009-11-20 2015-02-03 Murata Machinery, Ltd. Autonomous mobile body and control method of same
JP2019117584A (en) * 2017-12-27 2019-07-18 株式会社ダイヘン Mobile body
JP2019117585A (en) * 2017-12-27 2019-07-18 株式会社ダイヘン Mobile body
JP7021943B2 (en) 2017-12-27 2022-02-17 株式会社ダイヘン Mobile
JP7021942B2 (en) 2017-12-27 2022-02-17 株式会社ダイヘン Mobile
CN108563227A (en) * 2018-04-20 2018-09-21 武汉大学 A kind of motion control method of the 2D wheeled robots based on movable castor
CN108563227B (en) * 2018-04-20 2020-12-18 武汉大学 Motion control method of 2D wheeled robot based on movable caster

Similar Documents

Publication Publication Date Title
CN108725585B (en) Trajectory tracking control method and device for autonomous parking of vehicle
CN113306549B (en) Automatic parking trajectory planning algorithm
US6119057A (en) Autonomous vehicle with an easily set work area and easily switched mode
JP5262855B2 (en) Parking assistance device and parking assistance method
JP2009143550A (en) Automatic parking system for vehicle
JP2002104224A (en) Steering device of vehicle
KR101915887B1 (en) Travelling apparatus, control method of travelling apparatus, and control program of travelling apparatus
JP4670807B2 (en) Travel route creation method, autonomous mobile body, and autonomous mobile body control system
CN112537297B (en) Lane keeping method and system and vehicle
JP7322911B2 (en) Vehicle control method, vehicle control system, and vehicle
JPH07302118A (en) Control method of automatic movement unit
WO2017135191A1 (en) Parking assistance method
JPH064133A (en) Obstacle evading method for moving body
JP2003330542A (en) Movement control method of omnidirectional moving vehicle
JP4577247B2 (en) Mobile body and control method thereof
US20180022344A1 (en) Vehicle pivot technique
WO2017006910A1 (en) Traveling object and control method therefor
JP6744789B2 (en) Passenger boarding bridge
CN108382458B (en) Moving mechanism and movement control method
WO2016072186A1 (en) Location detecting device, control method, and autonomous vehicle
KR102462704B1 (en) Steering control method for automated guided vehicle
JP2018065404A (en) Parking support device
CN112337059A (en) Companion control for sports equipment
JP2934770B2 (en) Method and apparatus for measuring wheel diameter of mobile robot
JP2013075639A (en) Running control apparatus and vehicle

Legal Events

Date Code Title Description
A300 Application deemed to be withdrawn because no request for examination was validly filed

Free format text: JAPANESE INTERMEDIATE CODE: A300

Effective date: 20050802