JP7464331B1 - 搬送車の走行制御システム及び搬送車の走行制御方法 - Google Patents
搬送車の走行制御システム及び搬送車の走行制御方法 Download PDFInfo
- Publication number
- JP7464331B1 JP7464331B1 JP2023573147A JP2023573147A JP7464331B1 JP 7464331 B1 JP7464331 B1 JP 7464331B1 JP 2023573147 A JP2023573147 A JP 2023573147A JP 2023573147 A JP2023573147 A JP 2023573147A JP 7464331 B1 JP7464331 B1 JP 7464331B1
- Authority
- JP
- Japan
- Prior art keywords
- speed
- transport vehicle
- distance
- travel
- vehicle
- 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
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/20—Control system inputs
- G05D1/24—Arrangements for determining position or orientation
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/20—Control system inputs
- G05D1/24—Arrangements for determining position or orientation
- G05D1/244—Arrangements for determining position or orientation using passive navigation aids external to the vehicle, e.g. markers, reflectors or magnetic means
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/40—Control within particular dimensions
- G05D1/43—Control of position or course in two dimensions
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/60—Intended control result
- G05D1/646—Following a predefined trajectory, e.g. a line marked on the floor or a flight path
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/60—Intended control result
- G05D1/65—Following a desired speed profile
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/60—Intended control result
- G05D1/656—Interaction with payloads or external entities
- G05D1/667—Delivering or retrieving payloads
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
Description
前記軌道ラインの延在方向における搬送車の現在位置と目的位置との差分の距離に基づいて、前記搬送車の走行速度を制御する走行制御処理、を実行する制御部を備え、
前記走行制御処理は、前記距離が特定の第1数値以上である場合には一定の第1速度となるように制御し、
前記距離が特定の第1数値未満で、特定の第2数値以上である場合には、前記距離と前記速度の関係が予め定めた2次関数の式を満たす第2速度となるように、前記距離の減少に応じて徐々に減速制御し、
前記距離が第2の特定値未満である場合には、第1速度よりも小さい一定の第3速度となるように前記搬送車の速度を制御する走行制御システムが提供される。
前記搬送車の制御部が、
前記軌道ラインの延在方向における搬送車の現在位置と目的位置との差分の距離に基づいて、前記搬送車の走行速度を制御する走行制御処理、を実行し、
前記走行制御処理は、前記距離が特定の第1数値以上である場合には一定の第1速度となるように制御し、
前記距離が特定の第1数値未満で、特定の第2数値以上である場合には、前記距離と前記速度の関係が予め定めた2次関数の式を満たす第2速度となるように、前記距離の減少に応じて徐々に減速制御し、
前記距離が第2の特定値未満である場合には、第1速度よりも小さい一定の第3速度となるように前記搬送車の速度を制御する、走行制御方法が提供される。
次に、本実施形態の搬送システムの構成を説明する。図8は、本実施形態に係る搬送システムの全体構成図の一例を示す図である。搬送システム1000は、複数の搬送車(10a, 10b)、搬送物である台車2000、搬送車の状態を表示又は搬送車へ指令を入力可能な操縦機3000、搬送車の運行に必要な情報を管理する統括制御装置4000、統括制御装置の情報を表示し統括制御装置に情報を入力する入出力装置5000、複数の搬送車(10a, 10b)と操縦機3000と統括制御装置4000を通信可能に接続する通信ネットワーク6000を備える。
図10を用いて搬送車の有する機能を説明する。図10は本実施形態に係る搬送車の機能構成図を示す図である。搬送車10は、搬送車外部の台車2000や通信ネットワーク6000と通信を行う通信部210と、記録部220(記憶部を含む)、後述する各種センサを備えた検出部230、台車と連結するための連結部11、車輪を駆動させる車輪駆動部280、入力部240、表示部250、車輪駆動部280などの動作を制御する制御部260、を備えている。
vx = sign(x) * max(Vmin, min(k * x^2, Vmax)) [A]
式[A]に含まれる記号は、以下の通りとすることができる。
min(a,b) : a, b の内小さい値を採用する
max(a,b) : a, b の内大きい値を採用する
sign(x) : xの符号を指す。ロボットが目的位置(ゴール)を超過している場合 sign(x) = -1, 目的位置の手前に位置する場合 sign(x) = +1
Vmin : 速度の最小値
Vmax : 速度の最大値
k : 定数
v = sqrt(2*k*d) [B]
(項目1)
軌道ラインに沿って移動可能な搬送車の走行制御システムであって、
前記軌道ラインの延在方向における搬送車の現在位置と目的位置との差分の距離に基づいて、前記搬送車の走行速度を制御する走行制御処理と、を実行する制御部を備え、
前記走行制御処理は、前記距離が特定の第1数値以上である場合には一定の第1速度となるように制御し、
前記距離が特定の第1数値未満で、特定の第2数値以上である場合には、前記距離と前記速度の関係が予め定めた2次関数の式を満たす第2速度となるように、前記距離の減少に応じて徐々に減速制御し、
前記距離が第2の特定値未満である場合には、第1速度よりも小さい一定の第3速度となるように前記搬送車の速度を制御する、走行制御システム。
(項目2)
前記搬送車が前記目的位置に向けて前進する際に、前記距離に基づいて前記走行制御処理を実行するとともに、
前記搬送車が目的位置を通り過ぎた場合には、前記距離に基づいて後退方向に前記走行制御処理を実行する、項目1に記載の走行制御システム。
(項目3)
前記搬送車に設けたセンサからの情報に基づいて、前記軌道ラインの延在方向に対する前記搬送車の角度を推定する角度推定処理と、
前記搬送車に設けたセンサからの情報に基づいて、前記軌道ラインの延在方向に垂直な方向における前記軌道ラインと前記搬送車との相対位置を推定する相対位置推定処理と、
前記搬送車の角度及び前記相対位置に基づいて、前記搬送車の向きを制御する、項目1又は2に記載の走行制御システム。
(項目4)
前記制御部は、式[A]を満たように、前記走行制御処理を実行する、項目1又は2に記載の走行制御システム。
vx = sign(x) * max(Vmin, min(k * x^2, Vmax)) [A]
min(a,b) : a, b の内小さい方をとる
max(a,b) : a, b の内大きい方をとる
sign(x) : xの符号を指す。ロボットが目的位置(ゴール)を超過している場合 sign(x) = -1, 目的位置の手前に位置する場合 sign(x) = +1
Vmin : 速度の最小値
Vmax : 速度の最大値
k : 定数
(項目5)
前記制御部は、距離推定処理において、位置推定部から取得する前記現在位置と、記憶部から取得する前記目的位置との差分に基づいて、前記距離を算出する、項目1又は2に記載の走行制御システム。
(項目6)
前記制御部は、前記搬送車の速度センサで取得する速度情報に基づいて、前記走行制御処理を実行する、項目1又は2に記載の走行制御システム。
(項目7)
前記制御部は、予め定められる一定期間ごとに、前記距離推定処理を実行する、項目5に記載の走行制御システム。
(項目8)
路面に設置された2次元コードをスキャンすることにより、前記現在位置を取得する、項目1又は2に記載の走行制御システム。
(項目9)
軌道ラインに沿って移動可能な搬送車の走行制御方法であって、
前記搬送車の制御部が、
前記軌道ラインの延在方向における搬送車の現在位置と目的位置との差分の距離に基づいて、前記搬送車の走行速度を制御する走行制御処理と、を実行し、
前記走行制御処理は、前記距離が特定の第1数値以上である場合には一定の第1速度となるように制御し、
前記距離が特定の第1数値未満で、特定の第2数値以上である場合には、前記距離と前記速度の関係が予め定めた2次関数の式を満たす第2速度となるように、前記距離の減少に応じて徐々に減速制御し、
前記距離が第2の特定値未満である場合には、第1速度よりも小さい一定の第3速度となるように前記搬送車の速度を制御する、走行制御方法。
Claims (8)
- 軌道ラインに沿って移動可能な搬送車の走行制御システムであって、
前記軌道ラインの延在方向における搬送車の現在位置と目的位置との差分の距離xに基づいて、前記搬送車の前記軌道ラインの延在方向における走行速度vxを制御する走行制御処理、を実行する制御部を備え、
前記走行制御処理は、前記距離xが特定の第1数値以上である場合には前記走行速度vxが一定の第1速度となるように制御し、
前記距離xが特定の第1数値未満で、特定の第2数値以上である場合には、前記距離xと前記走行速度vxの関係が予め定めた2次関数の式を満たす第2速度となるように、前記距離xの減少に応じて徐々に減速制御し、
前記距離xが前記特定の第2数値未満である場合には、前記走行速度vxが第1速度よりも小さい一定の第3速度となるように前記搬送車の走行速度vxを制御し、
前記制御部は、式[A]を満たように、前記走行制御処理を実行する、走行制御システム。
vx = sign(x) * max(Vmin, min(k * x^2, Vmax)) [A]
min(a,b) : a, b の内小さい値を採用する
max(a,b) : a, b の内大きい値を採用する
sign(x) : xの符号を指す。ロボットが目的位置(ゴール)を超過している場合 sign(x) = -1, 目的位置の手前に位置する場合 sign(x) = +1
Vmin : 前記第3速度
Vmax : 前記第1速度
k : 定数 - 前記搬送車が前記目的位置に向けて前進する際に、前記距離xに基づいて前記走行制御処理を実行するとともに、
前記搬送車が目的位置を通り過ぎた場合には、前記距離xに基づいて後退方向に前記走行制御処理を実行する、請求項1に記載の走行制御システム。 - 前記搬送車に設けたセンサからの情報に基づいて、前記軌道ラインの延在方向に対する前記搬送車の角度を推定する角度推定処理と、
前記搬送車に設けたセンサからの情報に基づいて、前記軌道ラインの延在方向に垂直な方向における前記軌道ラインと前記搬送車との相対位置を推定する相対位置推定処理と、
前記搬送車の角度及び前記相対位置に基づいて、前記搬送車の向きを制御する、請求項1又は2に記載の走行制御システム。 - 前記制御部は、距離推定処理において、位置推定部から取得する前記現在位置と、記憶部から取得する前記目的位置との差分に基づいて、前記距離xを算出する、請求項1又は2に記載の走行制御システム。
- 前記制御部は、前記搬送車の速度センサで取得する速度情報に基づいて、前記走行制御処理を実行する、請求項1又は2に記載の走行制御システム。
- 前記制御部は、予め定められる一定期間ごとに、前記距離xの推定処理を実行する、請求項1または2に記載の走行制御システム。
- 路面に設置された2次元コードをスキャンすることにより、前記現在位置を取得する、請求項1又は2に記載の走行制御システム。
- 軌道ラインに沿って移動可能な搬送車の走行制御方法であって、
前記搬送車の制御部が、
前記軌道ラインの延在方向における搬送車の現在位置と目的位置との差分の距離xに基づいて、前記搬送車の前記軌道ラインの延在方向における走行速度vxを制御する走行制御処理と、を実行し、
前記走行制御処理は、前記距離xが特定の第1数値以上である場合には前記走行速度vxが一定の第1速度となるように制御し、
前記距離xが特定の第1数値未満で、特定の第2数値以上である場合には、前記距離と前記走行速度vxの関係が予め定めた2次関数の式を満たす第2速度となるように、前記距離xの減少に応じて徐々に減速制御し、
前記距離xが前記特定の第2数値未満である場合には、前記走行速度vxが第1速度よりも小さい一定の第3速度となるように前記搬送車の走行速度vxを制御し、
前記制御部は、式[A]を満たように、前記走行制御処理を実行する、走行制御方法。
vx = sign(x) * max(Vmin, min(k * x^2, Vmax)) [A]
min(a,b) : a, b の内小さい値を採用する
max(a,b) : a, b の内大きい値を採用する
sign(x) : xの符号を指す。ロボットが目的位置(ゴール)を超過している場合 sign(x) = -1, 目的位置の手前に位置する場合 sign(x) = +1
Vmin : 前記第3速度
Vmax : 前記第1速度
k : 定数
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2024044635A JP2025054160A (ja) | 2023-09-25 | 2024-03-21 | 搬送車の走行制御システム及び搬送車の走行制御方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| PCT/JP2023/034663 WO2025069130A1 (ja) | 2023-09-25 | 2023-09-25 | 搬送車の走行制御システム及び搬送車の走行制御方法 |
Related Child Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2024044635A Division JP2025054160A (ja) | 2023-09-25 | 2024-03-21 | 搬送車の走行制御システム及び搬送車の走行制御方法 |
Publications (3)
| Publication Number | Publication Date |
|---|---|
| JP7464331B1 true JP7464331B1 (ja) | 2024-04-09 |
| JPWO2025069130A1 JPWO2025069130A1 (ja) | 2025-04-03 |
| JPWO2025069130A5 JPWO2025069130A5 (ja) | 2025-09-03 |
Family
ID=90606799
Family Applications (2)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2023573147A Active JP7464331B1 (ja) | 2023-09-25 | 2023-09-25 | 搬送車の走行制御システム及び搬送車の走行制御方法 |
| JP2024044635A Pending JP2025054160A (ja) | 2023-09-25 | 2024-03-21 | 搬送車の走行制御システム及び搬送車の走行制御方法 |
Family Applications After (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2024044635A Pending JP2025054160A (ja) | 2023-09-25 | 2024-03-21 | 搬送車の走行制御システム及び搬送車の走行制御方法 |
Country Status (2)
| Country | Link |
|---|---|
| JP (2) | JP7464331B1 (ja) |
| WO (1) | WO2025069130A1 (ja) |
Citations (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS63241612A (ja) * | 1987-03-30 | 1988-10-06 | Hitachi Ltd | 移動体の走行制御方法 |
| JPH08202446A (ja) * | 1995-01-25 | 1996-08-09 | Toyota Autom Loom Works Ltd | 移動体の停止制御方法及び停止制御装置 |
| JPH10124144A (ja) * | 1996-09-02 | 1998-05-15 | Fuji Electric Co Ltd | 車両走行誘導装置および誘導テープセンサ |
| JP2022107500A (ja) * | 2021-01-08 | 2022-07-21 | 株式会社LexxPluss | 搬送システム、及び搬送制御方法 |
-
2023
- 2023-09-25 WO PCT/JP2023/034663 patent/WO2025069130A1/ja active Pending
- 2023-09-25 JP JP2023573147A patent/JP7464331B1/ja active Active
-
2024
- 2024-03-21 JP JP2024044635A patent/JP2025054160A/ja active Pending
Patent Citations (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS63241612A (ja) * | 1987-03-30 | 1988-10-06 | Hitachi Ltd | 移動体の走行制御方法 |
| JPH08202446A (ja) * | 1995-01-25 | 1996-08-09 | Toyota Autom Loom Works Ltd | 移動体の停止制御方法及び停止制御装置 |
| JPH10124144A (ja) * | 1996-09-02 | 1998-05-15 | Fuji Electric Co Ltd | 車両走行誘導装置および誘導テープセンサ |
| JP2022107500A (ja) * | 2021-01-08 | 2022-07-21 | 株式会社LexxPluss | 搬送システム、及び搬送制御方法 |
Also Published As
| Publication number | Publication date |
|---|---|
| JPWO2025069130A1 (ja) | 2025-04-03 |
| WO2025069130A1 (ja) | 2025-04-03 |
| JP2025054160A (ja) | 2025-04-07 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP7112803B1 (ja) | 搬送システム、及び搬送制御方法 | |
| JP7522516B1 (ja) | 搬送車の走行制御システム及び搬送車の走行制御方法 | |
| JP7464331B1 (ja) | 搬送車の走行制御システム及び搬送車の走行制御方法 | |
| JP7301409B2 (ja) | 搬送システム、及び搬送制御方法 | |
| JP7590802B1 (ja) | 搬送車の走行制御システム及び搬送車の走行制御方法 | |
| JP7659862B1 (ja) | 移動体の経路生成システム、経路生成方法、及びプログラム | |
| JP7540815B1 (ja) | 移動体の経路生成システム、経路生成方法、及びプログラム | |
| JP7575837B1 (ja) | 搬送車の制御システム及び搬送車の制御方法 | |
| JP7670406B1 (ja) | 走行制御システム、走行制御方法及びプログラム | |
| JP7669090B1 (ja) | 情報処理システム、情報処理方法、及びプログラム | |
| JP7645599B1 (ja) | 走行制御システム、走行制御方法及びプログラム | |
| JP7536377B1 (ja) | 連結装置 | |
| JP7676079B1 (ja) | 連結装置 | |
| JP7575836B1 (ja) | 搬送装置 | |
| JP7513338B2 (ja) | 搬送システム、及び搬送制御方法 | |
| WO2025262886A1 (ja) | 搬送車の制御システム及び搬送車の制御方法 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20231127 |
|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20231127 |
|
| A871 | Explanation of circumstances concerning accelerated examination |
Free format text: JAPANESE INTERMEDIATE CODE: A871 Effective date: 20240119 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20240208 |
|
| A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20240228 |
|
| 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: 20240314 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20240321 |
|
| R150 | Certificate of patent or registration of utility model |
Ref document number: 7464331 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |