JP5407514B2 - 無人搬送車の操舵駆動方法及び装置 - Google Patents
無人搬送車の操舵駆動方法及び装置 Download PDFInfo
- Publication number
- JP5407514B2 JP5407514B2 JP2009102530A JP2009102530A JP5407514B2 JP 5407514 B2 JP5407514 B2 JP 5407514B2 JP 2009102530 A JP2009102530 A JP 2009102530A JP 2009102530 A JP2009102530 A JP 2009102530A JP 5407514 B2 JP5407514 B2 JP 5407514B2
- Authority
- JP
- Japan
- Prior art keywords
- steering
- steering drive
- guided vehicle
- automatic guided
- center point
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Images
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Description
R=(H/2)/tanψ1−T/2 …(1’)
ψ2=tan-1{(H/2)/(R−T/2)} …(2’)
ここで、旋回半径Rは、旋回中心点OからAGV中心点Poまでの距離であり、ホイルベースHは、操舵駆動輪11の操舵中心点Pfと操舵駆動輪12の操舵中心点Prとの間の車長方向(車両の前後方向)の距離であり、トレッドTは、操舵駆動輪11の操舵中心点Pfと操舵駆動輪12の操舵中心点Prとの間の車幅方向(車両の左右方向)の距離である。
無人搬送車の一方の対角位置に備えられ、全方位に操舵されると共に駆動される2つの操舵駆動輪と、前記無人搬送車の他方の対角位置に備えられ、全方位に回転可能な2つのフリーキャスタと、前記操舵駆動輪を制御する制御装置とを備え、前記制御装置により前記操舵駆動輪の操舵駆動を制御して、前記無人搬送車を全方位に走行可能とする無人搬送車の操舵駆動方法であって、
前記制御装置を用いて、前記無人搬送車の中心点を通る車幅方向中心線であるx座標軸上に前記無人搬送車の旋回中心点を設定すると共に、入力された前側の前記操舵駆動輪の操舵角ψ1と前記中心点における速度Vとに基づいて、前記操舵駆動輪を操舵駆動する制御値を算出し、算出した前記制御値に基づいて、前記操舵駆動輪を操舵駆動する半自動走行時において、
前記中心点を基準点として、前記2つの操舵駆動輪の操舵中心点の座標(W1,D1)、(W2,D2)を、予め記憶しておき、
前記操舵角ψ1が、ψ1>0の場合には、下記式(1)、(2)、(3)を用いて、前記旋回中心点のx座標位置Ox、後側の前記操舵駆動輪の操舵角ψ2及び前記中心点における旋回半径Rを求め、
Ox={|W1|×tan(90°−ψ1)+D1} …(1)
ψ2=tan-1{(Ox−D2)/(|W2|)}−90° …(2)
R=Ox …(3)
前記操舵角ψ1が、ψ1<0の場合には、下記式(4)、(5)、(6)を用いて、前記x座標位置Ox、前記操舵角ψ2及び前記旋回半径Rを求め、
Ox={|W1|×tan(−90°−ψ1)+D1} …(4)
ψ2=tan-1{(Ox−D2)/(|W2|)}+90° …(5)
R=−Ox …(6)
求めた前記x座標位置Oxに基づき、下記式(7)、(8)を用いて、前側の前記操舵駆動輪の旋回半径R1と、後側の前記操舵駆動輪の旋回半径R2とを求め、
R1={(W1)2+(Ox−D1)2}1/2 …(7)
R2={(W2)2+(Ox−D2)2}1/2 …(8)
入力された前記速度Vと求めた前記旋回半径R、R1、R2に基づき、下記式(9)、(10)を用いて、前側の前記操舵駆動輪の速度V1と、後側の前記操舵駆動輪の速度V2とを求め、
V1=V×(R1/R) …(9)
V2=V×(R2/R) …(10)
前記操舵角ψ1、ψ2、前記速度V1、V2を制御値として、2つの前記操舵駆動輪を操舵駆動することを特徴とする。
但し、操舵角ψ1、ψ2は、進行方向右側への操舵角を正とし、進行方向左側への操舵角を負とする。
無人搬送車の一方の対角位置に備えられ、全方位に操舵されると共に駆動される2つの操舵駆動輪と、前記無人搬送車の他方の対角位置に備えられ、全方位に回転可能な2つのフリーキャスタと、前記操舵駆動輪を制御する制御装置とを備え、前記制御装置により前記操舵駆動輪の操舵駆動を制御して、前記無人搬送車を全方位に走行可能とする無人搬送車の操舵駆動装置であって、
前記制御装置は、
前記無人搬送車の中心点を通る車幅方向中心線であるx座標軸上に前記無人搬送車の旋回中心点を設定すると共に、入力された前側の前記操舵駆動輪の操舵角ψ1と前記無人搬送車の中心点における速度Vとに基づいて、前記操舵駆動輪を操舵駆動する制御値を算出し、算出した前記制御値に基づいて、前記操舵駆動輪を操舵駆動する半自動走行時において、
前記中心点を基準点として、前記2つの操舵駆動輪の操舵中心点の座標(W1,D1)、(W2,D2)を、予め記憶しておき、
前記操舵角ψ1が、ψ1>0の場合には、下記式(1)、(2)、(3)を用いて、前記旋回中心点のx座標位置Ox、後側の前記操舵駆動輪の操舵角ψ2及び前記中心点における旋回半径Rを求め、
Ox={|W1|×tan(90°−ψ1)+D1} …(1)
ψ2=tan-1{(Ox−D2)/(|W2|)}−90° …(2)
R=Ox …(3)
前記操舵角ψ1が、ψ1<0の場合には、下記式(4)、(5)、(6)を用いて、前記x座標位置Ox、前記操舵角ψ2及び前記旋回半径Rを求め、
Ox={|W1|×tan(−90°−ψ1)+D1} …(4)
ψ2=tan-1{(Ox−D2)/(|W2|)}+90° …(5)
R=−Ox …(6)
求めた前記x座標位置Oxに基づき、下記式(7)、(8)を用いて、前側の前記操舵駆動輪の旋回半径R1と、後側の前記操舵駆動輪の旋回半径R2とを求め、
R1={(W1)2+(Ox−D1)2}1/2 …(7)
R2={(W2)2+(Ox−D2)2}1/2 …(8)
入力された前記速度Vと求めた前記旋回半径R、R1、R2に基づき、下記式(9)、(10)を用いて、前側の前記操舵駆動輪の速度V1と、後側の前記操舵駆動輪の速度V2とを求め、
V1=V×(R1/R) …(9)
V2=V×(R2/R) …(10)
前記操舵角ψ1、ψ2、前記速度V1、V2を制御値として、2つの前記操舵駆動輪を操舵駆動することを特徴とする。
但し、操舵角ψ1、ψ2は、進行方向右側への操舵角を正とし、進行方向左側への操舵角を負とする。
本実施例において、AGVの基本的構成は、図4に示した従来のAGV10と同じであるが、手動モード(半自動走行時)における操舵駆動制御が異なっている。以下、AGV10の手動モードでの制御について説明を行うが、これは、完全な手動操作ではなく、後述する指示値を入力すれば、その指示値に基づいて、AGV10の制御装置(図示省略)が操舵駆動のための制御値を算出し、算出した制御値を用いて、AGV10の走行を制御する半自動走行のモードである。
AGV10の制御装置には、各操舵駆動輪11、12の操舵中心点Pf、Prの座標が予め記憶されている。この座標は、AGV10の中心点Po(車長方向中心線L1と車幅方向中心線L2の交点)を基準点(0,0)として求められたものであり、本実施例では、前操舵駆動輪11の操舵中心点Pfの座標を(W1,D1)、後操舵駆動輪12の操舵中心点Pr座標を(W2,D2)としている。
Ox={|W1|×tan(90°−ψ1)+D1} …(1)
ψ1=90°−tan-1{(Ox−D1)/(|W1|)} …(1a)
Ox={|W2|×tan(90°+ψ2)+D2} …(1b)
ψ2=tan-1{(Ox−D2)/(|W2|)}−90° …(2)
R=Ox …(3)
Ox={|W1|×tan(−90°−ψ1)+D1} …(4)
ψ1=−90°−tan-1{(Ox−D1)/(|W1|)} …(4a)
Ox={|W2|×tan(ψ2−90°)+D2} …(4b)
ψ2=tan-1{(Ox−D2)/(|W2|)}+90° …(5)
R=−Ox …(6)
R1={(W1)2+(Ox−D1)2}1/2 …(7)
R2={(W2)2+(Ox−D2)2}1/2 …(8)
V1=V×(R1/R) …(9)
V2=V×(R2/R) …(10)
11 前操舵駆動輪
12 後操舵駆動輪
20 誘導線
21、22、23、24 誘導センサ
31、32 フリーキャスタ
Claims (2)
- 無人搬送車の一方の対角位置に備えられ、全方位に操舵されると共に駆動される2つの操舵駆動輪と、前記無人搬送車の他方の対角位置に備えられ、全方位に回転可能な2つのフリーキャスタと、前記操舵駆動輪を制御する制御装置とを備え、前記制御装置により前記操舵駆動輪の操舵駆動を制御して、前記無人搬送車を全方位に走行可能とする無人搬送車の操舵駆動方法であって、
前記制御装置を用いて、前記無人搬送車の中心点を通る車幅方向中心線であるx座標軸上に前記無人搬送車の旋回中心点を設定すると共に、入力された前側の前記操舵駆動輪の操舵角ψ1と前記中心点における速度Vとに基づいて、前記操舵駆動輪を操舵駆動する制御値を算出し、算出した前記制御値に基づいて、前記操舵駆動輪を操舵駆動する半自動走行時において、
前記中心点を基準点として、前記2つの操舵駆動輪の操舵中心点の座標(W1,D1)、(W2,D2)を、予め記憶しておき、
前記操舵角ψ1が、ψ1>0の場合には、下記式(1)、(2)、(3)を用いて、前記旋回中心点のx座標位置Ox、後側の前記操舵駆動輪の操舵角ψ2及び前記中心点における旋回半径Rを求め、
Ox={|W1|×tan(90°−ψ1)+D1} …(1)
ψ2=tan-1{(Ox−D2)/(|W2|)}−90° …(2)
R=Ox …(3)
前記操舵角ψ1が、ψ1<0の場合には、下記式(4)、(5)、(6)を用いて、前記x座標位置Ox、前記操舵角ψ2及び前記旋回半径Rを求め、
Ox={|W1|×tan(−90°−ψ1)+D1} …(4)
ψ2=tan-1{(Ox−D2)/(|W2|)}+90° …(5)
R=−Ox …(6)
求めた前記x座標位置Oxに基づき、下記式(7)、(8)を用いて、前側の前記操舵駆動輪の旋回半径R1と、後側の前記操舵駆動輪の旋回半径R2とを求め、
R1={(W1)2+(Ox−D1)2}1/2 …(7)
R2={(W2)2+(Ox−D2)2}1/2 …(8)
入力された前記速度Vと求めた前記旋回半径R、R1、R2に基づき、下記式(9)、(10)を用いて、前側の前記操舵駆動輪の速度V1と、後側の前記操舵駆動輪の速度V2とを求め、
V1=V×(R1/R) …(9)
V2=V×(R2/R) …(10)
前記操舵角ψ1、ψ2、前記速度V1、V2を制御値として、2つの前記操舵駆動輪を操舵駆動することを特徴とする無人搬送車の操舵駆動方法。
但し、操舵角ψ1、ψ2は、進行方向右側への操舵角を正とし、進行方向左側への操舵角を負とする。 - 無人搬送車の一方の対角位置に備えられ、全方位に操舵されると共に駆動される2つの操舵駆動輪と、前記無人搬送車の他方の対角位置に備えられ、全方位に回転可能な2つのフリーキャスタと、前記操舵駆動輪を制御する制御装置とを備え、前記制御装置により前記操舵駆動輪の操舵駆動を制御して、前記無人搬送車を全方位に走行可能とする無人搬送車の操舵駆動装置であって、
前記制御装置は、
前記無人搬送車の中心点を通る車幅方向中心線であるx座標軸上に前記無人搬送車の旋回中心点を設定すると共に、入力された前側の前記操舵駆動輪の操舵角ψ1と前記無人搬送車の中心点における速度Vとに基づいて、前記操舵駆動輪を操舵駆動する制御値を算出し、算出した前記制御値に基づいて、前記操舵駆動輪を操舵駆動する半自動走行時において、
前記中心点を基準点として、前記2つの操舵駆動輪の操舵中心点の座標(W1,D1)、(W2,D2)を、予め記憶しておき、
前記操舵角ψ1が、ψ1>0の場合には、下記式(1)、(2)、(3)を用いて、前記旋回中心点のx座標位置Ox、後側の前記操舵駆動輪の操舵角ψ2及び前記中心点における旋回半径Rを求め、
Ox={|W1|×tan(90°−ψ1)+D1} …(1)
ψ2=tan-1{(Ox−D2)/(|W2|)}−90° …(2)
R=Ox …(3)
前記操舵角ψ1が、ψ1<0の場合には、下記式(4)、(5)、(6)を用いて、前記x座標位置Ox、前記操舵角ψ2及び前記旋回半径Rを求め、
Ox={|W1|×tan(−90°−ψ1)+D1} …(4)
ψ2=tan-1{(Ox−D2)/(|W2|)}+90° …(5)
R=−Ox …(6)
求めた前記x座標位置Oxに基づき、下記式(7)、(8)を用いて、前側の前記操舵駆動輪の旋回半径R1と、後側の前記操舵駆動輪の旋回半径R2とを求め、
R1={(W1)2+(Ox−D1)2}1/2 …(7)
R2={(W2)2+(Ox−D2)2}1/2 …(8)
入力された前記速度Vと求めた前記旋回半径R、R1、R2に基づき、下記式(9)、(10)を用いて、前側の前記操舵駆動輪の速度V1と、後側の前記操舵駆動輪の速度V2とを求め、
V1=V×(R1/R) …(9)
V2=V×(R2/R) …(10)
前記操舵角ψ1、ψ2、前記速度V1、V2を制御値として、2つの前記操舵駆動輪を操舵駆動することを特徴とする無人搬送車の操舵駆動装置。
但し、操舵角ψ1、ψ2は、進行方向右側への操舵角を正とし、進行方向左側への操舵角を負とする。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2009102530A JP5407514B2 (ja) | 2009-04-21 | 2009-04-21 | 無人搬送車の操舵駆動方法及び装置 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2009102530A JP5407514B2 (ja) | 2009-04-21 | 2009-04-21 | 無人搬送車の操舵駆動方法及び装置 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2010256941A JP2010256941A (ja) | 2010-11-11 |
| JP5407514B2 true JP5407514B2 (ja) | 2014-02-05 |
Family
ID=43317825
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2009102530A Active JP5407514B2 (ja) | 2009-04-21 | 2009-04-21 | 無人搬送車の操舵駆動方法及び装置 |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP5407514B2 (ja) |
Families Citing this family (11)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN104203785B (zh) * | 2012-04-13 | 2016-08-24 | 株式会社尼康 | 盒装置、基板搬送装置、基板处理装置和基板处理方法 |
| DE102013011152A1 (de) * | 2013-07-04 | 2015-01-08 | Claas Selbstfahrende Erntemaschinen Gmbh | Fahrzeug mit mehreren Lenkprogrammen |
| CN106143676A (zh) * | 2015-04-09 | 2016-11-23 | 大连光洋科技集团有限公司 | 带有支撑换向的可编程agv搬运车 |
| CN106909160B (zh) * | 2015-12-23 | 2023-07-07 | 广东科达洁能股份有限公司 | 一种基于双闭环pid控制的sd型agv倒车姿态角控制装置 |
| CN107563040B (zh) * | 2017-08-28 | 2020-12-04 | 广东嘉腾机器人自动化有限公司 | 一种agv转弯轨道的绘制方法 |
| CN109916403B (zh) * | 2017-12-13 | 2023-12-05 | 华中科技大学 | 一种用于agv小车的短时精确定位的装置及方法 |
| CN110103998B (zh) * | 2019-05-16 | 2020-06-09 | 湖南驰众机器人有限公司 | 非对称四舵轮agv转向及平移运动的控制方法 |
| CN110154787B (zh) * | 2019-06-27 | 2023-08-15 | 浙江亿控自动化设备有限公司 | 一种双舵轮无人搬运车及其控制方法 |
| CN110733564B (zh) * | 2019-11-21 | 2020-10-30 | 安徽春华智能科技有限公司 | 一种agv小车的驱动转向装置及其工作方法 |
| KR102391264B1 (ko) * | 2020-10-23 | 2022-04-27 | 현대무벡스 주식회사 | 무인운반차의 방향 전환 제어방법 |
| CN112947479B (zh) * | 2021-03-24 | 2022-09-16 | 合肥中科蓝睿科技有限公司 | 面向智能仓储的全向重载agv运动控制方法和系统 |
Family Cites Families (7)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2547575Y2 (ja) * | 1992-09-22 | 1997-09-10 | 日本輸送機株式会社 | フォークリフトの走行モード選択表示装置 |
| JPH09171407A (ja) * | 1995-12-20 | 1997-06-30 | Hitachi Zosen Corp | 移動体の誘導操舵装置 |
| JP3952548B2 (ja) * | 1997-08-11 | 2007-08-01 | 神鋼電機株式会社 | 無人走行車の制御方法及びその装置 |
| JP3361280B2 (ja) * | 1998-11-16 | 2003-01-07 | 日本輸送機株式会社 | 3輪操舵無人搬送車 |
| JP2002351545A (ja) * | 2001-05-25 | 2002-12-06 | Tcm Corp | 無人搬送車のステアリング制御方法および装置 |
| JP4089344B2 (ja) * | 2002-08-13 | 2008-05-28 | 株式会社明電舎 | 全方位走行無人搬送車の誘導走行方法 |
| JP2005071128A (ja) * | 2003-08-26 | 2005-03-17 | Matsushita Electric Ind Co Ltd | 無人搬送車およびこの無人搬送車の走行制御方法 |
-
2009
- 2009-04-21 JP JP2009102530A patent/JP5407514B2/ja active Active
Also Published As
| Publication number | Publication date |
|---|---|
| JP2010256941A (ja) | 2010-11-11 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP5407514B2 (ja) | 無人搬送車の操舵駆動方法及び装置 | |
| CN108473132B (zh) | 停车辅助系统、停车辅助方法及程序 | |
| US10384609B2 (en) | Vehicle rear object proximity system using multiple cameras | |
| CN103889825B (zh) | 用于支持机动车驾驶员的方法和设备 | |
| JP3721973B2 (ja) | 車両の操舵装置 | |
| JP5947091B2 (ja) | 車両用駐車軌跡導出方法 | |
| JP5262855B2 (ja) | 駐車支援装置及び駐車支援方法 | |
| KR101398223B1 (ko) | 차량의 차선 변경 제어 장치 및 그 제어 방법 | |
| JP6942735B2 (ja) | 駐車軌道の決定を伴う動力車両の駐車スペースへの操作のための方法、ドライバー支援システム及び動力車両 | |
| JP7047659B2 (ja) | 無人搬送車の制御装置及び制御方法 | |
| CN109747355B (zh) | 车辆挂接辅助系统及车辆 | |
| CN205880660U (zh) | 一种采用轮毂电机驱动的agv小车 | |
| KR20090125075A (ko) | 반자동 주차 기계 | |
| JP4167562B2 (ja) | 車両用走行支援装置 | |
| CN111055832A (zh) | 挂接辅助系统 | |
| US11155298B2 (en) | Modified steering angle at completion of hitch assist operation | |
| JP6289546B2 (ja) | 駐車支援装置 | |
| CN112776792A (zh) | 用于车辆定位以操作自动挂接特征的引导式指导 | |
| JP2004352120A (ja) | 車両用走行支援装置 | |
| JPH0854925A (ja) | 無人車 | |
| CN110871837A (zh) | 用于在辅助车辆操作中进行转向控制的系统和方法 | |
| US11279187B2 (en) | Automatic alignment reattempt in automatic hitch operation | |
| JP2008296638A (ja) | 駐車支援装置、表示装置、目標軌跡設定方法 | |
| JP2004338638A (ja) | 車両用走行支援装置 | |
| JP2018065404A (ja) | 駐車支援装置 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20111209 |
|
| A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20130318 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20130326 |
|
| TRDD | Decision of grant or rejection written | ||
| A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20131008 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20131021 |
|
| R150 | Certificate of patent or registration of utility model |
Ref document number: 5407514 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |