JP5473628B2 - Convoy travel system, convoy travel method, trailing manned vehicle controller, steering control method, program, and recording medium - Google Patents

Convoy travel system, convoy travel method, trailing manned vehicle controller, steering control method, program, and recording medium Download PDF

Info

Publication number
JP5473628B2
JP5473628B2 JP2010011995A JP2010011995A JP5473628B2 JP 5473628 B2 JP5473628 B2 JP 5473628B2 JP 2010011995 A JP2010011995 A JP 2010011995A JP 2010011995 A JP2010011995 A JP 2010011995A JP 5473628 B2 JP5473628 B2 JP 5473628B2
Authority
JP
Japan
Prior art keywords
data
vehicle
unit
unmanned vehicle
leading unmanned
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
Application number
JP2010011995A
Other languages
Japanese (ja)
Other versions
JP2011150580A (en
Inventor
直人 川内
拓志 佐藤
雅人 宅原
圭一 見持
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Mitsubishi Heavy Industries Ltd
Original Assignee
Mitsubishi Heavy Industries 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 Mitsubishi Heavy Industries Ltd filed Critical Mitsubishi Heavy Industries Ltd
Priority to JP2010011995A priority Critical patent/JP5473628B2/en
Publication of JP2011150580A publication Critical patent/JP2011150580A/en
Application granted granted Critical
Publication of JP5473628B2 publication Critical patent/JP5473628B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
  • Regulating Braking Force (AREA)
  • Traffic Control Systems (AREA)

Description

本発明は、隊列走行システム、隊列走行方法、後続有人車両コントローラ、操縦制御方法、プログラム及び記録媒体に関する。特に本発明は、複数の車両を隊列走行させる隊列走行システム、隊列走行方法、隊列の後続の車両のうち人が乗車する後続有人車両に搭載されて、後続有人車両の操縦を制御する後続有人車両コントローラ、後続有人車両の操縦を制御する操縦制御方法、当該隊列走行システム及び後続有人車両コントローラ用のプログラム、並びに当該プログラムを記録した記録媒体に関する。 The present invention relates to a convoy travel system, a convoy travel method, a subsequent manned vehicle controller, a steering control method, a program, and a recording medium . In particular, the present invention relates to a row running system for running a plurality of vehicles in a row, a row running method, and a subsequent manned vehicle that is mounted on a subsequent manned vehicle on which a person rides , and controls the operation of the subsequent manned vehicle. The present invention relates to a controller, an operation control method for controlling operation of a subsequent manned vehicle, a program for the platooning system and the subsequent manned vehicle controller, and a recording medium on which the program is recorded .

大量の物資を輸送するような状況では、物資を複数の車両に分けて搭載し、これら各車両に隊列走行させることがある。その場合、各車両には、その車両を運転する運転手が乗車しなければならず、効率的でない。このような問題を解決するための手段としては、省人化を目的とする様々な隊列走行システムが提案されている。   In a situation where a large amount of goods is transported, the goods may be divided into a plurality of vehicles and mounted on each vehicle. In that case, each vehicle has to be ridden by a driver who drives the vehicle, which is not efficient. As means for solving such problems, various platooning systems for the purpose of labor saving have been proposed.

省人化を目的とする隊列走行システムとしては、例えば、運転手が運転している先導車両に自動追従させるべく、人が乗車しない複数の後続車両を縦列走行させる方法が知られている(例えば、特許文献1参照。)。この隊列走行システムは、先導車両にのみ運転手が乗車すればよいので、大幅な省人化を実現しているといえる。   As a platooning system for the purpose of labor saving, for example, a method is known in which a plurality of succeeding vehicles that are not ridden by people are cascaded so as to automatically follow a leading vehicle driven by a driver (for example, , See Patent Document 1). This platooning system can be said to realize significant labor saving because the driver only has to get on the leading vehicle.

また、省人化を目的とする別の隊列走行システムとしては、隊列を組む全ての車両に運転手が乗車せずに、各車両が予め登録された経路に沿って走行するといった方法も提案されている。   In addition, as another platooning system for the purpose of labor saving, there is also proposed a method in which each vehicle travels along a pre-registered route without a driver getting on all the vehicles forming the platoon. ing.

特開2008−207729号公報JP 2008-207729 A

引用文献1に記載の隊列走行システムによると、運転手は、先導車両に乗車する。しかしながら、災害発生地域等において隊列走行するような状況では、走行経路に障害物や危険物が存在することもあり、隊列を組んでいる複数の車両のうち先導車両の危険度が最も高くなってしまう。   According to the row running system described in the cited document 1, the driver gets on the leading vehicle. However, in situations where platooning is performed in disaster-affected areas, obstacles and dangerous objects may exist on the travel route, and the leading vehicle has the highest degree of risk among the multiple vehicles in the platoon. End up.

一方、全ての車両に運転手が乗車しない隊列走行システムは、整備された既知の経路を走行することを前提としている。そのため、このような無人の隊列走行システムは、未知の経路や、障害物や危険物が存在するような経路を走行するような状況には向かない。   On the other hand, a convoy travel system in which no driver rides on all vehicles is premised on traveling on a well-known route. Therefore, such an unmanned platooning system is not suitable for a situation where the vehicle travels on an unknown route or a route on which obstacles or dangerous objects exist.

上記課題を解決するために、本発明の第1の形態によると、複数の車両を隊列走行させる隊列走行システムであって、人が乗車しない隊列の先頭無人車両に搭載されて、先頭無人車両の操縦を制御する先頭無人車両コントローラと、隊列の後続の車両のうち人が乗車する後続有人車両に搭載されて、後続有人車両の操縦を制御する後続有人車両コントローラとを備え、先頭無人車両コントローラは、先頭無人車両に設けられた撮影手段によって撮影された映像を示すデータを後続有人車両コントローラに送信する映像データ送信部と、先頭無人車両の操縦を制御するためのデータを後続有人車両コントローラから受信する制御データ受信部と、制御データ受信部が受信したデータに基づいて、先頭無人車両の操縦を制御する操縦制御部と、操縦制御部が制御したことによって走行した先頭無人車両の走行軌跡を示すデータを後続有人車両コントローラに送信する走行軌跡データ送信部とを有し、後続有人車両コントローラは、映像を示すデータを先頭無人車両コントローラから受信する映像データ受信部と、映像データ受信部が受信したデータを、後続有人車両に設けられた表示手段に出力する映像データ出力部と、先頭無人車両の操縦を制御するためのデータの入力を、後続有人車両に設けられた操縦手段から受け付ける制御データ入力受付部と、制御データ入力受付部が入力を受け付けたデータを先頭無人車両コントローラに送信する制御データ送信部と、制御データ入力受付部が入力を受け付けたデータに基づいて、先頭無人車両が走行すべき経路を算出する経路算出部と、走行軌跡を示すデータを先頭無人車両コントローラから受信する走行軌跡データ受信部と、経路算出部が算出した経路と、走行軌跡データ受信部が受信したデータによって示される先頭無人車両の走行軌跡とを比較し、その誤差が所定の閾値を超えたか否かを判定する誤差判定部と、走行軌跡データ受信部が受信したデータによって示される走行軌跡に沿って後続有人車両を走行させるべく、後続有人車両の操縦を制御すると共に、誤差が所定の閾値を超えたと誤差判定部が判定した場合、後続有人車両を停止させるべく、後続有人車両の操縦を制御する操縦制御部とを有する。 In order to solve the above-described problem, according to the first aspect of the present invention, there is a row running system for running a plurality of vehicles, which is mounted on a leading unmanned vehicle in a row where a person does not get on the vehicle. A leading unmanned vehicle controller for controlling the maneuvering and a succeeding manned vehicle controller for controlling the maneuvering of the succeeding manned vehicle mounted on the succeeding manned vehicle on which a person rides among the following vehicles in the formation, A video data transmitting unit for transmitting data indicating video captured by the imaging means provided in the leading unmanned vehicle to the subsequent manned vehicle controller, and receiving data for controlling the operation of the leading unmanned vehicle from the subsequent unmanned vehicle controller a control data receiving unit that, the steering control unit based on the data control data receiving unit receives, controls the steering of the leading unmanned vehicle, Misao And a traveling locus data transmitter for transmitting data indicating the traveling locus of the leading unmanned vehicle travels by the control unit is controlled in subsequent manned vehicle controller, subsequent manned vehicle controller, leading unmanned vehicle data indicating an image A video data receiving unit received from the controller, a video data output unit for outputting the data received by the video data receiving unit to a display means provided in a subsequent manned vehicle, and data for controlling the operation of the leading unmanned vehicle A control data input accepting unit that accepts input from a steering means provided in a subsequent manned vehicle, a control data sending unit that sends data received by the control data input accepting unit to a leading unmanned vehicle controller, and a control data input accepting A route calculation unit that calculates a route on which the leading unmanned vehicle should travel based on data received by the unit; Comparing the travel locus data receiving unit that receives data indicating the trajectory from the leading unmanned vehicle controller, the route calculated by the route calculating unit, and the traveling locus of the leading unmanned vehicle indicated by the data received by the traveling locus data receiving unit And an error determination unit that determines whether or not the error exceeds a predetermined threshold, and the subsequent manned vehicle to travel along the traveling locus indicated by the data received by the traveling locus data receiving unit. The control unit controls the maneuvering and controls the maneuvering of the subsequent manned vehicle to stop the manned vehicle when the error determining unit determines that the error exceeds a predetermined threshold .

先頭無人車両コントローラは、先頭無人車両が走行すべき経路を示す情報を格納する経路情報格納部更に有し、先頭無人車両コントローラの操縦制御部は、経路情報格納部が格納している情報によって示される経路に沿って先頭無人車両を走行させるべく、先頭無人車両の操縦を制御すると共に、制御データ受信部が受信したデータに基づいて、先頭無人車両の操縦を割り込み制御してもよい。The leading unmanned vehicle controller further includes a route information storage unit that stores information indicating a route on which the leading unmanned vehicle should travel, and the steering control unit of the leading unmanned vehicle controller is indicated by information stored in the route information storage unit. In order to drive the leading unmanned vehicle along the route, the control of the leading unmanned vehicle may be controlled, and the controlling of the leading unmanned vehicle may be interrupted based on the data received by the control data receiving unit.

先頭無人車両コントローラの操縦制御部は、制御データ受信部がデータを受信することができなくなった場合、先頭無人車両を停止させるべく、先頭無人車両の操縦を制御してもよい。The steering control unit of the leading unmanned vehicle controller may control the leading unmanned vehicle to stop the leading unmanned vehicle when the control data receiving unit cannot receive data.

後続有人車両コントローラの操縦制御部は、走行軌跡データ受信部がデータを受信することができなくなった場合、後続有人車両を停止させるべく、後続有人車両の操縦を制御してもよい。The steering control unit of the succeeding manned vehicle controller may control the maneuvering of the succeeding manned vehicle so as to stop the succeeding manned vehicle when the travel locus data receiving unit cannot receive the data.

後続有人車両コントローラの制御データ入力受付部は、先頭無人車両の操縦を制御するためのデータとして、ジョイスティックのレバーの操作方向とその操作量を含む情報を含むデータの入力を受け付けてもよい。The control data input acceptance unit of the subsequent manned vehicle controller may accept input of data including information including the operation direction and the operation amount of the lever of the joystick as data for controlling the operation of the leading unmanned vehicle.

後続有人車両コントローラの制御データ入力受付部は、先頭無人車両の操縦を制御するためのデータとして、押下操作されたジョイスティックのボタンを識別する情報を含むデータの入力を受け付けてもよい。The control data input accepting unit of the subsequent manned vehicle controller may accept input of data including information for identifying the pressed joystick button as data for controlling the operation of the leading unmanned vehicle.

先頭無人車両コントローラの操縦制御部は、先頭無人車両の操縦を制御するにあたり、制御データ受信部が受信したデータによって示される情報に従って、ステアリングアクチュエータの動作を制御してもよい。The steering control unit of the leading unmanned vehicle controller may control the operation of the steering actuator according to the information indicated by the data received by the control data receiving unit when controlling the steering of the leading unmanned vehicle.

本発明の第の形態によると、複数の車両を隊列走行させる隊列走行方法であって、人が乗車しない隊列の先頭無人車両に搭載されて、先頭無人車両の操縦を制御する先頭無人車両コントローラが、先頭無人車両に設けられた撮影手段によって撮影された映像を示すデータを、隊列の後続の車両のうち人が乗車する後続有人車両に搭載されて、後続有人車両の操縦を制御する後続有人車両コントローラに送信する映像データ送信段階と、後続有人車両コントローラが、映像を示すデータを先頭無人車両コントローラから受信する映像データ受信段階と、後続有人車両コントローラが、映像データ受信段階において受信されたデータを、後続有人車両に設けられた表示手段に出力する映像データ出力段階と、後続有人車両コントローラが、先頭無人車両の操縦を制御するためのデータの入力を、後続有人車両に設けられた操縦手段から受け付ける制御データ入力受付段階と、後続有人車両コントローラが、制御データ入力受付段階において入力が受け付けられたデータに基づいて、先頭無人車両が走行すべき経路を算出する経路算出段階と、後続有人車両コントローラが、制御データ入力受付段階において入力が受け付けられたデータを先頭無人車両コントローラに送信する制御データ送信段階と、先頭無人車両コントローラが、先頭無人車両の操縦を制御するためのデータを後続有人車両コントローラから受信する制御データ受信段階と、先頭無人車両コントローラが、制御データ受信段階において受信されたデータに基づいて、先頭無人車両の操縦を制御する操縦制御段階と、先頭無人車両コントローラが、操縦制御段階において制御されたことによって走行した先頭無人車両の走行軌跡を示すデータを後続有人車両コントローラに送信する走行軌跡データ送信段階と、後続有人車両コントローラが、走行軌跡を示すデータを先頭無人車両コントローラから受信する走行軌跡データ受信段階と、後続有人車両コントローラが、経路算出段階において算出された経路と、走行軌跡データ受信段階において受信されたデータによって示される先頭無人車両の走行軌跡とを比較し、その誤差が所定の閾値を超えたか否かを判定する誤差判定段階と、後続有人車両コントローラが、走行軌跡データ受信段階において受信されたデータによって示される走行軌跡に沿って後続有人車両を走行させるべく、後続有人車両の操縦を制御すると共に、誤差が所定の閾値を超えたと誤差判定段階において判定された場合、後続有人車両を停止させるべく、後続有人車両の操縦を制御する操縦制御段階とを含む。 According to the second aspect of the present invention , there is a row running method for running a plurality of vehicles in a row, and the head unmanned vehicle controller is mounted on the leading unmanned vehicle in the row where no person is on board and controls the operation of the leading unmanned vehicle. Is a succeeding manned that controls the maneuvering of the succeeding manned vehicle by installing the data indicating the image photographed by the photographing means provided in the leading unmanned vehicle on the succeeding manned vehicle on which the person gets on among the following vehicles in the formation Video data transmission stage to be transmitted to the vehicle controller, video data reception stage in which the subsequent manned vehicle controller receives data indicating the video from the first unmanned vehicle controller, and data received by the subsequent manned vehicle controller in the video data reception stage Is output to the display means provided in the succeeding manned vehicle, and the succeeding manned vehicle controller is Control data input reception stage for receiving input of data for controlling the maneuvering of the manned vehicle from the steering means provided in the subsequent manned vehicle, and data for which the subsequent manned vehicle controller has received an input in the control data input receiving stage. A route calculation stage for calculating a route on which the leading unmanned vehicle should travel, and a control data transmission stage in which the subsequent manned vehicle controller transmits data received in the control data input acceptance stage to the leading unmanned vehicle controller. And a control data receiving stage in which the leading unmanned vehicle controller receives data for controlling the operation of the leading unmanned vehicle from the subsequent manned vehicle controller, and the leading unmanned vehicle controller is based on the data received in the control data receiving stage. Control control stage to control the operation of the first unmanned vehicle, The unmanned vehicle controller transmits data indicating the traveling locus of the first unmanned vehicle that has traveled as a result of being controlled in the steering control stage to the subsequent manned vehicle controller, and the subsequent manned vehicle controller indicates the traveling locus. A travel locus data receiving stage for receiving data from the leading unmanned vehicle controller, a route of the leading unmanned vehicle indicated by the route calculated by the subsequent manned vehicle controller in the route calculating stage, and the data received in the traveling locus data receiving stage. An error determination stage that compares the trajectory and determines whether the error exceeds a predetermined threshold, and a subsequent manned vehicle controller follows the travel trajectory indicated by the data received in the travel trajectory data reception stage. Control the maneuvering of subsequent manned vehicles to drive manned vehicles And an operation control step for controlling the operation of the succeeding manned vehicle to stop the succeeding manned vehicle when it is determined in the error determining step that the error exceeds a predetermined threshold.

本発明の第の形態によると、複数の車両を隊列走行させる隊列走行システムにおいて、人が乗車しない隊列の先頭無人車両に搭載されて、先頭無人車両の操縦を制御する先頭無人車両コントローラとして第1のコンピュータを機能させ、隊列の後続の車両のうち人が乗車する後続有人車両に搭載されて、後続有人車両の操縦を制御する後続有人車両コントローラとして第2のコンピュータを機能させるプログラムであって、第1のコンピュータを、先頭無人車両に設けられた撮影手段によって撮影された映像を示すデータを、後続有人車両コントローラに送信する映像データ送信部、先頭無人車両の操縦を制御するためのデータを後続有人車両コントローラから受信する制御データ受信部、制御データ受信部が受信したデータに基づいて、先頭無人車両の操縦を制御する操縦制御部、操縦制御部が制御したことによって走行した先頭無人車両の走行軌跡を示すデータを後続有人車両コントローラに送信する走行軌跡データ送信部として機能させ、第2のコンピュータを、映像を示すデータを先頭無人車両コントローラから受信する映像データ受信部、映像データ受信部が受信したデータを、後続有人車両に設けられた表示手段に出力する映像データ出力部、先頭無人車両の操縦を制御するためのデータの入力を、後続有人車両に設けられた操縦手段から受け付ける制御データ入力受付部、制御データ入力受付部が入力を受け付けたデータを先頭無人車両コントローラに送信する制御データ送信部、制御データ入力受付部が入力を受け付けたデータに基づいて、先頭無人車両が走行すべき経路を算出する経路算出部、走行軌跡を示すデータを先頭無人車両コントローラから受信する走行軌跡データ受信部、経路算出部が算出した経路と、走行軌跡データ受信部が受信したデータによって示される先頭無人車両の走行軌跡とを比較し、その誤差が所定の閾値を超えたか否かを判定する誤差判定部、走行軌跡データ受信部が受信したデータによって示される走行軌跡に沿って後続有人車両を走行させるべく、後続有人車両の操縦を制御すると共に、誤差が所定の閾値を超えたと誤差判定部が判定した場合、後続有人車両を停止させるべく、後続有人車両の操縦を制御する操縦制御部として機能させる。 According to the third aspect of the present invention, in the row running system for running a plurality of vehicles in a row, the first unmanned vehicle controller is mounted on the first unmanned vehicle in the row where no person is on board and controls the operation of the first unmanned vehicle. A program for causing a second computer to function as a succeeding manned vehicle controller that controls one maneuvering computer and is mounted on a succeeding manned vehicle on which a person rides among the following vehicles in the formation. The first computer has a video data transmission unit for transmitting data indicating video captured by the imaging means provided in the leading unmanned vehicle to the subsequent manned vehicle controller, and data for controlling the operation of the leading unmanned vehicle. Based on the control data receiving unit received from the subsequent manned vehicle controller, the data received by the control data receiving unit, A steering control unit that controls the operation of the head unmanned vehicle, and a function that serves as a traveling locus data transmission unit that transmits data indicating a traveling locus of the leading unmanned vehicle that has traveled as controlled by the steering control unit to the subsequent manned vehicle controller, A video data receiving unit that receives data indicating video from the first unmanned vehicle controller, a video data output unit that outputs data received by the video data receiving unit to a display means provided in a subsequent manned vehicle, Control data input receiving unit that receives input of data for controlling the operation of the vehicle from the steering means provided in the subsequent manned vehicle, and control for transmitting the data received by the control data input receiving unit to the leading unmanned vehicle controller The first unmanned vehicle travels based on the data received by the data transmission unit and control data input reception unit A route calculation unit that calculates a power route, a travel locus data reception unit that receives data indicating a travel locus from the first unmanned vehicle controller, a route calculated by the route calculation unit, and a head indicated by data received by the travel locus data reception unit An error determination unit that compares the traveling locus of the unmanned vehicle and determines whether or not the error exceeds a predetermined threshold, and travels the subsequent manned vehicle along the traveling locus indicated by the data received by the traveling locus data receiving unit. In order to control the maneuvering of the succeeding manned vehicle, and when the error determining unit determines that the error exceeds a predetermined threshold, it functions as a maneuvering control unit that controls the maneuvering of the succeeding manned vehicle to stop the manned vehicle. Let

本発明の第の形態によると、複数の車両を隊列走行させる隊列走行システムにおいて、人が乗車しない隊列の先頭無人車両に搭載されて、先頭無人車両の操縦を制御する先頭無人車両コントローラとして第1のコンピュータを機能させ、隊列の後続の車両のうち人が乗車する後続有人車両に搭載されて、後続有人車両の操縦を制御する後続有人車両コントローラとして第2のコンピュータを機能させるプログラムを記録した記録媒体であって、第1のコンピュータを、先頭無人車両に設けられた撮影手段によって撮影された映像を示すデータを、後続有人車両コントローラに送信する映像データ送信部、先頭無人車両の操縦を制御するためのデータを後続有人車両コントローラから受信する制御データ受信部、制御データ受信部が受信したデータに基づいて、先頭無人車両の操縦を制御する操縦制御部、操縦制御部が制御したことによって走行した先頭無人車両の走行軌跡を示すデータを後続有人車両コントローラに送信する走行軌跡データ送信部として機能させ、第2のコンピュータを、映像を示すデータを先頭無人車両コントローラから受信する映像データ受信部、映像データ受信部が受信したデータを、後続有人車両に設けられた表示手段に出力する映像データ出力部、先頭無人車両の操縦を制御するためのデータの入力を、後続有人車両に設けられた操縦手段から受け付ける制御データ入力受付部、制御データ入力受付部が入力を受け付けたデータを先頭無人車両コントローラに送信する制御データ送信部、制御データ入力受付部が入力を受け付けたデータに基づいて、先頭無人車両が走行すべき経路を算出する経路算出部、走行軌跡を示すデータを先頭無人車両コントローラから受信する走行軌跡データ受信部、経路算出部が算出した経路と、走行軌跡データ受信部が受信したデータによって示される先頭無人車両の走行軌跡とを比較し、その誤差が所定の閾値を超えたか否かを判定する誤差判定部、走行軌跡データ受信部が受信したデータによって示される走行軌跡に沿って後続有人車両を走行させるべく、後続有人車両の操縦を制御すると共に、誤差が所定の閾値を超えたと誤差判定部が判定した場合、後続有人車両を停止させるべく、後続有人車両の操縦を制御する操縦制御部として機能させるプログラムを記録した。 According to the fourth aspect of the present invention, in a row running system for running a plurality of vehicles in a row, the first unmanned vehicle controller is mounted on the first unmanned vehicle of the row where no person is on board and controls the operation of the first unmanned vehicle. A program for operating the second computer as a subsequent manned vehicle controller that controls the operation of the subsequent manned vehicle mounted on the succeeding manned vehicle on which a person rides among the following vehicles in the formation is recorded. A video data transmission unit that is a recording medium and that transmits data indicating video captured by imaging means provided in the leading unmanned vehicle to the subsequent manned vehicle controller, and controls the operation of the leading unmanned vehicle Control data receiving unit for receiving data from the subsequent manned vehicle controller, received by the control data receiving unit A driving control unit for controlling the operation of the leading unmanned vehicle based on the data, and a traveling locus data transmitting unit for transmitting data indicating the traveling locus of the leading unmanned vehicle that has traveled as controlled by the steering control unit to the subsequent manned vehicle controller A video data receiving unit that receives data indicating video from the first unmanned vehicle controller, and a video that outputs data received by the video data receiving unit to display means provided in a subsequent manned vehicle Data output unit, control data input receiving unit for receiving data input for controlling the maneuvering of the first unmanned vehicle from the maneuvering means provided in the subsequent manned vehicle, and the data received by the control data input receiving unit for the first unmanned vehicle Based on the data received by the control data transmission unit and the control data input reception unit to be transmitted to the vehicle controller, A route calculation unit that calculates a route on which the unmanned unmanned vehicle should travel, a travel locus data reception unit that receives data indicating the travel locus from the first unmanned vehicle controller, a route that is calculated by the route calculation unit, and a travel locus data reception unit that receives the data. Compared with the traveling locus of the leading unmanned vehicle indicated by the data, an error determination unit that determines whether or not the error exceeds a predetermined threshold, along the traveling locus indicated by the data received by the traveling locus data receiving unit Control the subsequent manned vehicle to drive the subsequent manned vehicle, and control the operation of the subsequent manned vehicle to stop the subsequent manned vehicle when the error determination unit determines that the error exceeds a predetermined threshold. A program to function as a steering control unit was recorded.

本発明の第の形態によると、隊列の後続の車両のうち人が乗車する後続有人車両に搭載されて、後続有人車両の操縦を制御する後続有人車両コントローラであって、人が乗車しない隊列の先頭無人車両に設けられた撮影手段によって撮影された映像を示すデータを、先頭無人車両に搭載されて、先頭無人車両の操縦を制御する先頭無人車両コントローラから受信する映像データ受信部と、映像データ受信部が受信したデータを、後続有人車両に設けられた表示手段に出力する映像データ出力部と、先頭無人車両の操縦を制御するためのデータの入力を、後続有人車両に設けられた操縦手段から受け付ける制御データ入力受付部と、制御データ入力受付部が入力を受け付けたデータを先頭無人車両コントローラに送信する制御データ送信部と、制御データ入力受付部が入力を受け付けたデータに基づいて、先頭無人車両が走行すべき経路を算出する経路算出部と、先頭無人車両の走行軌跡を示すデータを先頭無人車両コントローラから受信する走行軌跡データ受信部と、経路算出部が算出した経路と、走行軌跡データ受信部が受信したデータによって示される先頭無人車両の走行軌跡とを比較し、その誤差が所定の閾値を超えたか否かを判定する誤差判定部と、走行軌跡データ受信部が受信したデータによって示される走行軌跡に沿って後続有人車両を走行させるべく、後続有人車両の操縦を制御すると共に、誤差が所定の閾値を超えたと誤差判定部が判定した場合、後続有人車両を停止させるべく、後続有人車両の操縦を制御する操縦制御部とを備える。 According to the fifth aspect of the present invention, a succeeding manned vehicle controller that is mounted on a succeeding manned vehicle on which a person rides among the following vehicles in the convoy, and controls the maneuvering of the succeeding manned vehicle, in which the person does not get on. A video data receiving unit for receiving data indicating a video imaged by a photographing unit provided in the first unmanned vehicle from a first unmanned vehicle controller mounted on the first unmanned vehicle and controlling the operation of the first unmanned vehicle; A video data output unit for outputting data received by the data receiving unit to a display means provided in the succeeding manned vehicle, and an input of data for controlling the maneuvering of the leading unmanned vehicle. A control data input receiving unit that receives from the means, and a control data transmitting unit that transmits data received by the control data input receiving unit to the leading unmanned vehicle controller; A route calculation unit that calculates a route on which the leading unmanned vehicle should travel based on data received by the control data input receiving unit, and a traveling locus that receives data indicating the traveling locus of the leading unmanned vehicle from the leading unmanned vehicle controller The data reception unit, the route calculated by the route calculation unit, and the traveling locus of the first unmanned vehicle indicated by the data received by the traveling locus data reception unit are compared, and it is determined whether or not the error exceeds a predetermined threshold. Control the subsequent manned vehicle to drive the succeeding manned vehicle along the travel locus indicated by the data received by the data received by the travel locus data receiving unit, and if the error exceeds a predetermined threshold, the error And a control unit that controls the operation of the subsequent manned vehicle to stop the subsequent manned vehicle when the determination unit determines.

本発明の第の形態によると、隊列の後続の車両のうち人が乗車する後続有人車両の操縦を制御する操縦制御方法であって、後続有人車両に搭載されて、後続有人車両の操縦を制御する後続有人車両コントローラが、人が乗車しない隊列の先頭無人車両に設けられた撮影手段によって撮影された映像を示すデータを、先頭無人車両に搭載されて、先頭無人車両の操縦を制御する先頭無人車両コントローラから受信する映像データ受信段階と、後続有人車両コントローラが、映像データ受信段階において受信されたデータを、後続有人車両に設けられた表示手段に出力する映像データ出力段階と、後続有人車両コントローラが、先頭無人車両の操縦を制御するためのデータの入力を、後続有人車両に設けられた操縦手段から受け付ける制御データ入力受付段階と、後続有人車両コントローラが、制御データ入力受付段階において入力が受け付けられたデータを先頭無人車両コントローラに送信する制御データ送信段階と、後続有人車両コントローラが、制御データ入力受付段階において入力が受け付けられたデータに基づいて、先頭無人車両が走行すべき経路を算出する経路算出段階と、後続有人車両コントローラが、先頭無人車両の走行軌跡を示すデータを先頭無人車両コントローラから受信する走行軌跡データ受信段階と、後続有人車両コントローラが、経路算出段階において算出された経路と、走行軌跡データ受信段階において受信されたデータによって示される先頭無人車両の走行軌跡とを比較し、その誤差が所定の閾値を超えたか否かを判定する誤差判定段階と、後続有人車両コントローラが、走行軌跡データ受信段階において受信されたデータによって示される走行軌跡に沿って後続有人車両を走行させるべく、後続有人車両の操縦を制御すると共に、誤差が所定の閾値を超えたと誤差判定段階において判定された場合、後続有人車両を停止させるべく、後続有人車両の操縦を制御する操縦制御段階とを含む。 According to a sixth aspect of the present invention, there is provided a steering control method for controlling the maneuvering of a succeeding manned vehicle on which a person rides among the following vehicles in the platoon, and the maneuvering of the succeeding manned vehicle is carried on the succeeding manned vehicle. The head of the following manned vehicle controller that controls the operation of the leading unmanned vehicle with the data indicating the video taken by the photographing means provided in the leading unmanned vehicle of the platoon where no person is on board in the leading unmanned vehicle A video data receiving stage for receiving from the unmanned vehicle controller, a video data output stage for the succeeding manned vehicle controller to output the data received in the video data receiving stage to a display means provided in the succeeding manned vehicle, and a subsequent manned vehicle Control data in which the controller receives data input for controlling the maneuvering of the first unmanned vehicle from the maneuvering means provided in the subsequent manned vehicle. An input reception stage, a control data transmission stage in which the subsequent manned vehicle controller transmits data received in the control data input reception stage to the leading unmanned vehicle controller, and a subsequent manned vehicle controller inputs in the control data input reception stage A route calculation stage for calculating a route on which the leading unmanned vehicle should travel based on the received data, and a traveling locus in which the subsequent manned vehicle controller receives data indicating the traveling locus of the leading unmanned vehicle from the leading unmanned vehicle controller. The data reception stage and the subsequent manned vehicle controller compare the route calculated in the route calculation stage with the traveling locus of the leading unmanned vehicle indicated by the data received in the traveling locus data reception stage, and the error is predetermined. Error determination stage for determining whether or not the threshold has been exceeded, and subsequent manned Both controllers control the maneuvering of the subsequent manned vehicle to travel along the travel locus indicated by the data received in the travel locus data receiving stage, and determine that the error exceeds a predetermined threshold. A steering control stage for controlling the steering of the succeeding manned vehicle to stop the succeeding manned vehicle if determined in the stage.

本発明の第の形態によると、隊列の後続の車両のうち人が乗車する後続有人車両に搭載されて、後続有人車両の操縦を制御する後続有人車両コントローラとしてコンピュータを機能させるプログラムであって、コンピュータを、人が乗車しない隊列の先頭無人車両に設けられた撮影手段によって撮影された映像を示すデータを、先頭無人車両に搭載されて、先頭無人車両の操縦を制御する先頭無人車両コントローラから受信する映像データ受信部、映像データ受信部が受信したデータを、後続有人車両に設けられた表示手段に出力する映像データ出力部、先頭無人車両の操縦を制御するためのデータの入力を、後続有人車両に設けられた操縦手段から受け付ける制御データ入力受付部、制御データ入力受付部が入力を受け付けたデータを先頭無人車両コントローラに送信する制御データ送信部、制御データ入力受付部が入力を受け付けたデータに基づいて、先頭無人車両が走行すべき経路を算出する経路算出部、先頭無人車両の走行軌跡を示すデータを先頭無人車両コントローラから受信する走行軌跡データ受信部、経路算出部が算出した経路と、走行軌跡データ受信部が受信したデータによって示される先頭無人車両の走行軌跡とを比較し、その誤差が所定の閾値を超えたか否かを判定する誤差判定部、走行軌跡データ受信部が受信したデータによって示される走行軌跡に沿って後続有人車両を走行させるべく、後続有人車両の操縦を制御すると共に、誤差が所定の閾値を超えたと誤差判定部が判定した場合、後続有人車両を停止させるべく、後続有人車両の操縦を制御する操縦制御部として機能させる。 According to a seventh aspect of the present invention , there is provided a program for causing a computer to function as a subsequent manned vehicle controller that is mounted on a subsequent manned vehicle on which a person rides among the following vehicles in the formation and controls the maneuvering of the subsequent manned vehicle. The computer shows the data taken by the photographing means provided in the first unmanned vehicle of the platoon where the person does not get on, from the first unmanned vehicle controller that is mounted on the first unmanned vehicle and controls the operation of the first unmanned vehicle. Receiving video data receiving unit, video data output unit for outputting data received by video data receiving unit to display means provided in succeeding manned vehicle, input of data for controlling operation of leading unmanned vehicle, subsequent The control data input receiving unit that receives from the control means provided in the manned vehicle, the data that the control data input receiving unit receives the input A control data transmission unit that transmits to the unmanned vehicle controller, a route calculation unit that calculates a route on which the leading unmanned vehicle should travel based on data received by the control data input receiving unit, and data that indicates a traveling locus of the unmanned vehicle Is compared with the traveling locus of the leading unmanned vehicle indicated by the data received by the traveling locus data receiving unit, and the error is predetermined. An error determination unit that determines whether or not the threshold of the vehicle is exceeded, and controls the maneuvering of the succeeding manned vehicle to travel the manned vehicle along the traveling locus indicated by the data received by the traveling locus data receiving unit. When the error determination unit determines that the value exceeds a predetermined threshold, the operation for controlling the operation of the subsequent manned vehicle is stopped in order to stop the subsequent manned vehicle. To function as a control unit.

本発明の第の形態によると、隊列の後続の車両のうち人が乗車する後続有人車両に搭載されて、後続有人車両の操縦を制御する後続有人車両コントローラとしてコンピュータを機能させるプログラムを記録した記録媒体であって、コンピュータを、人が乗車しない隊列の先頭無人車両に設けられた撮影手段によって撮影された映像を示すデータを、先頭無人車両に搭載されて、先頭無人車両の操縦を制御する先頭無人車両コントローラから受信する映像データ受信部、映像データ受信部が受信したデータを、後続有人車両に設けられた表示手段に出力する映像データ出力部、先頭無人車両の操縦を制御するためのデータの入力を、後続有人車両に設けられた操縦手段から受け付ける制御データ入力受付部、制御データ入力受付部が入力を受け付けたデータを先頭無人車両コントローラに送信する制御データ送信部、制御データ入力受付部が入力を受け付けたデータに基づいて、先頭無人車両が走行すべき経路を算出する経路算出部、先頭無人車両の走行軌跡を示すデータを先頭無人車両コントローラから受信する走行軌跡データ受信部、経路算出部が算出した経路と、走行軌跡データ受信部が受信したデータによって示される先頭無人車両の走行軌跡とを比較し、その誤差が所定の閾値を超えたか否かを判定する誤差判定部、走行軌跡データ受信部が受信したデータによって示される走行軌跡に沿って後続有人車両を走行させるべく、後続有人車両の操縦を制御すると共に、誤差が所定の閾値を超えたと誤差判定部が判定した場合、後続有人車両を停止させるべく、後続有人車両の操縦を制御する操縦制御部として機能させるプログラムを記録した。 According to the eighth aspect of the present invention, a program is recorded that is mounted on a succeeding manned vehicle on which a person gets on among the following vehicles in the platoon and functions as a succeeding manned vehicle controller that controls the operation of the succeeding manned vehicle. A recording medium, which is mounted on a head unmanned vehicle and controls the operation of the head unmanned vehicle with data indicating a picture taken by a photographing means provided on a head unmanned vehicle in a row where a person does not get on a computer Video data receiving unit received from the head unmanned vehicle controller, video data output unit for outputting the data received by the video data receiving unit to the display means provided in the subsequent manned vehicle, data for controlling the operation of the head unmanned vehicle Control data input receiving unit and control data input receiving unit that receive the input from the maneuvering means provided on the subsequent manned vehicle. A control data transmitting unit for transmitting the attached data to the leading unmanned vehicle controller, a route calculating unit for calculating a route on which the leading unmanned vehicle should travel based on the data received by the control data input receiving unit, The traveling locus data receiving unit that receives data indicating the traveling locus from the leading unmanned vehicle controller, the route calculated by the route calculating unit, and the traveling locus of the leading unmanned vehicle indicated by the data received by the traveling locus data receiving unit are compared. An error determination unit that determines whether or not the error exceeds a predetermined threshold, and the subsequent manned vehicle is operated to drive the subsequent manned vehicle along the traveling locus indicated by the data received by the traveling locus data receiving unit. When the error determination unit determines that the error exceeds a predetermined threshold, the subsequent manned vehicle is stopped to stop the subsequent manned vehicle. Recording a program to function as a steering control unit that controls the steering.

なお、上記の発明の概要は、本発明の必要な特徴の全てを列挙したものではなく、これらの特徴群のサブコンビネーションもまた、発明となり得る。   The above summary of the invention does not enumerate all the necessary features of the present invention, and sub-combinations of these feature groups can also be the invention.

以上の説明から明らかなように、この発明によれば、人は、先頭車両以外の後続車両のうち、いずれか1台の車両に乗車すればよい。よって、この発明では、未知の経路や、障害物や危険物が存在するような経路を走行する場合に安全な隊列走行を実現することができる。   As is apparent from the above description, according to the present invention, a person may get on any one of the following vehicles other than the leading vehicle. Therefore, according to the present invention, it is possible to realize safe platooning when traveling on an unknown route or a route on which an obstacle or dangerous object exists.

一実施形態に係る隊列走行システム100の利用環境の一例を示す図である。It is a figure which shows an example of the utilization environment of the convoy travel system 100 which concerns on one Embodiment. 車両200Aの構成の一例を示す図である。It is a figure showing an example of composition of vehicles 200A. 車両200Bの構成の一例を示す図である。It is a figure which shows an example of a structure of the vehicle 200B. 車両200aの構成の一例を示す図である。It is a figure which shows an example of a structure of the vehicle 200a. 車載コントローラ110のブロック構成の一例を示す図である。It is a figure which shows an example of the block configuration of the vehicle-mounted controller. 車載コントローラ130のブロック構成の一例を示す図である。It is a figure which shows an example of the block configuration of the vehicle-mounted controller. 車載コントローラ150aのブロック構成の一例を示す図である。It is a figure which shows an example of the block configuration of the vehicle-mounted controller 150a. 車載コントローラ110、車載コントローラ130、及び車載コントローラ150の動作シーケンスの一例を示す図である。It is a figure which shows an example of the operation | movement sequence of the vehicle-mounted controller 110, the vehicle-mounted controller 130, and the vehicle-mounted controller 150. FIG. 車両200Aの走行に問題が発生した場合の車載コントローラ110、車載コントローラ130、及び車載コントローラ150aの動作シーケンスの一例を示す図である。It is a figure which shows an example of the operation sequence of the vehicle-mounted controller 110, the vehicle-mounted controller 130, and the vehicle-mounted controller 150a when a problem generate | occur | produces in driving | running | working of the vehicle 200A. 経路情報格納部111が格納している情報の一例をテーブル形式で示す図である。It is a figure which shows an example of the information which the path | route information storage part 111 stores in a table format. 車載コントローラ110、車載コントローラ130、及び車載コントローラ150のそれぞれのハードウェア構成の一例を示す図である。It is a figure which shows an example of each hardware constitutions of the vehicle-mounted controller 110, the vehicle-mounted controller 130, and the vehicle-mounted controller 150.

以下、発明の実施の形態を通じて本発明を説明するが、以下の実施形態は特許請求の範囲にかかる発明を限定するものではなく、また実施形態の中で説明されている特徴の組み合わせの全てが発明の解決手段に必須であるとは限らない。   Hereinafter, the present invention will be described through embodiments of the invention. However, the following embodiments do not limit the claimed invention, and all combinations of features described in the embodiments are described. It is not necessarily essential for the solution of the invention.

図1は、一実施形態に係る隊列走行システム100の利用環境の一例を示す。隊列走行システム100は、複数の車両200A、車両200B、及び車両200a、b、c、・・・(以下、車両200と総称する。)を隊列走行させるシステムである。隊列走行システム100は、車載コントローラ110、車載コントローラ130、複数の車載コントローラ150a、b、c、・・・(以下、車載コントローラ150と総称する。)、及び通信回線170を備える。なお、通信回線170は、インターネット等のコンピュータネットワーク、通信事業者のコアネットワーク、及び種々のローカルネットワークであってよい。   FIG. 1 shows an example of a usage environment of a convoy travel system 100 according to an embodiment. The row running system 100 is a system for running a plurality of vehicles 200A, 200B, and vehicles 200a, b, c,... (Hereinafter collectively referred to as vehicles 200). The convoy travel system 100 includes an in-vehicle controller 110, an in-vehicle controller 130, a plurality of in-vehicle controllers 150a, b, c,... (Hereinafter collectively referred to as the in-vehicle controller 150), and a communication line 170. The communication line 170 may be a computer network such as the Internet, a core network of a communication carrier, and various local networks.

車載コントローラ110は、車両200Aに搭載されている。具体的には、車両200Aは、隊列の先頭を走行する先頭車両である。車両200Aには、人は乗車していない。また、車両200Aには、車載コントローラ110を通信回線170に通信接続するための通信アンテナ201Aが設けられている。そして、車載コントローラ110と通信アンテナ201Aとは、通信ケーブルを介して電気的に接続されている。なお、車載コントローラ110は、この発明における「先頭無人車両コントローラ」の一例であってよい。   The in-vehicle controller 110 is mounted on the vehicle 200A. Specifically, the vehicle 200A is a leading vehicle that travels at the top of the platoon. A person is not in the vehicle 200A. The vehicle 200 </ b> A is provided with a communication antenna 201 </ b> A for communicatively connecting the in-vehicle controller 110 to the communication line 170. The in-vehicle controller 110 and the communication antenna 201A are electrically connected via a communication cable. The in-vehicle controller 110 may be an example of the “first unmanned vehicle controller” in the present invention.

車載コントローラ130は、車両200Bに搭載されている。具体的には、車両200Bは、隊列の先頭以外を走行する後続車両である。車両200Bには、人が乗車している。また、車両200Bには、車載コントローラ130を通信回線170に通信接続するための通信アンテナ201Bが設けられている。そして、車載コントローラ130と通信アンテナ201Bとは、通信ケーブルを介して電気的に接続されている。なお、車載コントローラ130は、この発明における「後続有人車両コントローラ」の一例であってよい。   The in-vehicle controller 130 is mounted on the vehicle 200B. Specifically, the vehicle 200B is a succeeding vehicle that travels other than the head of the formation. A person is in the vehicle 200B. The vehicle 200B is provided with a communication antenna 201B for connecting the in-vehicle controller 130 to the communication line 170 for communication. The in-vehicle controller 130 and the communication antenna 201B are electrically connected via a communication cable. The in-vehicle controller 130 may be an example of a “subsequent manned vehicle controller” in the present invention.

車載コントローラ150は、車両200a、b、c、・・・に搭載されている。具体的には、車両200a、b、c、・・・は、隊列の先頭以外を走行する後続車両である。車両200a、b、c、・・・には、人は乗車していても、乗車していなくても、どちらでも構わない。また、車両200a、b、c、・・・には、車載コントローラ150を通信回線170に通信接続するための通信アンテナ201が設けられている。そして、車載コントローラ150と通信アンテナ201とは、通信ケーブルを介して電気的に接続されている。   The in-vehicle controller 150 is mounted on the vehicles 200a, b, c,. Specifically, the vehicles 200a, b, c,... Are subsequent vehicles that travel outside the head of the formation. It does not matter whether the vehicle 200a, b, c,... Is on board or not. Further, the vehicles 200a, b, c,... Are provided with a communication antenna 201 for communication connection of the in-vehicle controller 150 to the communication line 170. The in-vehicle controller 150 and the communication antenna 201 are electrically connected via a communication cable.

図2は、車両200Aの構成の一例を示す。車両200Aには、通信アンテナ201Aの他に、ビデオカメラ202A、GPS(Global Positioning System)受信機205A、IMU(Inertial Measurement Unit)206A、車速検出器207A、車速検出器208A、車速検出器209A、車速検出器210A、ステアリングアクチュエータ211A、アクセルアクチュエータ212A、ブレーキアクチュエータ213A、及びシフトチェンジアクチュエータ214Aが設けられている。以下に、各構成要素の機能及び動作を説明する。   FIG. 2 shows an example of the configuration of the vehicle 200A. In addition to the communication antenna 201A, the vehicle 200A includes a video camera 202A, a GPS (Global Positioning System) receiver 205A, an IMU (Internal Measurement Unit) 206A, a vehicle speed detector 207A, a vehicle speed detector 208A, a vehicle speed detector 209A, a vehicle speed. A detector 210A, a steering actuator 211A, an accelerator actuator 212A, a brake actuator 213A, and a shift change actuator 214A are provided. The function and operation of each component will be described below.

なお、車両200A以外の車両200B、及び車両200a、b、c、・・・も、車両200aが有する構成要素と同様の構成要素を有する。以後の説明では、車両200が有する構成要素がいずれの車両200の構成要素であるかを区別する場合には、各構成要素を有する車両200と同じ添え字(A、B、a、b、c、・・・)を各構成要素の末尾に付して区別する。例えば、通信アンテナ201A、通信アンテナ201B、及び通信アンテナ201aは、それぞれ車両200A、車両200B、及び車両200aの構成要素であることを示す。   Note that the vehicle 200B other than the vehicle 200A and the vehicles 200a, b, c,... Have the same components as the components of the vehicle 200a. In the following description, when distinguishing which component of the vehicle 200 the component of the vehicle 200 is, the same subscript (A, B, a, b, c) as the vehicle 200 having each component. ,...) Are added to the end of each component to distinguish them. For example, the communication antenna 201A, the communication antenna 201B, and the communication antenna 201a indicate components of the vehicle 200A, the vehicle 200B, and the vehicle 200a, respectively.

また、以後の説明において、添え字が付されていない構成要素の機能及び動作は、同じ符号が付されたいずれの構成要素の機能及び動作を示す。例えば、通信アンテナ201で説明された機能及び動作は、通信アンテナ201A、通信アンテナ201B、通信アンテナ201a、・・・の機能及び動作を示す。   Further, in the following description, the function and operation of a component that is not given a subscript indicates the function and operation of any component that is assigned the same reference numeral. For example, the functions and operations described for the communication antenna 201 indicate the functions and operations of the communication antenna 201A, the communication antenna 201B, the communication antenna 201a,.

ビデオカメラ202Aは、車両200Aの前方の状況を撮影する装置である。具体的には、ビデオカメラ202Aは、映像ケーブルを介して車載コントローラ110と電気的に接続されている。そして、ビデオカメラ202Aは、車両200Aの前方の状況を撮影すると、その映像を示すデータを車載コントローラ110に出力する。なお、ビデオカメラ202Aは、この発明における「撮影手段」の一例であってよい。   The video camera 202A is an apparatus that captures a situation in front of the vehicle 200A. Specifically, the video camera 202A is electrically connected to the in-vehicle controller 110 via a video cable. Then, when the video camera 202A captures a situation in front of the vehicle 200A, the video camera 202A outputs data indicating the video to the in-vehicle controller 110. The video camera 202A may be an example of the “photographing unit” in the present invention.

GPS受信機205Aは、地球上における車両200Aの位置を特定する装置である。具体的には、GPS受信機205Aは、上空にある数個の衛星からの信号を受信する手段と、受信した信号に基づいて、地球上における車両200Aの位置を特定する手段とを備えている。また、GPS受信機205Aは、データケーブルを介して車載コントローラ110と電気的に接続されている。そして、GPS受信機205Aは、地球上における車両200Aの位置を特定すると、その位置を示すデータを車載コントローラ110に出力する。   The GPS receiver 205A is a device that specifies the position of the vehicle 200A on the earth. Specifically, the GPS receiver 205A includes means for receiving signals from several satellites in the sky, and means for specifying the position of the vehicle 200A on the earth based on the received signals. . The GPS receiver 205A is electrically connected to the in-vehicle controller 110 via a data cable. And if GPS receiver 205A pinpoints the position of vehicle 200A on the earth, it will output the data which show the position to in-vehicle controller 110.

IMU206Aは、車両200Aの3次元の角度と加速度を検出する装置である。具体的には、IMU206Aは、3軸のジャイロと、3方向の加速度計によって構成されている。また、IMU206Aは、データケーブルを介して車載コントローラ110と電気的に接続されている。そして、IMU206Aは、車両200Aの3次元の角度と加速度を検出すると、その各値を示すデータを車載コントローラ110に出力する。   The IMU 206A is a device that detects a three-dimensional angle and acceleration of the vehicle 200A. Specifically, the IMU 206A includes a three-axis gyro and a three-direction accelerometer. Further, the IMU 206A is electrically connected to the in-vehicle controller 110 via a data cable. And IMU206A will output the data which show each value to the vehicle-mounted controller 110, if the three-dimensional angle and acceleration of the vehicle 200A are detected.

車速検出器207A、車速検出器208A、車速検出器209A、及び車速検出器210Aは、車両200Aの車輪の速度を検出する装置である。具体的には、車速検出器207Aは、車両200Aの左前輪の車軸の回転数に比例してパルス信号を発生する手段と、そのパルス信号に基づいて、左前輪の速度を算出する手段とを備えている。同様に、車速検出器208Aは、車両200Aの右前輪の車軸の回転数に比例してパルス信号を発生する手段と、そのパルス信号に基づいて、右前輪の速度を算出する手段とを備えている。同様に、車速検出器209Aは、車両200Aの左後輪の車軸の回転数に比例してパルス信号を発生する手段と、そのパルス信号に基づいて、左後輪の速度を算出する手段とを備えている。同様に、車速検出器210Aは、車両200Aの右後輪の車軸の回転数に比例してパルス信号を発生する手段と、そのパルス信号に基づいて、右後輪の速度を算出する手段とを備えている。また、車速検出器207A、車速検出器208A、車速検出器209A、及び車速検出器210Aは、それぞれデータケーブルを介して車載コントローラ110と電気的に接続されている。そして、車速検出器207A、車速検出器208A、車速検出器209A、及び車速検出器210Aは、車輪の速度を算出すると、その値を示すデータを車載コントローラ110に出力する。   The vehicle speed detector 207A, the vehicle speed detector 208A, the vehicle speed detector 209A, and the vehicle speed detector 210A are devices that detect the speed of the wheels of the vehicle 200A. Specifically, the vehicle speed detector 207A includes means for generating a pulse signal in proportion to the rotational speed of the axle of the left front wheel of the vehicle 200A, and means for calculating the speed of the left front wheel based on the pulse signal. I have. Similarly, vehicle speed detector 208A includes means for generating a pulse signal in proportion to the rotational speed of the axle of the right front wheel of vehicle 200A, and means for calculating the speed of the right front wheel based on the pulse signal. Yes. Similarly, the vehicle speed detector 209A includes means for generating a pulse signal in proportion to the rotational speed of the left rear wheel axle of the vehicle 200A, and means for calculating the speed of the left rear wheel based on the pulse signal. I have. Similarly, the vehicle speed detector 210A includes means for generating a pulse signal in proportion to the rotational speed of the right rear wheel axle of the vehicle 200A, and means for calculating the speed of the right rear wheel based on the pulse signal. I have. Further, the vehicle speed detector 207A, the vehicle speed detector 208A, the vehicle speed detector 209A, and the vehicle speed detector 210A are electrically connected to the in-vehicle controller 110 via data cables, respectively. Then, when the vehicle speed detector 207 </ b> A, the vehicle speed detector 208 </ b> A, the vehicle speed detector 209 </ b> A, and the vehicle speed detector 210 </ b> A calculate the wheel speed, the data indicating the value is output to the in-vehicle controller 110.

ステアリングアクチュエータ211Aは、車両200Aのステアリングを物理的に制御する装置である。具体的には、ステアリングアクチュエータ211Aは、車両200Aのステアリング機構に機械的に接続されている。また、ステアリングアクチュエータ211Aは、データケーブルを介して車載コントローラ110と電気的に接続されている。そして、ステアリングアクチュエータ211Aは、車載コントローラ110から出力された制御データの入力を受け付けると、その制御データに従って車両200Aのステアリングを物理的に制御する。   The steering actuator 211A is a device that physically controls the steering of the vehicle 200A. Specifically, the steering actuator 211A is mechanically connected to the steering mechanism of the vehicle 200A. The steering actuator 211A is electrically connected to the in-vehicle controller 110 via a data cable. When the steering actuator 211A receives input of control data output from the in-vehicle controller 110, the steering actuator 211A physically controls the steering of the vehicle 200A according to the control data.

アクセルアクチュエータ212Aは、車両200Aのアクセルを物理的に制御する装置である。具体的には、アクセルアクチュエータ212Aは、車両200Aのアクセル機構に機械的に接続されている。また、アクセルアクチュエータ212Aは、データケーブルを介して車載コントローラ110と電気的に接続されている。そして、アクセルアクチュエータ212Aは、車載コントローラ110から出力された制御データの入力を受け付けると、その制御データに従って車両200Aのアクセルを物理的に制御する。   The accelerator actuator 212A is a device that physically controls the accelerator of the vehicle 200A. Specifically, the accelerator actuator 212A is mechanically connected to the accelerator mechanism of the vehicle 200A. Further, the accelerator actuator 212A is electrically connected to the in-vehicle controller 110 via a data cable. When the accelerator actuator 212A receives the control data output from the in-vehicle controller 110, the accelerator actuator 212A physically controls the accelerator of the vehicle 200A according to the control data.

ブレーキアクチュエータ213Aは、車両200Aのブレーキを物理的に制御する装置である。具体的には、ブレーキアクチュエータ213Aは、車両200Aのブレーキ機構に機械的に接続されている。また、ブレーキアクチュエータ213Aは、データケーブルを介して車載コントローラ110と電気的に接続されている。そして、ブレーキアクチュエータ213Aは、車載コントローラ110から出力された制御データの入力を受け付けると、その制御データに従って車両200Aのブレーキを物理的に制御する。   The brake actuator 213A is a device that physically controls the brake of the vehicle 200A. Specifically, the brake actuator 213A is mechanically connected to the brake mechanism of the vehicle 200A. The brake actuator 213A is electrically connected to the in-vehicle controller 110 via a data cable. When the brake actuator 213A receives the input of the control data output from the in-vehicle controller 110, the brake actuator 213A physically controls the brake of the vehicle 200A according to the control data.

シフトチェンジアクチュエータ214Aは、車両200Aの変速機を制御する装置である。具体的には、シフトチェンジアクチュエータ214Aは、車両200Aの変速機に機械的に接続されている。また、シフトチェンジアクチュエータ213Aは、データケーブルを介して車載コントローラ110と電気的に接続されている。そして、シフトチェンジアクチュエータ214Aは、車載コントローラ110から出力された制御データの入力を受け付けると、その制御データに従って車両200Aの変速機を制御する。   Shift change actuator 214A is a device that controls the transmission of vehicle 200A. Specifically, shift change actuator 214A is mechanically connected to the transmission of vehicle 200A. The shift change actuator 213A is electrically connected to the in-vehicle controller 110 via a data cable. And shift change actuator 214A will control the transmission of vehicle 200A according to the control data, if the input of the control data output from in-vehicle controller 110 is received.

図3は、車両200Bの構成の一例を示す。車両200Bには、通信アンテナ201Bの他に、ディスプレイ203B、ジョイスティック204B、GPS受信機205B、IMU206B、車速検出器207B、車速検出器208B、車速検出器209B、車速検出器210B、ステアリングアクチュエータ211B、アクセルアクチュエータ212B、ブレーキアクチュエータ213B、及びシフトチェンジアクチュエータ214Bが設けられている。以下に、各構成要素の機能及び動作を説明する。   FIG. 3 shows an example of the configuration of the vehicle 200B. In addition to the communication antenna 201B, the vehicle 200B includes a display 203B, joystick 204B, GPS receiver 205B, IMU 206B, vehicle speed detector 207B, vehicle speed detector 208B, vehicle speed detector 209B, vehicle speed detector 210B, steering actuator 211B, accelerator An actuator 212B, a brake actuator 213B, and a shift change actuator 214B are provided. The function and operation of each component will be described below.

なお、車両200Bのディスプレイ203B及びジョイスティック204B以外の各構成要素は、車両200Aの各構成要素が車載コントローラ110と電気的に接続されているのに対し、車載コントローラ130と電気的に接続されていることを除けば同様の機能及び動作であるため、その詳細な説明を省略する。   Each component other than the display 203B and the joystick 204B of the vehicle 200B is electrically connected to the in-vehicle controller 130, whereas each component of the vehicle 200A is electrically connected to the in-vehicle controller 110. Since it is the same function and operation | movement except that, the detailed description is abbreviate | omitted.

ディスプレイ203Bは、文字や図形、映像等の情報を表示する装置である。具体的には、ディスプレイ203Bは、ディスプレイケーブルを介して車載コントローラ130と接続されている。そして、ディスプレイ203Bは、車載コントローラ130から出力されたデータの入力を受け付けると、そのデータによって示される情報を表示する。なお、ディスプレイ203Bは、この発明における「表示手段」の一例であってよい。   The display 203B is a device that displays information such as characters, graphics, and images. Specifically, the display 203B is connected to the in-vehicle controller 130 via a display cable. And display 203B will display the information shown by the data, if the input of the data output from in-vehicle controller 130 is received. The display 203B may be an example of the “display unit” in the present invention.

ジョイスティック204Bは、ディスプレイ203Bの画面上における入力位置や座標を指定する装置である。具体的には、ジョイスティック204Bは、レバーといくつかのボタンを備えている。また、ジョイスティック204Bは、データケーブルを介して車載コントローラ130と接続されている。そして、ジョイスティック204Bは、レバーが前後左右に倒されると、その操作量を示すデータを車載コントローラ130に出力する。また、ジョイスティック204Bは、ボタンが押下されると、押下されたボタンを識別するデータを車載コントローラ130に出力する。なお、ジョイスティック204Bは、この発明における「操縦手段」の一例であってよい。また、レバーの操作量を示すデータ、及び押下されたボタンを識別するデータは、この発明における「先頭の無人車両の操縦を制御するためのデータ」の一例であってよい。   The joystick 204B is a device that designates an input position and coordinates on the screen of the display 203B. Specifically, the joystick 204B includes a lever and several buttons. The joystick 204B is connected to the in-vehicle controller 130 via a data cable. Then, when the lever is tilted back and forth and left and right, the joystick 204B outputs data indicating the operation amount to the in-vehicle controller 130. When the button is pressed, the joystick 204B outputs data for identifying the pressed button to the in-vehicle controller 130. The joystick 204B may be an example of the “steering means” in the present invention. The data indicating the amount of operation of the lever and the data for identifying the pressed button may be an example of “data for controlling the operation of the leading unmanned vehicle” in the present invention.

図4は、車両200aの構成の一例を示す。車両200aには、通信アンテナ201aの他に、GPS受信機205a、IMU206a、車速検出器207a、車速検出器208a、車速検出器209a、車速検出器210a、ステアリングアクチュエータ211a、アクセルアクチュエータ212a、ブレーキアクチュエータ213a、及びシフトチェンジアクチュエータ214aが設けられている。   FIG. 4 shows an example of the configuration of the vehicle 200a. In addition to the communication antenna 201a, the vehicle 200a includes a GPS receiver 205a, IMU 206a, vehicle speed detector 207a, vehicle speed detector 208a, vehicle speed detector 209a, vehicle speed detector 210a, steering actuator 211a, accelerator actuator 212a, brake actuator 213a. , And a shift change actuator 214a is provided.

車両200aの各構成要素は、車両200Aの各構成要素が車載コントローラ110と電気的に接続されているのに対し、車載コントローラ150aと電気的に接続されていることを除けば同様の機能及び動作であるため、その詳細な説明を省略する。また、車両200b、c、・・・の構成は、車両200aの構成と同じ構成であるため、その詳細な説明を省略する。   Each component of the vehicle 200a has the same function and operation except that each component of the vehicle 200A is electrically connected to the in-vehicle controller 110, whereas it is electrically connected to the in-vehicle controller 150a. Therefore, detailed description thereof is omitted. Further, the configuration of the vehicles 200b, c,... Is the same as the configuration of the vehicle 200a, and thus detailed description thereof is omitted.

このような隊列走行システム100においては、車両200Aを先頭に、車両200B、車両200a、車両200b、車両200c、・・・が順に後続して走行するよう各車両200の操縦が制御される。   In such a row running system 100, the steering of each vehicle 200 is controlled so that the vehicle 200A, the vehicle 200a, the vehicle 200b, the vehicle 200c,.

具体的には、先頭を走行すべき車両200Aに設けられたビデオカメラ202Aは、車両200Aの前方の状況を撮影している。そして、ビデオカメラ202Aは、撮影した映像を示すデータを車載コントローラ110に出力する。車載コントローラ110は、ビデオカメラ202Aから出力された映像を示すデータの入力を受け付けると、そのデータを車載コントローラ130に送信する。   Specifically, the video camera 202A provided in the vehicle 200A that should run at the head is photographing the situation in front of the vehicle 200A. Then, the video camera 202A outputs data indicating the captured video to the in-vehicle controller 110. When receiving the data indicating the video output from the video camera 202 </ b> A, the in-vehicle controller 110 transmits the data to the in-vehicle controller 130.

車載コントローラ130は、車載コントローラ110から送信された映像を示すデータを受信すると、そのデータをディスプレイ203Bに出力する。このようにして、ディスプレイ203Bには、車両200Aの前方の状況を撮影した映像が表示されることになる。   When the in-vehicle controller 130 receives the data indicating the video transmitted from the in-vehicle controller 110, the in-vehicle controller 130 outputs the data to the display 203B. In this way, an image of the situation in front of the vehicle 200A is displayed on the display 203B.

車両200Bには、操縦者が乗車している。但し、この操縦者は、乗車している車両200Bを操縦するわけではなく、乗車していない車両200Aを遠隔操縦する。具体的には、操縦者は、ディスプレイ203Bに表示される映像を見ながら、ジョイスティック204Bのレバーやボタンを操作することによって、車両200Aを遠隔操縦する。   A driver is on the vehicle 200B. However, this pilot does not steer the vehicle 200B that is on board, but remotely steers the vehicle 200A that is not on board. Specifically, the operator remotely controls the vehicle 200A by operating the levers and buttons of the joystick 204B while watching the video displayed on the display 203B.

ジョイスティック204Bは、レバーやボタンが操縦者によって操作されると、レバーの操作量や、押下されたボタンを識別するデータを車載コントローラ130に出力する。車載コントローラ130は、ジョイスティック204Bから出力されたデータの入力を受け付けると、そのデータを車載コントローラ110に送信する。   When the lever or button is operated by the operator, the joystick 204B outputs the amount of operation of the lever and data for identifying the pressed button to the in-vehicle controller 130. When the in-vehicle controller 130 receives input of data output from the joystick 204B, the in-vehicle controller 130 transmits the data to the in-vehicle controller 110.

車載コントローラ110は、車載コントローラ130から送信されたデータを受信すると、そのデータによって示されるジョイスティック204Bの操作情報に基づいて、ステアリングアクチュエータ211A、アクセルアクチュエータ212A、ブレーキアクチュエータ213A、及びシフトチェンジアクチュエータ214Aの動作を制御する。   When the in-vehicle controller 110 receives the data transmitted from the in-vehicle controller 130, the operation of the steering actuator 211A, the accelerator actuator 212A, the brake actuator 213A, and the shift change actuator 214A based on the operation information of the joystick 204B indicated by the data. To control.

例えば、受信したデータが「ジョイスティック204Bのレバーが左右に倒された操作量」を示す情報を含んでいる場合、車載コントローラ110は、その操作量に応じて、ステアリングが操作されるべき操作量を算出し、その値を示す制御データをステアリングアクチュエータ211Aに出力する。ステアリングアクチュエータ211Aは、制御データの入力を受け付けると、そのデータによって示される操作量となるよう、車両200Aのステアリングを物理的に制御する。   For example, when the received data includes information indicating “the amount of operation in which the lever of the joystick 204B is tilted to the left and right”, the in-vehicle controller 110 determines the amount of operation that the steering should be operated according to the amount of operation. The control data indicating the calculated value is output to the steering actuator 211A. When the steering actuator 211A receives the input of the control data, the steering actuator 211A physically controls the steering of the vehicle 200A so that the operation amount indicated by the data is obtained.

また、例えば、受信したデータが「ジョイスティック204Bのレバーが前に倒された操作量」を示す情報を含んでいる場合、車載コントローラ110は、その操作量に応じて、アクセルが操作されるべき操作量を算出し、その値を示す制御データをアクセルアクチュエータ212Aに出力する。アクセルアクチュエータ212Aは、制御データの入力を受け付けると、そのデータによって示される操作量となるよう、車両200Aのアクセルを物理的に制御する。   In addition, for example, when the received data includes information indicating “the amount of operation in which the lever of the joystick 204B is tilted forward”, the in-vehicle controller 110 operates the accelerator to be operated according to the amount of operation. The amount is calculated, and control data indicating the value is output to the accelerator actuator 212A. When the accelerator actuator 212A receives the input of the control data, the accelerator actuator 212A physically controls the accelerator of the vehicle 200A so that the operation amount indicated by the data is obtained.

また、例えば、受信したデータが「ジョイスティック204Bのレバーが後ろに倒された操作量」を示す情報を含んでいる場合、車載コントローラ110は、その操作量に応じて、ブレーキが操作されるべき操作量を算出し、その値を示す制御データをブレーキアクチュエータ213Aに出力する。ブレーキアクチュエータ213Aは、制御データの入力を受け付けると、そのデータによって示される操作量となるよう、車両200Aのブレーキを物理的に制御する。   In addition, for example, when the received data includes information indicating “the amount of operation in which the lever of the joystick 204B is tilted backward”, the in-vehicle controller 110 operates the brake to be operated according to the amount of operation. The amount is calculated, and control data indicating the value is output to the brake actuator 213A. When receiving the input of the control data, the brake actuator 213A physically controls the brake of the vehicle 200A so that the operation amount indicated by the data is obtained.

また、例えば、受信したデータが「押下されたボタン」を識別する情報を含んでいる場合、車載コントローラ110は、そのボタンに割り当てられているギヤを特定し、そのギヤを示す制御データをシフトチェンジアクチュエータ214Aに出力する。シフトチェンジアクチュエータ214Aは、制御データの入力を受け付けると、そのデータによって示されるギヤに変速するよう、車両200Aの変速機を物理的に制御する。このようにして、車両200Aは、車両200Bに乗車している操縦者の操縦によって、ステアリング、アクセル、ブレーキ、及び変速機が遠隔的に操作され、走行することになる。   Further, for example, when the received data includes information for identifying the “button pressed”, the in-vehicle controller 110 identifies the gear assigned to the button and shift-controls the control data indicating the gear. Output to the actuator 214A. When shift control actuator 214A receives input of control data, shift change actuator 214A physically controls the transmission of vehicle 200A to shift to the gear indicated by the data. In this manner, the vehicle 200A travels by remotely operating the steering, the accelerator, the brake, and the transmission under the control of the driver who is on the vehicle 200B.

車両200Aが走行すると、GPS受信機205Aは、地球上における車両200Aの位置を特定し、その位置を示すデータを車載コントローラ110に出力する。IMU206Aは、車両200Aの3次元の角度と加速度を検出し、その各値を示すデータを車載コントローラ110に出力する。また、車速検出器207A、車速検出器208A、車速検出器209A、及び車速検出器210Aは、車輪の速度を検出すると、その値を示すデータを車載コントローラ110に出力する。   When vehicle 200A travels, GPS receiver 205A identifies the position of vehicle 200A on the earth and outputs data indicating the position to in-vehicle controller 110. The IMU 206A detects the three-dimensional angle and acceleration of the vehicle 200A, and outputs data indicating each value to the in-vehicle controller 110. Further, when the vehicle speed detector 207 </ b> A, the vehicle speed detector 208 </ b> A, the vehicle speed detector 209 </ b> A, and the vehicle speed detector 210 </ b> A detect the wheel speed, they output data indicating the value to the in-vehicle controller 110.

車載コントローラ110は、GPS受信機205Aから出力されたデータの入力を受け付けると、車両200Aの位置の遷移から車両200Aが走行した軌跡を示すデータを生成し、そのデータを車載コントローラ130及び各車載コントローラ150に送信する。なお、車両200Aが走行した軌跡を示すデータは、この発明における「先頭の無人車両の走行軌跡を示すデータ」の一例であってよい。   When the in-vehicle controller 110 receives input of data output from the GPS receiver 205A, the in-vehicle controller 110 generates data indicating a trajectory traveled by the vehicle 200A from the transition of the position of the vehicle 200A, and the data is used as the in-vehicle controller 130 and each in-vehicle controller. 150. The data indicating the trajectory traveled by vehicle 200A may be an example of “data indicating the travel trajectory of the first unmanned vehicle” in the present invention.

例えば、車両200Aがトンネルに入ったり、建物の影に隠れたりすると、GPS受信機205Aは、地球上における車両200Aの位置を特定することができなくなることがある。そのような場合、車載コントローラ110は、IMU206、車速検出器207A、車速検出器208A、車速検出器209A、及び車速検出器210Aから出力されたデータの入力を受け付けると、これらデータによって示される情報に基づいて、車両200Aが走行した軌跡を示すデータを生成し、そのデータを車載コントローラ130及び各車載コントローラ150に送信する。   For example, if the vehicle 200A enters a tunnel or is hidden behind a building, the GPS receiver 205A may not be able to determine the position of the vehicle 200A on the earth. In such a case, when the in-vehicle controller 110 receives input of data output from the IMU 206, the vehicle speed detector 207A, the vehicle speed detector 208A, the vehicle speed detector 209A, and the vehicle speed detector 210A, the information indicated by these data is displayed. Based on this, data indicating the trajectory traveled by the vehicle 200 </ b> A is generated, and the data is transmitted to the in-vehicle controller 130 and each in-vehicle controller 150.

車載コントローラ130は、車両200Aが走行した軌跡を示すデータを車載コントローラ110から受信すると、その軌跡に沿って車両200Bを走行させるべく、ステアリングアクチュエータ211B、アクセルアクチュエータ212B、ブレーキアクチュエータ213B、及びシフトチェンジアクチュエータ214Bの動作を制御する。   When the in-vehicle controller 130 receives data indicating the trajectory traveled by the vehicle 200A from the in-vehicle controller 110, the in-vehicle controller 130B, the accelerator actuator 212B, the brake actuator 213B, and the shift change actuator are used to drive the vehicle 200B along the trajectory. The operation of 214B is controlled.

例えば、GPS受信機205Bが地球上における車両200Bの位置を特定できている場合、車載コントローラ130は、GPS受信機205Bから出力されたデータによって示される車両200Bの現在位置に基づいて、車両200Aが走行した軌跡に沿って車両200Bを走行させるべく、ステアリングアクチュエータ211B、アクセルアクチュエータ212B、ブレーキアクチュエータ213B、及びシフトチェンジアクチュエータ214Bの動作を制御する。   For example, when the GPS receiver 205B can identify the position of the vehicle 200B on the earth, the in-vehicle controller 130 determines that the vehicle 200A is based on the current position of the vehicle 200B indicated by the data output from the GPS receiver 205B. The operation of the steering actuator 211B, the accelerator actuator 212B, the brake actuator 213B, and the shift change actuator 214B is controlled so that the vehicle 200B travels along the traveled path.

また、例えば、GPS受信機205Bが地球上における車両200Bの位置を特定できていない場合、車載コントローラ130は、IMU206B、車速検出器207B、車速検出器208B、車速検出器209B、及び車速検出器210Bから出力されたデータによって示される各情報に基づいて、車両200Aが走行した軌跡に沿って車両200Bを走行させるべく、ステアリングアクチュエータ211B、アクセルアクチュエータ212B、ブレーキアクチュエータ213B、及びシフトチェンジアクチュエータ214Bの動作を制御する。このようにして、車両200Bは、車両200Aが走行した軌跡に沿って走行することになる。   Further, for example, when the GPS receiver 205B cannot identify the position of the vehicle 200B on the earth, the in-vehicle controller 130 sets the IMU 206B, the vehicle speed detector 207B, the vehicle speed detector 208B, the vehicle speed detector 209B, and the vehicle speed detector 210B. The operation of the steering actuator 211B, the accelerator actuator 212B, the brake actuator 213B, and the shift change actuator 214B is performed so that the vehicle 200B travels along the trajectory traveled by the vehicle 200A based on the information indicated by the data output from the vehicle 200A. Control. Thus, the vehicle 200B travels along the trajectory traveled by the vehicle 200A.

一方、車載コントローラ150は、車両200Aが走行した軌跡を示すデータを車載コントローラ110から受信すると、その軌跡に沿って車両200を走行させるべく、ステアリングアクチュエータ211、アクセルアクチュエータ212、ブレーキアクチュエータ213、及びシフトチェンジアクチュエータ214の動作を制御する。車載コントローラ150によるステアリングアクチュエータ211、アクセルアクチュエータ212、ブレーキアクチュエータ213、及びシフトチェンジアクチュエータ214の動作の制御は、車載コントローラ130による制御と同じであるため、その詳細な説明を省略する。このようにして、車両200a、b、c、・・・は、車両200Aが走行した軌跡に沿って走行することになる。   On the other hand, when the in-vehicle controller 150 receives data indicating the trajectory traveled by the vehicle 200A from the in-vehicle controller 110, the in-vehicle controller 150, the accelerator actuator 212, the brake actuator 213, and the shift are driven to travel the vehicle 200 along the trajectory. The operation of the change actuator 214 is controlled. Since the control of the steering actuator 211, the accelerator actuator 212, the brake actuator 213, and the shift change actuator 214 by the in-vehicle controller 150 is the same as the control by the in-vehicle controller 130, detailed description thereof is omitted. In this way, the vehicles 200a, b, c,... Travel along the trajectory traveled by the vehicle 200A.

なお、車載コントローラ110は、予め設定された経路に沿って車両200Aを走行させるべく、ステアリングアクチュエータ211A、アクセルアクチュエータ212A、ブレーキアクチュエータ213A、及びシフトチェンジアクチュエータ214Aの動作を制御することもできる。その場合、車載コントローラ110は、ジョイスティック204Bの操作情報を示すデータを車載コントローラ130から受信すると、その操作情報に基づく動作が優先されるよう、ステアリングアクチュエータ211A、アクセルアクチュエータ212A、ブレーキアクチュエータ213A、及びシフトチェンジアクチュエータ214Aの動作を制御する。このようにして、車両200Aは、予め設定された経路に沿って走行すると共に、車両200Bに乗車している人の操作によっても制御されるようにして走行することになる。   The in-vehicle controller 110 can also control the operations of the steering actuator 211A, the accelerator actuator 212A, the brake actuator 213A, and the shift change actuator 214A so that the vehicle 200A travels along a preset route. In that case, when the in-vehicle controller 110 receives data indicating the operation information of the joystick 204B from the in-vehicle controller 130, the steering actuator 211A, the accelerator actuator 212A, the brake actuator 213A, and the shift are given so that the operation based on the operation information is given priority. The operation of the change actuator 214A is controlled. In this way, the vehicle 200A travels along a preset route and travels so as to be controlled by an operation of a person riding on the vehicle 200B.

また、車載コントローラ110は、所定時間以上の間、ジョイスティック204Bの操作情報を示すデータを車載コントローラ130から受信することができなくなった場合、車両200Aを停止させるべく、ステアリングアクチュエータ211A、アクセルアクチュエータ212A、ブレーキアクチュエータ213A、及びシフトチェンジアクチュエータ214Aの動作を制御する。このようにして、車両200Aは、停止することになる。   On the other hand, when the in-vehicle controller 110 cannot receive the data indicating the operation information of the joystick 204B from the in-vehicle controller 130 for a predetermined time or more, the steering actuator 211A, the accelerator actuator 212A, The operation of the brake actuator 213A and the shift change actuator 214A is controlled. In this way, the vehicle 200A stops.

また、車載コントローラ130は、ジョイスティック204Bの操作情報に基づいて、車両200Aが走行すべき経路を算出する。そして、車載コントローラ130は、車両200Aが走行した軌跡を示すデータを車載コントローラ110から受信すると、その軌跡と、算出した経路とを比較し、その誤差が所定の閾値を超えたか否かを判定する。そして、車載コントローラ130は、所定の閾値を超えたと判定した場合、車両200Bを停止させるべく、ステアリングアクチュエータ211B、アクセルアクチュエータ212B、ブレーキアクチュエータ213B、及びシフトチェンジアクチュエータ214Bの動作を制御する。このようにして、車両200Bは、停止することになる。更に、車載コントローラ130は、車両200を停止させるよう指示する旨のデータを各車載コントローラ150に送信する。車載コントローラ150は、車両200を停止させるよう指示する旨のデータを車載コントローラ130から受信すると、車両200を停止させるべく、ステアリングアクチュエータ211、アクセルアクチュエータ212、ブレーキアクチュエータ213、及びシフトチェンジアクチュエータ214の動作を制御する。このようにして、各車両200a、b、c、・・・は、停止することになる。   Further, the in-vehicle controller 130 calculates a route on which the vehicle 200A should travel based on the operation information of the joystick 204B. Then, when the in-vehicle controller 130 receives data indicating the trajectory traveled by the vehicle 200A from the in-vehicle controller 110, the in-vehicle controller 130 compares the trajectory with the calculated route and determines whether or not the error exceeds a predetermined threshold. . And when it determines with the vehicle-mounted controller 130 having exceeded the predetermined threshold value, in order to stop the vehicle 200B, it controls operation | movement of the steering actuator 211B, the accelerator actuator 212B, the brake actuator 213B, and the shift change actuator 214B. In this way, the vehicle 200B stops. Furthermore, the in-vehicle controller 130 transmits data indicating that the vehicle 200 is to be stopped to each in-vehicle controller 150. When the in-vehicle controller 150 receives data indicating that the vehicle 200 is to be stopped from the in-vehicle controller 130, the operations of the steering actuator 211, the accelerator actuator 212, the brake actuator 213, and the shift change actuator 214 to stop the vehicle 200. To control. In this way, each vehicle 200a, b, c,... Stops.

図5は、車載コントローラ110のブロック構成の一例を示す。車載コントローラ110は、経路情報格納部111、映像データ入力受付部112、映像データ送信部113、制御データ受信部114、操縦制御部115、位置データ入力受付部116、3次元データ入力受付部117、車速データ入力受付部118、走行軌跡データ生成部119、及び走行軌跡データ送信部120を有する。以下に、各構成要素の機能及び動作を説明する。   FIG. 5 shows an example of a block configuration of the in-vehicle controller 110. The in-vehicle controller 110 includes a route information storage unit 111, a video data input reception unit 112, a video data transmission unit 113, a control data reception unit 114, a steering control unit 115, a position data input reception unit 116, a three-dimensional data input reception unit 117, A vehicle speed data input reception unit 118, a travel locus data generation unit 119, and a travel locus data transmission unit 120 are included. The function and operation of each component will be described below.

映像データ入力受付部112は、ビデオカメラ202Aによって撮影された映像を示すデータの入力を受け付ける。具体的には、映像データ入力受付部112は、ビデオカメラ202Aから出力された映像を示すデータの入力を受け付けると、そのデータを映像データ送信部113に送る。   The video data input acceptance unit 112 accepts input of data indicating video captured by the video camera 202A. Specifically, when the video data input receiving unit 112 receives input of data indicating the video output from the video camera 202A, the video data input receiving unit 112 transmits the data to the video data transmitting unit 113.

映像データ送信部113は、ビデオカメラ202Aによって撮影された映像を示すデータを車載コントローラ130に送信する。具体的には、映像データ送信部113は、映像を示すデータを映像データ入力受付部112から受け取ると、そのデータを車載コントローラ130に送信する。   The video data transmission unit 113 transmits data indicating video captured by the video camera 202 </ b> A to the in-vehicle controller 130. Specifically, when video data transmission unit 113 receives data indicating video from video data input reception unit 112, video data transmission unit 113 transmits the data to in-vehicle controller 130.

制御データ受信部114は、車両200Aの操縦を制御するためのデータを車載コントローラ130から受信する。具体的には、制御データ受信部114は、車両200Aの操縦を制御するためのデータを車載コントローラ130から受信すると、そのデータを操縦制御部115に送る。   The control data receiving unit 114 receives data for controlling the operation of the vehicle 200 </ b> A from the in-vehicle controller 130. Specifically, when the control data receiving unit 114 receives data for controlling the operation of the vehicle 200 </ b> A from the in-vehicle controller 130, the control data receiving unit 114 sends the data to the operation control unit 115.

操縦制御部115は、車両200Aの操縦を制御する。具体的には、操縦制御部115は、車両200Aの操縦を制御するためのデータを制御データ受信部114から受け取ると、そのデータによって示される情報に基づいて、動作を制御するためのデータをステアリングアクチュエータ211A、アクセルアクチュエータ212A、ブレーキアクチュエータ213A、及びシフトチェンジアクチュエータ214Aに出力する。   The steering control unit 115 controls the steering of the vehicle 200A. Specifically, when the steering control unit 115 receives data for controlling the steering of the vehicle 200A from the control data receiving unit 114, the steering control unit 115 steers the data for controlling the operation based on the information indicated by the data. The data is output to the actuator 211A, the accelerator actuator 212A, the brake actuator 213A, and the shift change actuator 214A.

また、操縦制御部115は、車両200Aが走行すべき経路を示す情報が経路情報格納部111に格納されている場合、その経路に沿って車両200Aを走行させるべく、車両200Aの操縦を制御すると共に、制御データ受信部が受信したデータに基づいて、車両200Aの操縦を割り込み制御する。具体的には、経路情報格納部111は、車両200Aが走行すべき経路を示す情報として、その経路上の各通過位置を特定する緯度、経路、及び走行路の高さ等のデータや、その各通過位置を通過するときにとるべき速度を示すデータを格納している。このように、車両200Aが走行すべき経路を示す情報が経路情報格納部111に格納されている場合、操縦制御部115は、その情報を経路情報格納部111から読み出す。また、操縦制御部115は、地球上における車両200Aの位置を示すデータを位置データ入力受付部116から受け取る。そして、操縦制御部115は、車両200Aの位置を示す値に基づいて、経路情報格納部111から読み出した情報によって示される経路に沿って車両200Aを走行させるべく、動作を制御するためのデータをステアリングアクチュエータ211A、アクセルアクチュエータ212A、ブレーキアクチュエータ213A、及びシフトチェンジアクチュエータ214Aに出力する。例えば、経路情報格納部111は、アクセルアクチュエータ212Aの動作を制御するためのデータを、走行路の高さから算出される路面の傾斜や、車両200Aがとるべき速度等に基づいて生成して出力する。また、操縦制御部115は、地球上における車両200Aの位置を示すデータを位置データ入力受付部116から受け取ることができない場合、車両200Aの3次元の角度と加速度を示すデータを3次元データ入力受付部117から受け取り、車両200Aの各車輪の速度を示すデータを車速データ入力受付部118から受け取る。そして、操縦制御部115は、車両200Aの3次元の角度と加速度を示す値、及び車両200Aの各車輪の速度を示す値に基づいて、経路情報格納部111から読み出した情報によって示される経路に沿って車両200Aを走行させるべく、動作を制御するためのデータをステアリングアクチュエータ211A、アクセルアクチュエータ212A、ブレーキアクチュエータ213A、及びシフトチェンジアクチュエータ214Aに出力する。また、操縦制御部115は、車両200Aの操縦を制御するためのデータを制御データ受信部114から受け取ると、そのデータによって示される情報に基づく制御を優先して、動作を制御するためのデータをステアリングアクチュエータ211A、アクセルアクチュエータ212A、ブレーキアクチュエータ213A、及びシフトチェンジアクチュエータ214Aに出力する。   Further, when information indicating a route on which the vehicle 200A should travel is stored in the route information storage unit 111, the steering control unit 115 controls the steering of the vehicle 200A so that the vehicle 200A travels along the route. At the same time, the control of the vehicle 200A is interrupted and controlled based on the data received by the control data receiver. Specifically, the route information storage unit 111 includes, as information indicating a route that the vehicle 200A should travel, data such as a latitude, a route, and a height of the travel route that specify each passing position on the route, Data indicating the speed to be taken when passing through each passing position is stored. As described above, when information indicating the route on which the vehicle 200 </ b> A should travel is stored in the route information storage unit 111, the steering control unit 115 reads out the information from the route information storage unit 111. In addition, the steering control unit 115 receives data indicating the position of the vehicle 200 </ b> A on the earth from the position data input receiving unit 116. Then, based on the value indicating the position of the vehicle 200A, the steering control unit 115 provides data for controlling the operation so that the vehicle 200A travels along the route indicated by the information read from the route information storage unit 111. The data is output to the steering actuator 211A, the accelerator actuator 212A, the brake actuator 213A, and the shift change actuator 214A. For example, the route information storage unit 111 generates and outputs data for controlling the operation of the accelerator actuator 212A based on the slope of the road surface calculated from the height of the traveling road, the speed that the vehicle 200A should take, and the like. To do. Further, when the operation control unit 115 cannot receive data indicating the position of the vehicle 200A on the earth from the position data input receiving unit 116, the operation control unit 115 receives data indicating the three-dimensional angle and acceleration of the vehicle 200A. Data received from unit 117 and data indicating the speed of each wheel of vehicle 200 </ b> A is received from vehicle speed data input receiving unit 118. Then, the steering control unit 115 sets the route indicated by the information read from the route information storage unit 111 based on the value indicating the three-dimensional angle and acceleration of the vehicle 200A and the value indicating the speed of each wheel of the vehicle 200A. Data for controlling the operation is output to the steering actuator 211A, the accelerator actuator 212A, the brake actuator 213A, and the shift change actuator 214A so that the vehicle 200A travels along the vehicle. Further, when the control unit 115 receives data for controlling the control of the vehicle 200A from the control data receiving unit 114, the control unit 115 gives priority to the control based on the information indicated by the data, and the data for controlling the operation. The data is output to the steering actuator 211A, the accelerator actuator 212A, the brake actuator 213A, and the shift change actuator 214A.

また、操縦制御部115は、制御データ受信部114がデータを受信することができなくなった場合、車両200Aを停止させるべく、車両200Aの操縦を制御する。具体的には、操縦制御部115は、所定時間以上の間、制御データ受信部114からデータを受け取ることができない場合、車両200Aを停止させるべく、動作を制御するためのデータをステアリングアクチュエータ211A、アクセルアクチュエータ212A、ブレーキアクチュエータ213A、及びシフトチェンジアクチュエータ214Aに出力する。   In addition, the steering control unit 115 controls the steering of the vehicle 200A to stop the vehicle 200A when the control data receiving unit 114 cannot receive data. Specifically, when the steering control unit 115 cannot receive data from the control data receiving unit 114 for a predetermined time or more, the steering control unit 115A transmits data for controlling the operation to stop the vehicle 200A. The data is output to the accelerator actuator 212A, the brake actuator 213A, and the shift change actuator 214A.

位置データ入力受付部116は、GPS受信機205Aによって特定された地球上における車両200Aの位置を示すデータの入力を受け付ける。具体的には、位置データ入力受付部116は、GSP受信機205Aから出力された地球上における車両200Aの位置を示すデータの入力を受け付けると、そのデータを走行軌跡データ生成部119及び操縦制御部115に送る。   The position data input receiving unit 116 receives input of data indicating the position of the vehicle 200A on the earth specified by the GPS receiver 205A. Specifically, when the position data input accepting unit 116 accepts input of data indicating the position of the vehicle 200A on the earth output from the GSP receiver 205A, the position data input accepting unit 116 receives the data as a travel locus data generating unit 119 and a steering control unit. 115.

3次元データ入力受付部117は、IMU206Aによって検出された車両200Aの3次元の角度と加速度を示すデータの入力を受け付ける。具体的には、3次元データ入力受付部117は、IMU206Aから出力された車両200Aの3次元の角度と加速度を示すデータの入力を受け付けると、そのデータを走行軌跡データ生成部119及び操縦制御部115に送る。   The three-dimensional data input receiving unit 117 receives input of data indicating the three-dimensional angle and acceleration of the vehicle 200A detected by the IMU 206A. Specifically, when the three-dimensional data input accepting unit 117 accepts input of data indicating the three-dimensional angle and acceleration of the vehicle 200A output from the IMU 206A, the three-dimensional data input accepting unit 117 receives the data as a travel locus data generating unit 119 and a steering control unit. 115.

車速データ入力受付部118は、車速検出器207A、車速検出器208A、車速検出器209A、及び車速検出器210Aによってそれぞれ検出された車両200Aの各車輪の速度を示すデータの入力を受け付ける。具体的には、車速データ入力受付部118は、車速検出器207A、車速検出器208A、車速検出器209A、及び車速検出器210Aからそれぞれ出力された車両200Aの各車輪の速度を示すデータの入力を受け付けると、そのデータを走行軌跡データ生成部119及び操縦制御部115に送る。   The vehicle speed data input receiving unit 118 receives input of data indicating the speed of each wheel of the vehicle 200A detected by the vehicle speed detector 207A, the vehicle speed detector 208A, the vehicle speed detector 209A, and the vehicle speed detector 210A. Specifically, the vehicle speed data input receiving unit 118 inputs data indicating the speed of each wheel of the vehicle 200A output from the vehicle speed detector 207A, the vehicle speed detector 208A, the vehicle speed detector 209A, and the vehicle speed detector 210A. Is sent to the travel locus data generation unit 119 and the steering control unit 115.

走行軌跡データ生成部119は、車両200Aが走行した軌跡を示すデータを生成する。具体的には、走行軌跡データ生成部119は、地球上における車両200Aの位置を示すデータを位置データ入力受付部116から受け取ると、地球上における車両200Aの位置を示す値の変化に基づいて、車両200Aが走行した軌跡を示すデータを生成する。また、走行軌跡データ生成部119は、地球上における車両200Aの位置を示すデータを位置データ入力受付部116から受け取ることができない場合、車両200Aの3次元の角度と加速度を示すデータを3次元データ入力受付部117から受け取り、車両200Aの各車輪の速度を示すデータを車速データ入力受付部118から受け取る。そして、走行軌跡データ生成部119は、車両200Aの3次元の角度と加速度を示す値の変化、及び車両200Aの各車輪の速度を示す値の変化に基づいて、車両200Aが走行した軌跡を示すデータを生成する。そして、走行軌跡データ生成部119は、生成したデータを走行軌跡データ送信部120に送る。   The travel locus data generation unit 119 generates data indicating the locus on which the vehicle 200A has traveled. Specifically, when the travel locus data generation unit 119 receives data indicating the position of the vehicle 200A on the earth from the position data input reception unit 116, the travel locus data generation unit 119 is based on a change in a value indicating the position of the vehicle 200A on the earth. Data indicating the trajectory traveled by the vehicle 200A is generated. In addition, when the travel locus data generation unit 119 cannot receive the data indicating the position of the vehicle 200A on the earth from the position data input reception unit 116, the travel locus data generation unit 119 displays the data indicating the three-dimensional angle and acceleration of the vehicle 200A as the three-dimensional data. Data is received from the input receiving unit 117 and data indicating the speed of each wheel of the vehicle 200 </ b> A is received from the vehicle speed data input receiving unit 118. Then, the traveling locus data generation unit 119 indicates the locus on which the vehicle 200A has traveled based on the change in the value indicating the three-dimensional angle and acceleration of the vehicle 200A and the change in the value indicating the speed of each wheel of the vehicle 200A. Generate data. Then, the travel locus data generation unit 119 sends the generated data to the travel locus data transmission unit 120.

走行軌跡データ送信部120は、車両200Aが走行した軌跡を示すデータを車載コントローラ130及び各車載コントローラ150に送信する。具体的には、走行軌跡データ送信部120は、車両200Aが走行した軌跡を示すデータを走行軌跡データ生成部119から受け取ると、そのデータを車載コントローラ130及び各車載コントローラ150に送信する。   The travel locus data transmission unit 120 transmits data indicating the locus of travel of the vehicle 200 </ b> A to the in-vehicle controller 130 and each in-vehicle controller 150. Specifically, when the traveling locus data transmission unit 120 receives data indicating the locus on which the vehicle 200 </ b> A has traveled from the traveling locus data generation unit 119, the traveling locus data transmission unit 120 transmits the data to the in-vehicle controller 130 and each in-vehicle controller 150.

図6は、車載コントローラ130のブロック構成の一例を示す。車載コントローラ130は、映像データ受信部131、映像データ出力部132、制御データ入力受付部133、制御データ送信部134、走行軌跡データ受信部135、操縦制御部136、経路算出部137、誤差判定部138、及び停止指示データ送信部139を有する。以下に、各構成要素の機能及び動作を説明する。   FIG. 6 shows an example of a block configuration of the in-vehicle controller 130. The in-vehicle controller 130 includes a video data reception unit 131, a video data output unit 132, a control data input reception unit 133, a control data transmission unit 134, a travel locus data reception unit 135, a steering control unit 136, a route calculation unit 137, and an error determination unit. 138 and a stop instruction data transmission unit 139. The function and operation of each component will be described below.

映像データ受信部131は、ビデオカメラ202Aによって撮影された映像を示すデータを車載コントローラ110から受信する。具体的には、映像データ受信部131は、映像を示すデータを車載コントローラ110から受信すると、そのデータを映像データ出力部132に送る。   The video data receiving unit 131 receives data indicating video captured by the video camera 202 </ b> A from the in-vehicle controller 110. Specifically, when receiving video data from the in-vehicle controller 110, the video data receiving unit 131 sends the data to the video data output unit 132.

映像データ出力部123は、ビデオカメラ202Aによって撮影された映像を示すデータをディスプレイ203に出力する。具体的には、映像データ出力部123は、映像を示すデータを映像データ受信部131から受け取ると、そのデータをディスプレイ203に出力する。   The video data output unit 123 outputs data indicating video captured by the video camera 202 </ b> A to the display 203. Specifically, when the video data output unit 123 receives data indicating video from the video data reception unit 131, the video data output unit 123 outputs the data to the display 203.

制御データ入力受付部133は、ジョイスティック204が操作されたときに、その操作内容を示すデータの入力を受け付ける。具体的には、制御データ入力受付部133は、ジョイスティック204から出力されたジョイスティック204の操作内容を示すデータの入力を受け付けると、そのデータを、車両200Aの操縦を制御するためのデータとして、制御データ送信部134、及び経路算出部140に送る。   When the joystick 204 is operated, the control data input receiving unit 133 receives input of data indicating the operation content. Specifically, when the control data input accepting unit 133 accepts input of data indicating the operation content of the joystick 204 output from the joystick 204, the control data input accepting unit 133 controls the data as data for controlling the operation of the vehicle 200A. The data is sent to the data transmission unit 134 and the route calculation unit 140.

制御データ送信部134は、車両200Aの操縦を制御するためのデータを車載コントローラ110に送信する。具体的には、制御データ送信部134は、車両200Aの操縦を制御するためのデータを制御データ入力受付部133から受け取ると、そのデータを車載コントローラ110に送信する。   The control data transmission unit 134 transmits data for controlling the operation of the vehicle 200 </ b> A to the in-vehicle controller 110. Specifically, when control data transmission unit 134 receives data for controlling the operation of vehicle 200A from control data input reception unit 133, control data transmission unit 134 transmits the data to in-vehicle controller 110.

位置データ入力受付部135は、GPS受信機205Bによって特定された地球上における車両200Bの位置を示すデータの入力を受け付ける。具体的には、位置データ入力受付部135は、GSP受信機205Bから出力された地球上における車両200Bの位置を示すデータの入力を受け付けると、そのデータを操縦制御部139に送る。   The position data input receiving unit 135 receives input of data indicating the position of the vehicle 200B on the earth specified by the GPS receiver 205B. Specifically, when the position data input receiving unit 135 receives an input of data indicating the position of the vehicle 200B on the earth output from the GSP receiver 205B, the position data input receiving unit 135 sends the data to the steering control unit 139.

3次元データ入力受付部136は、IMU206Bによって検出された車両200Bの3次元の角度と加速度を示すデータの入力を受け付ける。具体的には、3次元データ入力受付部136は、IMU206Bから出力された車両200Bの3次元の角度と加速度を示すデータの入力を受け付けると、そのデータを操縦制御部139に送る。   The three-dimensional data input receiving unit 136 receives input of data indicating the three-dimensional angle and acceleration of the vehicle 200B detected by the IMU 206B. Specifically, when the three-dimensional data input receiving unit 136 receives input of data indicating the three-dimensional angle and acceleration of the vehicle 200B output from the IMU 206B, the three-dimensional data input receiving unit 136 sends the data to the steering control unit 139.

車速データ入力受付部137は、車速検出器207B、車速検出器208B、車速検出器209B、及び車速検出器210Bによってそれぞれ検出された車両200Bの各車輪の速度を示すデータの入力を受け付ける。具体的には、車速データ入力受付部137は、車速検出器207B、車速検出器208B、車速検出器209B、及び車速検出器210Bからそれぞれ出力された車両200Bの各車輪の速度を示すデータの入力を受け付けると、そのデータを操縦制御部139に送る。   The vehicle speed data input receiving unit 137 receives input of data indicating the speed of each wheel of the vehicle 200B detected by the vehicle speed detector 207B, the vehicle speed detector 208B, the vehicle speed detector 209B, and the vehicle speed detector 210B. Specifically, the vehicle speed data input receiving unit 137 inputs data indicating the speed of each wheel of the vehicle 200B output from the vehicle speed detector 207B, the vehicle speed detector 208B, the vehicle speed detector 209B, and the vehicle speed detector 210B. Is received, the data is sent to the steering control unit 139.

走行軌跡データ受信部138は、車両200Aが走行した軌跡を示すデータを車載コントローラ110から受信する。具体的には、走行軌跡データ受信部138は、車両200Aが走行した軌跡を示すデータを車載コントローラ110から受信すると、そのデータを操縦制御部139に送る。   The travel locus data receiving unit 138 receives data indicating the locus traveled by the vehicle 200 </ b> A from the in-vehicle controller 110. Specifically, when the traveling locus data receiving unit 138 receives data indicating the locus of traveling of the vehicle 200 </ b> A from the in-vehicle controller 110, the traveling locus data receiving unit 138 sends the data to the steering control unit 139.

操縦制御部139は、車両200Aが走行した軌跡に沿って車両200Bを走行させるべく、車両200Bの操縦を制御する。具体的には、操縦制御部139は、地球上における車両200Bの位置を示すデータを位置データ入力受付部135から受け取る。また、操縦制御部139は、地球上における車両200Bの位置を示すデータを位置データ入力受付部135から受け取ることができない場合、車両200Bの3次元の角度と加速度を示すデータを3次元データ入力受付部136から受け取り、車両200Bの各車輪の速度を示すデータを車速データ入力受付部137から受け取る。そして、操縦制御部139は、車両200Aが走行した軌跡を示すデータを走行軌跡データ受信部138から受け取ると、車両200Aが走行した軌跡に沿って車両200Bを走行させるべく、動作を制御するためのデータをステアリングアクチュエータ211B、アクセルアクチュエータ212B、ブレーキアクチュエータ213B、及びシフトチェンジアクチュエータ214Bに出力する。   The steering control unit 139 controls the steering of the vehicle 200B so that the vehicle 200B travels along the trajectory traveled by the vehicle 200A. Specifically, the steering control unit 139 receives data indicating the position of the vehicle 200B on the earth from the position data input receiving unit 135. Further, when the operation control unit 139 cannot receive data indicating the position of the vehicle 200B on the earth from the position data input receiving unit 135, the operation control unit 139 receives data indicating the three-dimensional angle and acceleration of the vehicle 200B. Data received from unit 136 and data indicating the speed of each wheel of vehicle 200 </ b> B is received from vehicle speed data input receiving unit 137. When the steering control unit 139 receives data indicating the trajectory traveled by the vehicle 200A from the travel trajectory data reception unit 138, the operation control unit 139 controls the operation to travel the vehicle 200B along the trajectory traveled by the vehicle 200A. Data is output to the steering actuator 211B, the accelerator actuator 212B, the brake actuator 213B, and the shift change actuator 214B.

また、操縦制御部139は、走行軌跡データ受信部138がデータを受信することができなくなった場合、車両200Bを停止させるべく、車両200Bの操縦を制御する。具体的には、操縦制御部139は、所定時間以上の間、走行軌跡データ受信部138からデータを受け取ることができない場合、車両200Bを停止させるべく、動作を制御するためのデータをステアリングアクチュエータ211B、アクセルアクチュエータ212B、ブレーキアクチュエータ213B、及びシフトチェンジアクチュエータ214Bに出力する。   In addition, the steering control unit 139 controls the steering of the vehicle 200B in order to stop the vehicle 200B when the travel locus data receiving unit 138 cannot receive the data. Specifically, when the steering control unit 139 cannot receive data from the travel locus data receiving unit 138 for a predetermined time or longer, the steering control unit 139 transmits data for controlling the operation to stop the vehicle 200B. , Output to the accelerator actuator 212B, the brake actuator 213B, and the shift change actuator 214B.

また、操縦制御部139は、車両200Aが走行すべき経路として算出した経路と、車両200Aが実際に走行した軌跡との誤差が閾値以上であった場合、車両200Bを停止させるべく、車両200Bの操縦を制御する。具体的には、操縦制御部139は、車両200Aが走行すべき経路として算出した経路と、車両200Aが実際に走行した軌跡との誤差が所定の閾値を超えたことを示すデータを誤差判定部141から受け取ると、車両200Bを停止させるべく、動作を制御するためのデータをステアリングアクチュエータ211B、アクセルアクチュエータ212B、ブレーキアクチュエータ213B、及びシフトチェンジアクチュエータ214Bに出力する。   In addition, when the error between the route calculated as the route on which the vehicle 200A should travel and the trajectory on which the vehicle 200A actually traveled is greater than or equal to the threshold, the steering control unit 139 is configured to stop the vehicle 200B. Control the maneuver. Specifically, the steering control unit 139 generates data indicating that the error between the route calculated as the route on which the vehicle 200A should travel and the locus on which the vehicle 200A actually traveled has exceeded a predetermined threshold. 141, data for controlling the operation is output to the steering actuator 211B, the accelerator actuator 212B, the brake actuator 213B, and the shift change actuator 214B in order to stop the vehicle 200B.

経路算出部140は、車両200Aが走行すべき経路を算出する。具体的には、経路算出部140は、車両200Aの操縦を制御するためのデータを制御データ入力受付部133から受け取ると、車両200Aが走行すべき経路を算出し、算出したデータを誤差判定部141に送る。   The route calculation unit 140 calculates a route on which the vehicle 200A should travel. Specifically, when the route calculation unit 140 receives data for controlling the operation of the vehicle 200A from the control data input reception unit 133, the route calculation unit 140 calculates a route that the vehicle 200A should travel and uses the calculated data as an error determination unit. 141.

誤差判定部141は、車両200Aが走行すべき経路として算出された経路と、車両200Aが走行した軌跡とを比較し、その誤差が所定の閾値を超えたか否かを判定する。具体的には、誤差判定部141は、車両200Aが走行すべき経路を示すデータを経路算出部140から受け取る。そして、誤差判定部141は、車両200Aが走行した軌跡を示すデータを走行軌跡データ受信部138から受け取ると、車両200Aが走行すべき経路として算出された経路と、車両200Aが走行した軌跡とを比較し、その誤差が所定の閾値を超えたか否かを判定する。そして、誤差判定部141は、誤差が所定の閾値を超えたと判定した場合、その旨を示すデータを操縦制御部139、及び停止指示データ送信部142に送る。   The error determination unit 141 compares the route calculated as the route on which the vehicle 200A should travel with the trajectory on which the vehicle 200A has traveled, and determines whether or not the error exceeds a predetermined threshold. Specifically, error determination unit 141 receives data indicating a route on which vehicle 200A should travel from route calculation unit 140. When the error determination unit 141 receives data indicating the trajectory traveled by the vehicle 200A from the travel trajectory data reception unit 138, the error determination unit 141 calculates the route calculated as the route on which the vehicle 200A should travel and the trajectory traveled by the vehicle 200A. A comparison is made to determine whether the error exceeds a predetermined threshold. When the error determination unit 141 determines that the error exceeds a predetermined threshold, the error determination unit 141 transmits data indicating that to the steering control unit 139 and the stop instruction data transmission unit 142.

停止指示データ送信部142は、車両200を停止させるよう指示する旨のデータを各車載コントローラ150に送信する。具体的には、停止指示データ送信部142は、車両200Aが走行すべき経路として算出した経路と、車両200Aが実際に走行した軌跡との誤差が所定の閾値を超えたことを示すデータを誤差判定部141から受け取ると、車両200を停止させるよう指示する旨のデータを各車載コントローラ150に送信する。   The stop instruction data transmission unit 142 transmits data indicating that the vehicle 200 is to be stopped to each in-vehicle controller 150. Specifically, the stop instruction data transmission unit 142 generates data indicating that the error between the route calculated as the route on which the vehicle 200A should travel and the locus on which the vehicle 200A actually traveled exceeds a predetermined threshold. When received from the determination unit 141, data indicating that the vehicle 200 is to be stopped is transmitted to each in-vehicle controller 150.

図7は、車載コントローラ150aのブロック構成の一例を示す。車載コントローラ150aは、位置データ入力受付部151a、3次元データ入力受付部152a、車速データ入力受付部153a、走行軌跡データ受信部154a、停止指示データ受信部155a、及び操縦制御部156aを有する。以下に、各構成要素の機能及び動作を説明する。   FIG. 7 shows an example of a block configuration of the in-vehicle controller 150a. The in-vehicle controller 150a includes a position data input receiving unit 151a, a three-dimensional data input receiving unit 152a, a vehicle speed data input receiving unit 153a, a travel locus data receiving unit 154a, a stop instruction data receiving unit 155a, and a steering control unit 156a. The function and operation of each component will be described below.

なお、車載コントローラ150a以外の車載コントローラ150b、c、・・・も、車載コントローラ150aが有する構成要素と同じ構成要素を有する。以後の説明では、車載コントローラ150が有する構成要素がいずれの車載コントローラ150の構成要素であるかを区別する場合には、各構成要素を有する車載コントローラ150と同じ添え字(a、b、c、・・・)を各構成要素の末尾に付して区別する。例えば、位置データ入力受付部151a、位置データ入力受付部151b、及び位置データ入力受付部151cは、それぞれ車載コントローラ150a、車載コントローラ150b、及び車載コントローラ150cの構成要素であることを示す。   The vehicle-mounted controllers 150b, c,... Other than the vehicle-mounted controller 150a also have the same components as the components included in the vehicle-mounted controller 150a. In the following description, when distinguishing which component of the vehicle-mounted controller 150 the component of the vehicle-mounted controller 150 is, the same subscripts (a, b, c, ...) are added to the end of each component to distinguish them. For example, the position data input receiving unit 151a, the position data input receiving unit 151b, and the position data input receiving unit 151c are components of the in-vehicle controller 150a, the in-vehicle controller 150b, and the in-vehicle controller 150c, respectively.

また、以後の説明において、添え字が付されていない構成要素の機能及び動作は、同じ符号が付されたいずれの構成要素の機能及び動作を示す。例えば、位置データ入力受付部151で説明された機能及び動作は、位置データ入力受付部151a、位置データ入力受付部151b、位置データ入力受付部151c、・・・の機能及び動作を示す。   Further, in the following description, the function and operation of a component that is not given a subscript indicates the function and operation of any component that is assigned the same reference numeral. For example, the functions and operations described in the position data input receiving unit 151 indicate the functions and operations of the position data input receiving unit 151a, the position data input receiving unit 151b, the position data input receiving unit 151c,.

位置データ入力受付部151aは、GPS受信機205aによって特定された地球上における車両200aの位置を示すデータの入力を受け付ける。具体的には、位置データ入力受付部151aは、GSP受信機205aから出力された地球上における車両200aの位置を示すデータの入力を受け付けると、そのデータを操縦制御部156aに送る。   The position data input receiving unit 151a receives an input of data indicating the position of the vehicle 200a on the earth specified by the GPS receiver 205a. Specifically, when the position data input receiving unit 151a receives an input of data indicating the position of the vehicle 200a on the earth output from the GSP receiver 205a, the position data input receiving unit 151a sends the data to the steering control unit 156a.

3次元データ入力受付部152aは、IMU206aによって検出された車両200aの3次元の角度と加速度を示すデータの入力を受け付ける。具体的には、3次元データ入力受付部152aは、IMU206aから出力された車両200aの3次元の角度と加速度を示すデータの入力を受け付けると、そのデータを操縦制御部156aに送る。   The three-dimensional data input reception unit 152a receives input of data indicating the three-dimensional angle and acceleration of the vehicle 200a detected by the IMU 206a. Specifically, when the three-dimensional data input receiving unit 152a receives input of data indicating the three-dimensional angle and acceleration of the vehicle 200a output from the IMU 206a, the three-dimensional data input receiving unit 152a sends the data to the steering control unit 156a.

車速データ入力受付部153aは、車速検出器207a、車速検出器208a、車速検出器209a、及び車速検出器210aによってそれぞれ検出された車両200aの各車輪の速度を示すデータの入力を受け付ける。具体的には、車速データ入力受付部153aは、車速検出器207a、車速検出器208a、車速検出器209a、及び車速検出器210aからそれぞれ出力された車両200aの各車輪の速度を示すデータの入力を受け付けると、そのデータを操縦制御部156aに送る。   The vehicle speed data input receiving unit 153a receives input of data indicating the speed of each wheel of the vehicle 200a detected by the vehicle speed detector 207a, the vehicle speed detector 208a, the vehicle speed detector 209a, and the vehicle speed detector 210a. Specifically, the vehicle speed data input receiving unit 153a inputs data indicating the speed of each wheel of the vehicle 200a output from the vehicle speed detector 207a, the vehicle speed detector 208a, the vehicle speed detector 209a, and the vehicle speed detector 210a. Is sent to the steering control unit 156a.

走行軌跡データ受信部154aは、車両200Aが走行した軌跡を示すデータを車載コントローラ110から受信する。具体的には、走行軌跡データ受信部154aは、車両200Aが走行した軌跡を示すデータを車載コントローラ110から受信すると、そのデータを操縦制御部156aに送る。   The traveling locus data receiving unit 154a receives data indicating the locus on which the vehicle 200A has traveled from the in-vehicle controller 110. Specifically, when the traveling locus data receiving unit 154a receives data indicating the locus on which the vehicle 200A has traveled from the in-vehicle controller 110, the traveling locus data receiving unit 154a sends the data to the steering control unit 156a.

停止指示データ受信部155aは、車両200aを停止させるよう指示する旨のデータを車載コントローラ130から受信する。具体的には、停止指示データ受信部155aは、車両200aを停止させるよう指示する旨のデータを車載コントローラ130から受信すると、そのデータを操縦制御部156aに送る。   The stop instruction data receiving unit 155a receives data indicating that the vehicle 200a is to be stopped from the in-vehicle controller 130. Specifically, when the stop instruction data receiving unit 155a receives data indicating that the vehicle 200a is to be stopped from the in-vehicle controller 130, the stop instruction data receiving unit 155a sends the data to the steering control unit 156a.

操縦制御部156aは、車両200Aが走行した軌跡に沿って車両200をが走行させるべく、車両200aの操縦を制御する。具体的には、操縦制御部156aは、地球上における車両200aの位置を示すデータを位置データ入力受付部151aから受け取る。また、操縦制御部156aは、地球上における車両200aの位置を示すデータを位置データ入力受付部151aから受け取ることができない場合、車両200aの3次元の角度と加速度を示すデータを3次元データ入力受付部152aから受け取り、車両200aの各車輪の速度を示すデータを車速データ入力受付部153aから受け取る。そして、操縦制御部156aは、車両200Aが走行した軌跡を示すデータを走行軌跡データ受信部154aから受け取ると、車両200Aが走行した軌跡に沿って車両200aを走行させるべく、動作を制御するためのデータをステアリングアクチュエータ211a、アクセルアクチュエータ212a、ブレーキアクチュエータ213a、及びシフトチェンジアクチュエータ214aに出力する。   The maneuvering control unit 156a controls the maneuvering of the vehicle 200a so that the vehicle 200 travels along the trajectory traveled by the vehicle 200A. Specifically, the steering control unit 156a receives data indicating the position of the vehicle 200a on the earth from the position data input receiving unit 151a. Further, when the steering control unit 156a cannot receive data indicating the position of the vehicle 200a on the earth from the position data input receiving unit 151a, the steering control unit 156a receives data indicating the three-dimensional angle and acceleration of the vehicle 200a. Data received from the unit 152a and data indicating the speed of each wheel of the vehicle 200a is received from the vehicle speed data input receiving unit 153a. When the steering control unit 156a receives data indicating the trajectory traveled by the vehicle 200A from the travel trajectory data reception unit 154a, the operation control unit 156a controls the operation to travel the vehicle 200a along the trajectory traveled by the vehicle 200A. Data is output to the steering actuator 211a, the accelerator actuator 212a, the brake actuator 213a, and the shift change actuator 214a.

また、操縦制御部156aは、走行軌跡データ受信部154aがデータを受信することができなくなった場合、車両200aを停止させるべく、車両200aの操縦を制御する。具体的には、操縦制御部156aは、所定時間以上の間、走行軌跡データ受信部154aからデータを受け取ることができない場合、車両200aを停止させるべく、動作を制御するためのデータをステアリングアクチュエータ211a、アクセルアクチュエータ212a、ブレーキアクチュエータ213a、及びシフトチェンジアクチュエータ214aに出力する。   In addition, the steering control unit 156a controls the steering of the vehicle 200a to stop the vehicle 200a when the travel locus data receiving unit 154a cannot receive the data. Specifically, when the steering control unit 156a cannot receive data from the travel locus data receiving unit 154a for a predetermined time or longer, the steering control unit 156a transmits data for controlling the operation to stop the vehicle 200a. And output to the accelerator actuator 212a, the brake actuator 213a, and the shift change actuator 214a.

また、操縦制御部156aは、車両200aの走行を停止する旨の指示を受けると、車両200aを停止させるべく、車両200aの操縦を制御する。具体的には、操縦制御部156aは、車両200aを停止させるよう指示する旨のデータを停止指示データ受信部155aから受け取ると、車両200aを停止させるべく、動作を制御するためのデータをステアリングアクチュエータ211a、アクセルアクチュエータ212a、ブレーキアクチュエータ213a、及びシフトチェンジアクチュエータ214aに出力する。   Further, upon receiving an instruction to stop traveling of the vehicle 200a, the steering control unit 156a controls the steering of the vehicle 200a so as to stop the vehicle 200a. Specifically, when the steering control unit 156a receives data indicating that the vehicle 200a is to be stopped from the stop instruction data receiving unit 155a, the steering control unit 156a transmits data for controlling the operation to stop the vehicle 200a. 211a, accelerator actuator 212a, brake actuator 213a, and shift change actuator 214a.

図8は、車載コントローラ110、車載コントローラ130、及び車載コントローラ150aの動作シーケンスの一例を示す。各車両200の隊列走行を開始するにあたり、映像データ入力受付部112は、ビデオカメラ202Aによって撮影された映像を示すデータの入力を受け付ける(S101)。映像データ入力受付部112が入力を受け付けるデータは、例えば、映像を電気信号化したものである。   FIG. 8 shows an example of an operation sequence of the in-vehicle controller 110, the in-vehicle controller 130, and the in-vehicle controller 150a. In starting the platooning of each vehicle 200, the video data input receiving unit 112 receives input of data indicating a video shot by the video camera 202A (S101). The data that the video data input receiving unit 112 receives input is, for example, video converted into an electrical signal.

そして、映像データ送信部113は、映像データ入力受付部112が入力を受け付けたデータを車載コントローラ130に送信する(S102)。映像データ受信部131は、この送信されたデータを受信する。具体的には、映像データ送信部113が送信したデータは、通信アンテナ201A、通信回線170、及び通信アンテナ201Bを順に経由して伝送され、映像データ受信部131によって受信される。   Then, the video data transmitting unit 113 transmits the data received by the video data input receiving unit 112 to the in-vehicle controller 130 (S102). The video data receiving unit 131 receives the transmitted data. Specifically, the data transmitted by the video data transmission unit 113 is transmitted via the communication antenna 201A, the communication line 170, and the communication antenna 201B in order, and is received by the video data reception unit 131.

そして、映像データ出力部132は、映像データ受信部131が受信したデータをディスプレイ203に出力する(S103)。このようにして、ディスプレイ203には、ビデオカメラ202Aによって撮影された映像が表示されることになる。そして、車両200Bに乗車している搭乗者は、ディスプレイ203に表示されている映像を見ながら、ジョイスティック204を利用して車両200Aを操縦する。   Then, the video data output unit 132 outputs the data received by the video data receiving unit 131 to the display 203 (S103). In this way, the video shot by the video camera 202A is displayed on the display 203. Then, a passenger on the vehicle 200B controls the vehicle 200A using the joystick 204 while watching the video displayed on the display 203.

搭乗者がジョイスティック204を利用して車両200Aの操縦を開始すると、制御データ入力受付部133は、車両200Aを制御するためのデータとして、ジョイスティック204の操作内容を示すデータの入力を受け付ける(S104)。制御データ入力受付部133が入力を受け付けるデータは、例えば、ジョイスティック204のレバーの操作方向とその操作量を示す情報や、押下操作されたジョイスティック204のボタンを識別する情報を含むデータである。   When the occupant starts maneuvering the vehicle 200A using the joystick 204, the control data input accepting unit 133 accepts input of data indicating the operation content of the joystick 204 as data for controlling the vehicle 200A (S104). . The data that the control data input receiving unit 133 receives input is, for example, data including information indicating the operation direction and the operation amount of the lever of the joystick 204 and information identifying the button of the joystick 204 that has been pressed.

そして、制御データ送信部134は、制御データ入力受付部133が入力を受け付けたデータを車載コントローラ110に送信する(S105)。制御データ受信部114は、この送信されたデータを受信する。具体的には、制御データ送信部134が送信したデータは、通信アンテナ201B、通信回線170、及び通信アンテナ201Aを順に経由して伝送され、制御データ受信部114によって受信される。   Then, the control data transmission unit 134 transmits the data received by the control data input reception unit 133 to the in-vehicle controller 110 (S105). The control data receiving unit 114 receives the transmitted data. Specifically, the data transmitted by the control data transmission unit 134 is transmitted via the communication antenna 201B, the communication line 170, and the communication antenna 201A in order, and is received by the control data reception unit 114.

そして、操縦制御部115は、制御データ受信部114が受信したデータによって示される情報に従って、ステアリングアクチュエータ211A、アクセルアクチュエータ212A、ブレーキアクチュエータ213A、及びシフトチェンジアクチュエータ214Aの動作を制御する(S106)。このようにして、車両200Aは、車両200Bに搭乗している搭乗者によって遠隔操作されて走行することになる。   Then, the steering control unit 115 controls the operations of the steering actuator 211A, the accelerator actuator 212A, the brake actuator 213A, and the shift change actuator 214A according to the information indicated by the data received by the control data receiving unit 114 (S106). In this way, the vehicle 200A travels by being remotely operated by a passenger boarding the vehicle 200B.

車両200Aが走行を開始すると、走行軌跡データ生成部119は、車両200Aが走行した軌跡を示すデータを生成する(S107)。走行軌跡データ生成部119が生成するデータは、地球上における車両200Aの位置の遷移を示すデータである。具体的には、走行軌跡データ生成部119が生成するデータは、車両200Aが存在していた緯度及び経度を計測又は算出し、その値の経時的な変化を示すデータである。   When the vehicle 200A starts traveling, the traveling locus data generation unit 119 generates data indicating the locus on which the vehicle 200A has traveled (S107). The data generated by the travel locus data generation unit 119 is data indicating the transition of the position of the vehicle 200A on the earth. Specifically, the data generated by the travel locus data generation unit 119 is data that measures or calculates the latitude and longitude in which the vehicle 200A existed, and indicates the change over time of the value.

そして、走行軌跡データ送信部120は、走行軌跡データ生成部119が生成したデータを、車載コントローラ130、及び各車載コントローラ150aに送信する(S108)。走行軌跡データ受信部138、及び走行軌跡データ受信部154aは、この送信されたデータをそれぞれ受信する。具体的には、走行軌跡データ送信部120が送信したデータは、通信アンテナ201A、通信回線170、及び通信アンテナ201Bを順に経由して伝送され、走行軌跡データ受信部138によって受信される。また、走行軌跡データ送信部120が送信したデータは、通信アンテナ201A、通信回線170、及び通信アンテナ201aを順に経由して伝送され、走行軌跡データ受信部154aによって受信される。   Then, the traveling locus data transmission unit 120 transmits the data generated by the traveling locus data generation unit 119 to the in-vehicle controller 130 and each in-vehicle controller 150a (S108). The traveling locus data receiving unit 138 and the traveling locus data receiving unit 154a receive the transmitted data, respectively. Specifically, the data transmitted by the travel locus data transmission unit 120 is transmitted via the communication antenna 201A, the communication line 170, and the communication antenna 201B in order, and is received by the travel locus data reception unit 138. The data transmitted by the travel locus data transmission unit 120 is transmitted via the communication antenna 201A, the communication line 170, and the communication antenna 201a in order, and is received by the travel locus data reception unit 154a.

そして、操縦制御部139は、走行軌跡データ受信部138が受信したデータによって示される車両200Aが走行した軌跡に沿って、車両200Bを走行させるべく、ステアリングアクチュエータ211B、アクセルアクチュエータ212B、ブレーキアクチュエータ213B、及びシフトチェンジアクチュエータ214Bの動作を制御する(S109)。このようにして、車両200Bは、車両200Aが走行した軌跡に沿って走行することになる。   Then, the steering control unit 139 causes the steering actuator 211B, the accelerator actuator 212B, the brake actuator 213B, and the vehicle to travel the vehicle 200B along the trajectory traveled by the vehicle 200A indicated by the data received by the travel trajectory data receiving unit 138. Then, the operation of the shift change actuator 214B is controlled (S109). Thus, the vehicle 200B travels along the trajectory traveled by the vehicle 200A.

同様に、操縦制御部156aは、走行軌跡データ受信部154aが受信したデータによって示される車両200Aが走行した軌跡に沿って、車両200aを走行させるべく、ステアリングアクチュエータ211a、アクセルアクチュエータ212a、ブレーキアクチュエータ213a、及びシフトチェンジアクチュエータ214aの動作を制御する(S109)。このようにして、車両200aは、車両200Aが走行した軌跡に沿って走行することになる。   Similarly, the steering control unit 156a causes the steering actuator 211a, the accelerator actuator 212a, and the brake actuator 213a to drive the vehicle 200a along the trajectory traveled by the vehicle 200A indicated by the data received by the travel trajectory data receiving unit 154a. And the operation of the shift change actuator 214a is controlled (S109). Thus, the vehicle 200a travels along the trajectory traveled by the vehicle 200A.

この動作シーケンスでは、車載コントローラ110が車載コントローラ130から受信した制御データのみに基づいて、車両200Aの操縦を制御する場合について説明したが、予め設定された経路に沿って車両200Aの操縦を制御することもできる。その場合、操縦制御部115は、経路情報格納部111が格納している経路の情報を読み出し、その経路に沿って車両200Aを走行させるべく、ステアリングアクチュエータ211A、アクセルアクチュエータ212A、ブレーキアクチュエータ213A、及びシフトチェンジアクチュエータ214Aの動作を制御する。そして、車載コントローラ110は、制御データを車載コントローラ130から受信すると、その制御データに基づく処理を優先してステアリングアクチュエータ211A、アクセルアクチュエータ212A、ブレーキアクチュエータ213A、及びシフトチェンジアクチュエータ214Aの動作を制御する。   In this operation sequence, the case where the in-vehicle controller 110 controls the operation of the vehicle 200A based only on the control data received from the in-vehicle controller 130 has been described. However, the operation of the vehicle 200A is controlled along a preset route. You can also In that case, the steering control unit 115 reads the route information stored in the route information storage unit 111, and in order to drive the vehicle 200A along the route, the steering actuator 211A, the accelerator actuator 212A, the brake actuator 213A, and The operation of shift change actuator 214A is controlled. When receiving the control data from the in-vehicle controller 130, the in-vehicle controller 110 controls the operations of the steering actuator 211A, the accelerator actuator 212A, the brake actuator 213A, and the shift change actuator 214A with priority given to processing based on the control data.

図9は、車両200Aの走行に問題が発生した場合の車載コントローラ110、車載コントローラ130、及び車載コントローラ150aの動作シーケンスの一例を示す。上述したように、走行軌跡データ送信部120は、走行軌跡データ生成部119が生成したデータを車載コントローラ130に送信する(S201)。走行軌跡データ受信部138は、この送信されたデータを受信する。   FIG. 9 shows an example of an operation sequence of the in-vehicle controller 110, the in-vehicle controller 130, and the in-vehicle controller 150a when a problem occurs in the traveling of the vehicle 200A. As described above, the traveling locus data transmission unit 120 transmits the data generated by the traveling locus data generation unit 119 to the in-vehicle controller 130 (S201). The travel locus data receiving unit 138 receives the transmitted data.

一方、経路算出部140は、制御データ入力受付部133が入力を受け付けたデータに基づいて、車両200Aが走行すべき経路を算出する(S202)。例えば、経路算出部140は、車両200Aが走行すべき経路の算出を開始するにあたり、車両200Aが走行を開始するスタート地点の緯度及び経度を取得する。そして、経路算出部140は、制御データ入力受付部133が入力を受け付けたデータによって示されるジョイスティック204の操作情報に基づく操縦がなされた場合に、車両200Aがスタート地点を起点として走行すべき経路を算出する。   On the other hand, the route calculation unit 140 calculates a route on which the vehicle 200A should travel based on the data received by the control data input reception unit 133 (S202). For example, when starting calculation of a route on which the vehicle 200A should travel, the route calculation unit 140 acquires the latitude and longitude of the start point at which the vehicle 200A starts traveling. Then, the route calculation unit 140 determines the route on which the vehicle 200A should travel starting from the start point when the operation is performed based on the operation information of the joystick 204 indicated by the data received by the control data input reception unit 133. calculate.

そして、誤差判定部141は、車両200Aが走行すべき経路として算出された経路と、車両200Aが走行した軌跡とを比較し、その誤差が所定の閾値を超えたか否かを判定する(S203)。制御データ入力受付部133が入力を受け付けたデータに基づいて車両200Aが走行していれば、車両200Aは、経路算出部140が算出した経路に近い経路を走行する筈である。したがって、車両200Aが走行すべき経路と、車両200Aが実際に走行した軌跡との誤差が大きい場合、車両200Aの走行に問題が発生している可能性がある。   Then, the error determination unit 141 compares the route calculated as the route on which the vehicle 200A should travel with the trajectory on which the vehicle 200A has traveled, and determines whether or not the error has exceeded a predetermined threshold (S203). . If the vehicle 200A is traveling based on the data received by the control data input accepting unit 133, the vehicle 200A should travel along a route that is close to the route calculated by the route calculating unit 140. Therefore, if the error between the route on which the vehicle 200A should travel and the locus on which the vehicle 200A actually traveled is large, there may be a problem with the traveling of the vehicle 200A.

誤差が所定の閾値を超えたと誤差判定部141が判定した場合(S203;Yes)、停止指示データ送信部142は、車両200aを停止させるよう指示する旨のデータを車載コントローラ150aに送信する(S204)。停止指示データ受信部154aは、この送信されたデータを受信する。具体的には、停止指示データ送信部142が送信したデータは、通信アンテナB、通信回線170、及び通信アンテナ201aを順に経由して伝送され、停止指示データ受信部154aによって受信される。   When the error determination unit 141 determines that the error exceeds a predetermined threshold (S203; Yes), the stop instruction data transmission unit 142 transmits data indicating that the vehicle 200a is to be stopped to the in-vehicle controller 150a (S204). ). The stop instruction data receiving unit 154a receives the transmitted data. Specifically, the data transmitted by the stop instruction data transmission unit 142 is transmitted via the communication antenna B, the communication line 170, and the communication antenna 201a in order, and is received by the stop instruction data reception unit 154a.

そして、操縦制御部155aは、車両200aを停止させるべく、ステアリングアクチュエータ211a、アクセルアクチュエータ212a、ブレーキアクチュエータ213a、及びシフトチェンジアクチュエータ214aの動作を制御する(S205)。このようにして、車両200aは、停止することになる。   Then, the steering control unit 155a controls the operations of the steering actuator 211a, the accelerator actuator 212a, the brake actuator 213a, and the shift change actuator 214a to stop the vehicle 200a (S205). In this way, the vehicle 200a stops.

一方、誤差が所定の閾値を超えたと誤差判定部141が判定した場合(S203;Yes)、操縦制御部139は、車両200Bを停止させるべく、ステアリングアクチュエータ211B、アクセルアクチュエータ212B、ブレーキアクチュエータ213B、及びシフトチェンジアクチュエータ214Bの動作を制御する(S206)。このようにして、車両200Bは、停止することになる。   On the other hand, when the error determination unit 141 determines that the error exceeds a predetermined threshold (S203; Yes), the steering control unit 139 controls the steering actuator 211B, the accelerator actuator 212B, the brake actuator 213B, and the like to stop the vehicle 200B. The operation of the shift change actuator 214B is controlled (S206). In this way, the vehicle 200B stops.

車両200Aは、車両200Bに乗車している搭乗者がジョイスティック204を利用して停止操作することにより停止する。   The vehicle 200 </ b> A stops when a passenger on the vehicle 200 </ b> B performs a stop operation using the joystick 204.

この動作シーケンスでは、車両200Aが走行すべき経路として算出した経路と、実際に車両200Aが走行した軌跡との誤差が大きい場合に、各車両200を停止すべく制御する例について説明した。この例以外にも、例えば、通信の障害は、隊列走行を継続する阻害要因となり得る。そこで、操縦制御部115は、制御データ受信部114がデータを受信することができなくなった場合、車両200Aを停止させるべく、ステアリングアクチュエータ211A、アクセルアクチュエータ212A、ブレーキアクチュエータ213A、及びシフトチェンジアクチュエータ214Aの動作を制御する。このようにして、車両200Aは、通信の障害が発生すると停止することになる。   In this operation sequence, an example has been described in which each vehicle 200 is controlled to stop when there is a large error between the route calculated as the route on which the vehicle 200A should travel and the locus on which the vehicle 200A actually traveled. In addition to this example, for example, a communication failure can be a hindrance to continue platooning. Therefore, when the control data receiving unit 114 becomes unable to receive data, the steering control unit 115 sets the steering actuator 211A, the accelerator actuator 212A, the brake actuator 213A, and the shift change actuator 214A to stop the vehicle 200A. Control the behavior. In this manner, the vehicle 200A stops when a communication failure occurs.

同様に、操縦制御部139は、走行軌跡データ受信部138がデータを受信することができなくなった場合、車両200Bを停止させるべく、ステアリングアクチュエータ211B、アクセルアクチュエータ212B、ブレーキアクチュエータ213B、及びシフトチェンジアクチュエータ214Bの動作を制御する。このようにして、車両200Bは、通信の障害が発生すると停止することになる。   Similarly, the steering control unit 139 determines that the steering actuator 211B, the accelerator actuator 212B, the brake actuator 213B, and the shift change actuator stop the vehicle 200B when the travel locus data receiving unit 138 can no longer receive data. The operation of 214B is controlled. In this way, the vehicle 200B stops when a communication failure occurs.

同様に、操縦制御部156aは、走行軌跡データ受信部154aがデータを受信することができなくなった場合、車両200aを停止させるべく、ステアリングアクチュエータ211a、アクセルアクチュエータ212a、ブレーキアクチュエータ213a、及びシフトチェンジアクチュエータ214aの動作を制御する。このようにして、車両200aは、通信の障害が発生すると停止することになる。   Similarly, the steering control unit 156a has a steering actuator 211a, an accelerator actuator 212a, a brake actuator 213a, and a shift change actuator to stop the vehicle 200a when the travel locus data receiving unit 154a cannot receive data. The operation of 214a is controlled. In this manner, the vehicle 200a stops when a communication failure occurs.

図10は、経路情報格納部111が格納しているデータの一例をテーブル形式で示す。経路情報格納部111は、ID、緯度、及び経度を対応付けて格納している。なお、緯度及び経度は、この発明における「先頭の無人車両が走行すべき経路を示す情報」の一例であってよい。   FIG. 10 shows an example of data stored in the path information storage unit 111 in a table format. The route information storage unit 111 stores ID, latitude, and longitude in association with each other. The latitude and longitude may be an example of “information indicating a route on which the leading unmanned vehicle should travel” in the present invention.

IDは、経路データ格納部111が格納している緯度及び経度の組合せを一意に識別するための識別符号であってよい。IDは、車両200Aが走行すべき経路の順となるよう緯度及び経路を識別し得るものであってよいし、そうでなくてもよい。また、IDは、緯度及び経度の組合せによって特定されるランドマーク等の場所を示すような文字列であってよいし、そうでなくてもよい。   The ID may be an identification code for uniquely identifying a combination of latitude and longitude stored in the route data storage unit 111. The ID may or may not identify the latitude and the route so that the vehicle 200A is in the order of the route that the vehicle 200A should travel. Further, the ID may or may not be a character string indicating a place such as a landmark specified by a combination of latitude and longitude.

緯度及び経度は、車両200Aが走行すべき地球上の位置を示す座標であってよい。なお、緯度は、車両200Aが走行すべき地点における天頂の方向と赤道面とのなす角度を示すデータであってよい。同様に、経度は、車両200Aが走行すべき地点と北極・南極を通る大円と、ロンドンの旧グリニッジ天文台を通る大円とのなす角度を示すデータであってよい。   The latitude and longitude may be coordinates indicating a position on the earth where the vehicle 200A should travel. The latitude may be data indicating an angle formed between the zenith direction and the equator plane at a point where the vehicle 200A should travel. Similarly, the longitude may be data indicating an angle between a point where the vehicle 200A should travel, a great circle passing through the North Pole and the South Pole, and a great circle passing through the former Greenwich Observatory in London.

操縦制御部115は、経路情報格納部111が格納しているこれら情報に基づいて、車両200Aを自律的に走行させるべく制御する。例えば、操縦制御部115は、ID「1」〜「5」によってそれぞれ識別される緯度及び経度の位置に沿って、車両200Aを自律的に走行させるべく制御する。この場合、まず、操縦制御部115は、ID「1」によって識別される緯度「35.678573」及び経度「139.767686」の位置に到達するまで、車両200Aを自律的に走行させるべく制御する。例えば、操縦制御部115は、現在地から各IDによって識別される緯度及び軽度の位置まで、車両200Aを直線的に走行させるべく制御する。こうして、車両200Aが緯度「35.678573」及び経度「139.767686」の位置に到達すると、操縦制御115は、ID「2」によって識別される緯度「35.679479」及び経度「139.768329」の位置に到達するまで、車両200Aを自律的に走行させるべく制御する。操縦制御部115は、このような処理を繰り返すことによって、ID「5」によって識別される緯度「35.683832」及び経度「139.769295」の位置まで、車両200Aを自律的に走行させるべく制御する。   The steering control unit 115 controls the vehicle 200A to autonomously travel based on the information stored in the route information storage unit 111. For example, the steering control unit 115 controls the vehicle 200A to autonomously travel along the latitude and longitude positions identified by the IDs “1” to “5”, respectively. In this case, first, the steering control unit 115 performs control so that the vehicle 200A travels autonomously until the position of the latitude “35.678573” and the longitude “139.767686” identified by the ID “1” is reached. . For example, the steering control unit 115 controls the vehicle 200 </ b> A to travel linearly from the current location to the latitude and mild position identified by each ID. Thus, when the vehicle 200A reaches the position of the latitude “35.678573” and the longitude “139.767686”, the steering control 115 performs the latitude “35.679479” and the longitude “139.768329” identified by the ID “2”. Control is performed so that the vehicle 200A travels autonomously until the position is reached. By repeating such processing, the steering control unit 115 performs control so that the vehicle 200A autonomously travels to the positions of the latitude “35.683832” and the longitude “139.769295” identified by the ID “5”. To do.

なお、予め設定される経路は、車両の走行経路を示すものであれば、何でも良い。例えば、予め設定される経路は、緯度と経度を基本とするデータであれば、人に車両を運転させて、GPS受信機205によって得られたデータを経路としたり、衛星写真や航空写真、地図等から走行経路の点列を直線や曲線で補間して生成した位置データを経路としたりすることができる。また、走行すべき経路情報には、より的確に車両の走行を制御するために、緯度と経路に加え、走行路の高さや速度等のデータを追加しておくことが望ましい。   The route set in advance may be anything as long as it indicates the travel route of the vehicle. For example, if the preset route is data based on latitude and longitude, a vehicle is driven by a person and the data obtained by the GPS receiver 205 is used as a route, a satellite photograph, an aerial photograph, a map, etc. For example, position data generated by interpolating a point sequence of a travel route with a straight line or a curve can be used as a route. In addition to the latitude and the route, it is desirable to add data such as the height and speed of the travel route to the route information to be traveled in order to more accurately control the travel of the vehicle.

また、操縦制御部139及び操縦制御部156は、車載コントローラ110から受信した走行軌跡データに基づいて、車両200を自律的に走行させるべく制御する。このとき、操縦制御部139及び操縦制御部156は、走行軌跡データによって示される緯度及び経路を参照する点を除けば、その緯度及び経度の情報に基づいて、操縦制御部115と同様の処理を行う。   In addition, the steering control unit 139 and the steering control unit 156 perform control so that the vehicle 200 autonomously travels based on the travel locus data received from the in-vehicle controller 110. At this time, the maneuvering control unit 139 and the maneuvering control unit 156 perform the same processing as the maneuvering control unit 115 based on the information on the latitude and longitude, except that the latitude and the route indicated by the travel locus data are referred to. Do.

以上説明したように、隊列走行システム100においては、人は、先頭を走行する車両200A以外の後続車両200のうち、いずれか1台の車両200Bに乗車すればよい。よって、隊列走行システム100では、未知の経路や、障害物や危険物が存在するような経路を走行する場合に安全な隊列走行を実現することができる。   As described above, in the convoy travel system 100, a person may get on any one vehicle 200B among the following vehicles 200 other than the vehicle 200A traveling at the head. Therefore, the convoy travel system 100 can realize safe convoy travel when traveling on an unknown route or a route where an obstacle or dangerous object exists.

図11は、車載コントローラ110、車載コントローラ130、及び車載コントローラ150をコンピュータ等の電子情報処理装置でそれぞれ構成した場合のハードウェア構成の一例を示す。車載コントローラ110、車載コントローラ130、及び車載コントローラ150は、CPU(Central Processing Unit)周辺部と、入出力部とを備える。CPU周辺部は、ホスト・コントローラ901により相互に接続されるCPU902、RAM(Random Access Memory)903、グラフィック・コントローラ904、及び表示装置905を有する。入出力部は、入出力コントローラ906によりホスト・コントローラ901に接続される通信インターフェイス907、ハードディスクドライブ908、CD−ROM(Compact Disk Read Only Memory)ドライブ909、入出力コントローラ906に接続されるROM(Read Only Memory)910、フレキシブルディスク・ドライブ911、及び入出力チップ912を有する。   FIG. 11 shows an example of a hardware configuration when the in-vehicle controller 110, the in-vehicle controller 130, and the in-vehicle controller 150 are each configured by an electronic information processing apparatus such as a computer. The in-vehicle controller 110, the in-vehicle controller 130, and the in-vehicle controller 150 include a CPU (Central Processing Unit) peripheral part and an input / output part. The CPU peripheral section includes a CPU 902, a RAM (Random Access Memory) 903, a graphic controller 904, and a display device 905 that are connected to each other by a host controller 901. The input / output unit includes a communication interface 907 connected to the host controller 901 by the input / output controller 906, a hard disk drive 908, a CD-ROM (Compact Disk Read Only Memory) drive 909, and a ROM (Read) connected to the input / output controller 906. Only Memory) 910, flexible disk drive 911, and input / output chip 912.

ホスト・コントローラ901は、RAM903と、高い転送レートでRAM903をアクセスするCPU902、及びグラフィック・コントローラ904とを接続する。CPU902は、ROM910、及びRAM903に格納されたプログラムに基づいて動作して、各部の制御をする。グラフィック・コントローラ904は、CPU902等がRAM903内に設けたフレーム・バッファ上に生成する画像データを取得して、表示装置905上に表示させる。これに代えて、グラフィック・コントローラ904は、CPU902等が生成する画像データを格納するフレーム・バッファを、内部に含んでもよい。   The host controller 901 connects the RAM 903, the CPU 902 that accesses the RAM 903 at a high transfer rate, and the graphic controller 904. The CPU 902 operates based on programs stored in the ROM 910 and the RAM 903 to control each unit. The graphic controller 904 acquires image data generated by the CPU 902 or the like on a frame buffer provided in the RAM 903 and displays the image data on the display device 905. Instead of this, the graphic controller 904 may include a frame buffer for storing image data generated by the CPU 902 or the like.

入出力コントローラ906は、ホスト・コントローラ901と、比較的高速な入出力装置であるハードディスクドライブ908、通信インターフェイス907、CD−ROMドライブ909を接続する。ハードディスクドライブ908は、CPU902が使用するプログラム、及びデータを格納する。通信インターフェイス907は、ネットワーク通信装置991に接続してプログラム又はデータを送受信する。CD−ROMドライブ909は、CD−ROM992からプログラム又はデータを読み取り、RAM903を介してハードディスクドライブ908、及び通信インターフェイス907に提供する。なお、車載コントローラ110、車載コントローラ130、及び車載コントローラ150は、車両200に搭載され、車両200の走行に伴う振動を受けることになる。そのため、プログラムやデータの格納手段としては、ハードディスクドライブ908に代えて、機械的に振動する部品がなく衝撃に強いSSD(Solid State Drive)を用いてもよい。   The input / output controller 906 connects the host controller 901 to the hard disk drive 908, the communication interface 907, and the CD-ROM drive 909, which are relatively high-speed input / output devices. The hard disk drive 908 stores programs and data used by the CPU 902. The communication interface 907 is connected to the network communication device 991 to transmit / receive programs or data. The CD-ROM drive 909 reads a program or data from the CD-ROM 992 and provides it to the hard disk drive 908 and the communication interface 907 via the RAM 903. Note that the in-vehicle controller 110, the in-vehicle controller 130, and the in-vehicle controller 150 are mounted on the vehicle 200 and receive vibrations associated with the traveling of the vehicle 200. Therefore, instead of the hard disk drive 908, an SSD (Solid State Drive) having no mechanical vibration parts and strong against impact may be used as a program or data storage means.

入出力コントローラ906には、ROM910と、フレキシブルディスク・ドライブ911、及び入出力チップ912の比較的低速な入出力装置とが接続される。ROM910は、車載コントローラ110、車載コントローラ130、及び車載コントローラ150が起動時に実行するブート・プログラム、あるいは車載コントローラ110、車載コントローラ130、及び車載コントローラ150のハードウェアに依存するプログラム等を格納する。フレキシブルディスク・ドライブ911は、フレキシブルディスク993からプログラム又はデータを読み取り、RAM903を介してハードディスクドライブ908、及び通信インターフェイス907に提供する。入出力チップ912は、フレキシブルディスク・ドライブ911、あるいはパラレル・ポート、シリアル・ポート、キーボード・ポート、マウス・ポート等を介して各種の入出力装置を接続する。   The input / output controller 906 is connected to a ROM 910, a flexible disk drive 911, and a relatively low-speed input / output device such as an input / output chip 912. The ROM 910 stores a boot program executed when the in-vehicle controller 110, the in-vehicle controller 130, and the in-vehicle controller 150 are started, or a program that depends on the hardware of the in-vehicle controller 110, the in-vehicle controller 130, and the in-vehicle controller 150. The flexible disk drive 911 reads a program or data from the flexible disk 993 and provides it to the hard disk drive 908 and the communication interface 907 via the RAM 903. The input / output chip 912 connects various input / output devices via the flexible disk drive 911 or a parallel port, a serial port, a keyboard port, a mouse port, and the like.

CPU902が実行するプログラムは、フレキシブルディスク993、CD−ROM992、又はIC(Integrated Circuit)カード等の記録媒体に格納されて利用者によって提供される。記録媒体に格納されたプログラムは圧縮されていても非圧縮であってもよい。プログラムは、記録媒体からハードディスクドライブ908にインストールされ、RAM903に読み出されてCPU902により実行される。CPU902により実行されるプログラムは、車載コントローラ110を、図1から図10に関連して説明した経路情報格納部111、映像データ入力受付部112、映像データ送信部113、制御データ受信部114、操縦制御部115、位置データ入力受付部116、3次元データ入力受付部117、車速データ入力受付部118、走行軌跡データ生成部119、及び走行軌跡データ送信部120として機能させ、車載コントローラ130を、図1から図10に関連して説明した映像データ受信部131、映像データ出力部132、制御データ入力受付部133、制御データ送信部134、走行軌跡データ受信部135、操縦制御部136、経路算出部137、誤差判定部138、及び停止指示データ送信部139として機能させ、車載コントローラ150を、図1から図10に関連して説明した位置データ入力受付部151、3次元データ入力受付部152、車速データ入力受付部153、走行軌跡データ受信部154、停止指示データ受信部155、及び操縦制御部156として機能させる。   A program executed by the CPU 902 is stored in a recording medium such as a flexible disk 993, a CD-ROM 992, or an IC (Integrated Circuit) card and provided by a user. The program stored in the recording medium may be compressed or uncompressed. The program is installed in the hard disk drive 908 from the recording medium, read into the RAM 903, and executed by the CPU 902. The program executed by the CPU 902 controls the in-vehicle controller 110, the route information storage unit 111, the video data input reception unit 112, the video data transmission unit 113, the control data reception unit 114, and the control described with reference to FIGS. The in-vehicle controller 130 is made to function as the control unit 115, the position data input reception unit 116, the three-dimensional data input reception unit 117, the vehicle speed data input reception unit 118, the travel locus data generation unit 119, and the travel locus data transmission unit 120. The video data reception unit 131, the video data output unit 132, the control data input reception unit 133, the control data transmission unit 134, the travel locus data reception unit 135, the steering control unit 136, and the route calculation unit described with reference to FIGS. 137, function as an error determination unit 138, and a stop instruction data transmission unit 139 The controller 150 includes the position data input receiving unit 151, the three-dimensional data input receiving unit 152, the vehicle speed data input receiving unit 153, the travel locus data receiving unit 154, and the stop instruction data receiving unit 155 described with reference to FIGS. , And function as the steering control unit 156.

以上に示したプログラムは、外部の記憶媒体に格納されてもよい。記憶媒体としては、フレキシブルディスク993、CD−ROM992の他に、DVD(Digital Versatile Disk)又はPD(Phase Disk)等の光学記録媒体、MD(MiniDisk)等の光磁気記録媒体、テープ媒体、ICカード等の半導体メモリ等を用いることができる。また、専用通信ネットワークあるいはインターネットに接続されたサーバシステムに設けたハードディスク又はRAM等の記憶媒体を記録媒体として使用して、ネットワークを介したプログラムとして隊列走行システム100を提供してもよい。   The program shown above may be stored in an external storage medium. As a storage medium, in addition to a flexible disk 993 and a CD-ROM 992, an optical recording medium such as a DVD (Digital Versatile Disk) or a PD (Phase Disk), a magneto-optical recording medium such as an MD (MiniDisk), a tape medium, and an IC card A semiconductor memory or the like can be used. Alternatively, the convoy travel system 100 may be provided as a program via a network using a storage medium such as a hard disk or RAM provided in a server system connected to a dedicated communication network or the Internet as a recording medium.

以上、本発明を実施の形態を用いて説明したが、本発明の技術的範囲は上記実施の形態に記載の範囲には限定されない。上記実施の形態に、多様な変更又は改良を加えることが可能であることが当業者に明らかである。その様な変更又は改良を加えた形態も本発明の技術的範囲に含まれ得ることが、特許請求の範囲の記載から明らかである。   As mentioned above, although this invention was demonstrated using embodiment, the technical scope of this invention is not limited to the range as described in the said embodiment. It will be apparent to those skilled in the art that various modifications or improvements can be added to the above embodiment. It is apparent from the description of the scope of claims that embodiments with such changes or improvements can be included in the technical scope of the present invention.

100 隊列走行システム
110 車載コントローラ
111 経路情報格納部
112 映像データ入力受付部
113 映像データ送信部
114 制御データ受信部
115 操縦制御部
116 位置データ入力受付部
117 3次元データ入力受付部
118 車速データ入力受付部
119 走行軌跡データ生成部
120 走行軌跡データ送信部
130 車載コントローラ
131 映像データ受信部
132 映像データ出力部
133 制御データ入力受付部
134 制御データ送信部
135 位置データ入力受付部
136 3次元データ入力受付部
137 車速データ入力受付部
138 走行軌跡データ受信部
139 操縦制御部
140 経路算出部
141 誤差判定部
142 停止指示データ送信部
150 車載コントローラ
151 位置データ入力受付部
152 3次元データ入力受付部
153 車速データ入力受付部
154 走行軌跡データ受信部
155 停止指示データ受信部
156 操縦制御部
170 通信回線
200 車両
201 通信アンテナ
202 ビデオカメラ
203 ディスプレイ
204 ジョイスティック
205 GPS受信機
206 IMU
207 車速検出器
208 車速検出器
209 車速検出器
210 車速検出器
211 ステアリングアクチュエータ
212 アクセルアクチュエータ
213 ブレーキアクチュエータ
214 シフトチェンジアクチュエータ
901 ホスト・コントローラ
902 CPU
903 RAM
904 グラフィック・コントローラ
905 表示装置
906 入出力コントローラ
907 通信インターフェイス
908 ハードディスクドライブ
909 CD−ROMドライブ
910 ROM
911 フレキシブルディスク・ドライブ
912 入出力チップ
991 ネットワーク通信装置
992 CD−ROM
993 フレキシブルディスク
100 convoy travel system 110 vehicle-mounted controller 111 route information storage unit 112 video data input reception unit 113 video data transmission unit 114 control data reception unit 115 steering control unit 116 position data input reception unit 117 three-dimensional data input reception unit 118 vehicle speed data input reception Unit 119 travel locus data generation unit 120 travel locus data transmission unit 130 vehicle-mounted controller 131 video data reception unit 132 video data output unit 133 control data input reception unit 134 control data transmission unit 135 position data input reception unit 136 three-dimensional data input reception unit 137 Vehicle speed data input receiving unit 138 Traveling track data receiving unit 139 Maneuvering control unit 140 Route calculating unit 141 Error determining unit 142 Stop instruction data transmitting unit 150 In-vehicle controller 151 Position data input receiving unit 152 Three-dimensional data input receiving Attached part 153 Vehicle speed data input receiving part 154 Traveling track data receiving part 155 Stop instruction data receiving part 156 Steering control part 170 Communication line 200 Vehicle 201 Communication antenna 202 Video camera 203 Display 204 Joystick 205 GPS receiver 206 IMU
207 Vehicle speed detector 208 Vehicle speed detector 209 Vehicle speed detector 210 Vehicle speed detector 211 Steering actuator 212 Accelerator actuator 213 Brake actuator 214 Shift change actuator 901 Host controller 902 CPU
903 RAM
904 Graphic controller 905 Display device 906 Input / output controller 907 Communication interface 908 Hard disk drive 909 CD-ROM drive 910 ROM
911 Flexible disk drive 912 I / O chip 991 Network communication device 992 CD-ROM
993 Flexible disk

Claims (14)

複数の車両を隊列走行させる隊列走行システムであって、
人が乗車しない隊列の先頭無人車両に搭載されて、前記先頭無人車両の操縦を制御する先頭無人車両コントローラと、隊列の後続の車両のうち人が乗車する後続有人車両に搭載されて、前記後続有人車両の操縦を制御する後続有人車両コントローラと
を備え、
前記先頭無人車両コントローラは、
前記先頭無人車両に設けられた撮影手段によって撮影された映像を示すデータを前記後続有人車両コントローラに送信する映像データ送信部と、
前記先頭無人車両の操縦を制御するためのデータを前記後続有人車両コントローラから受信する制御データ受信部と、
前記制御データ受信部が受信したデータに基づいて、前記先頭無人車両の操縦を制御する操縦制御部と
前記操縦制御部が制御したことによって走行した前記先頭無人車両の走行軌跡を示すデータを前記後続有人車両コントローラに送信する走行軌跡データ送信部と
を有し、
前記後続有人車両コントローラは、
前記映像を示すデータを前記先頭無人車両コントローラから受信する映像データ受信部と、
前記映像データ受信部が受信したデータを、前記後続有人車両に設けられた表示手段に出力する映像データ出力部と、
前記先頭無人車両の操縦を制御するためのデータの入力を、前記後続有人車両に設けられた操縦手段から受け付ける制御データ入力受付部と、
前記制御データ入力受付部が入力を受け付けたデータを前記先頭無人車両コントローラに送信する制御データ送信部と
前記制御データ入力受付部が入力を受け付けたデータに基づいて、前記先頭無人車両が走行すべき経路を算出する経路算出部と、
前記走行軌跡を示すデータを前記先頭無人車両コントローラから受信する走行軌跡データ受信部と、
前記経路算出部が算出した経路と、前記走行軌跡データ受信部が受信したデータによって示される前記先頭無人車両の走行軌跡とを比較し、その誤差が所定の閾値を超えたか否かを判定する誤差判定部と、
前記走行軌跡データ受信部が受信したデータによって示される走行軌跡に沿って前記後続有人車両を走行させるべく、前記後続有人車両の操縦を制御すると共に、誤差が所定の閾値を超えたと前記誤差判定部が判定した場合、前記後続有人車両を停止させるべく、前記後続有人車両の操縦を制御する操縦制御部と
を有する隊列走行システム。
A row running system for running multiple vehicles in a row,
Mounted on the first unmanned vehicle in the platoon where no person is on board, and on the leading unmanned vehicle controller that controls the operation of the first unmanned vehicle, and on the subsequent manned vehicle on which the person gets on among the following vehicles in the platoon, A trailing manned vehicle controller for controlling manned vehicle maneuvering ,
The leading unmanned vehicle controller is:
A video data transmission unit for transmitting data indicating video captured by the imaging means provided in the leading unmanned vehicle to the subsequent manned vehicle controller;
A control data receiving unit for receiving data for controlling the operation of the leading unmanned vehicle from the subsequent manned vehicle controller;
Based on the data received by the control data receiving unit, a steering control unit that controls the steering of the leading unmanned vehicle ,
A travel trajectory data transmission unit that transmits data indicating the travel trajectory of the leading unmanned vehicle that has traveled by being controlled by the steering control unit to the subsequent manned vehicle controller ;
The subsequent manned vehicle controller is:
A video data receiving unit for receiving data indicating the video from the leading unmanned vehicle controller;
A video data output unit for outputting the data received by the video data receiving unit to display means provided in the subsequent manned vehicle;
A control data input receiving unit that receives input of data for controlling the maneuvering of the leading unmanned vehicle from maneuvering means provided in the succeeding manned vehicle;
A control data transmission unit that transmits data received by the control data input reception unit to the leading unmanned vehicle controller ;
A route calculation unit that calculates a route on which the leading unmanned vehicle should travel based on data received by the control data input reception unit;
A travel locus data receiving unit for receiving data indicating the travel locus from the leading unmanned vehicle controller;
An error for comparing the route calculated by the route calculation unit and the traveling locus of the leading unmanned vehicle indicated by the data received by the traveling locus data receiving unit, and determining whether or not the error exceeds a predetermined threshold A determination unit;
In order to drive the succeeding manned vehicle along the traveling locus indicated by the data received by the traveling locus data receiving unit, the control of the succeeding manned vehicle is controlled, and when the error exceeds a predetermined threshold, the error determining unit If determined , a row running system having a steering control unit that controls the steering of the succeeding manned vehicle to stop the succeeding manned vehicle .
前記先頭無人車両コントローラは、
前記先頭無人車両が走行すべき経路を示す情報を格納する経路情報格納部
を更に有し、
前記先頭無人車両コントローラの操縦制御部は、前記経路情報格納部が格納している情報によって示される経路に沿って前記先頭無人車両を走行させるべく、前記先頭無人車両の操縦を制御すると共に、制御データ受信部が受信したデータに基づいて、前記先頭無人車両の操縦を割り込み制御する
請求項に記載の隊列走行システム。
The leading unmanned vehicle controller is:
A route information storage unit for storing information indicating a route on which the leading unmanned vehicle should travel;
The steering control unit of the leading unmanned vehicle controller controls the steering of the leading unmanned vehicle to control the leading unmanned vehicle to travel along the route indicated by the information stored in the route information storage unit. based on the data that the data receiving unit receives, row running system of claim 1, the interrupt control steering of the leading unmanned vehicle.
前記先頭無人車両コントローラの操縦制御部は、前記制御データ受信部がデータを受信することができなくなった場合、前記先頭無人車両を停止させるべく、前記先頭無人車両の操縦を制御する
請求項1又は2に記載の隊列走行システム。
Steering control unit of the first unmanned vehicle controller, when the control data receiving unit is no longer able to receive the data, in order to stop the leading unmanned vehicle, according to claim 1 for controlling the steering of the leading unmanned vehicle or platoon system described in 2.
前記後続有人車両コントローラの操縦制御部は、前記走行軌跡データ受信部がデータを受信することができなくなった場合、前記後続有人車両を停止させるべく、前記後続有人車両の操縦を制御する
請求項1から3のいずれか一項に記載の隊列走行システム。
The steering control unit of the following manned vehicle controller, when the traveling locus data receiving unit is no longer able to receive the data, in order to stop the subsequent manned vehicle, according to claim 1 for controlling the steering of the subsequent manned vehicle The convoy travel system as described in any one of 3 to 3 .
前記後続有人車両コントローラの前記制御データ入力受付部は、前記先頭無人車両の操縦を制御するためのデータとして、ジョイスティックのレバーの操作方向とその操作量を含む情報を含むデータの入力を受け付けるThe control data input receiving unit of the succeeding manned vehicle controller receives input of data including information including an operation direction and an operation amount of a lever of a joystick as data for controlling the operation of the leading unmanned vehicle.
請求項1から4のいずれか一項に記載の隊列走行システム。The convoy travel system according to any one of claims 1 to 4.
前記後続有人車両コントローラの前記制御データ入力受付部は、前記先頭無人車両の操縦を制御するためのデータとして、押下操作されたジョイスティックのボタンを識別する情報を含むデータの入力を受け付けるThe control data input receiving unit of the succeeding manned vehicle controller receives input of data including information for identifying a pressed joystick button as data for controlling the operation of the leading unmanned vehicle.
請求項1から5のいずれか一項に記載の隊列走行システム。The convoy travel system according to any one of claims 1 to 5.
前記先頭無人車両コントローラの操縦制御部は、前記先頭無人車両の操縦を制御するにあたり、前記制御データ受信部が受信したデータによって示される情報に従って、ステアリングアクチュエータの動作を制御するThe steering control unit of the leading unmanned vehicle controller controls the operation of the steering actuator according to the information indicated by the data received by the control data receiving unit when controlling the steering of the leading unmanned vehicle.
請求項1から6のいずれか一項に記載の隊列走行システム。The convoy travel system according to any one of claims 1 to 6.
複数の車両を隊列走行させる隊列走行方法であって、
人が乗車しない隊列の先頭無人車両に搭載されて、前記先頭無人車両の操縦を制御する先頭無人車両コントローラが、先頭無人車両に設けられた撮影手段によって撮影された映像を示すデータを、隊列の後続の車両のうち人が乗車する後続有人車両に搭載されて、前記後続有人車両の操縦を制御する後続有人車両コントローラに送信する映像データ送信段階と、
前記後続有人車両コントローラが、前記映像を示すデータを前記先頭無人車両コントローラから受信する映像データ受信段階と、
前記後続有人車両コントローラが、前記映像データ受信段階において受信されたデータを、前記後続有人車両に設けられた表示手段に出力する映像データ出力段階と、
前記後続有人車両コントローラが、前記先頭無人車両の操縦を制御するためのデータの入力を、前記後続有人車両に設けられた操縦手段から受け付ける制御データ入力受付段階と、
前記後続有人車両コントローラが、前記制御データ入力受付段階において入力が受け付けられたデータに基づいて、前記先頭無人車両が走行すべき経路を算出する経路算出段階と、
前記後続有人車両コントローラが、前記制御データ入力受付段階において入力が受け付けられたデータを前記先頭無人車両コントローラに送信する制御データ送信段階と、
前記先頭無人車両コントローラが、前記先頭無人車両の操縦を制御するためのデータを前記後続有人車両コントローラから受信する制御データ受信段階と、
前記先頭無人車両コントローラが、前記制御データ受信段階において受信されたデータに基づいて、前記先頭無人車両の操縦を制御する操縦制御段階と
前記先頭無人車両コントローラが、前記操縦制御段階において制御されたことによって走行した前記先頭無人車両の走行軌跡を示すデータを前記後続有人車両コントローラに送信する走行軌跡データ送信段階と、
前記後続有人車両コントローラが、前記走行軌跡を示すデータを前記先頭無人車両コントローラから受信する走行軌跡データ受信段階と、
前記後続有人車両コントローラが、前記経路算出段階において算出された経路と、前記走行軌跡データ受信段階において受信されたデータによって示される前記先頭無人車両の走行軌跡とを比較し、その誤差が所定の閾値を超えたか否かを判定する誤差判定段階と、
前記後続有人車両コントローラが、前記走行軌跡データ受信段階において受信されたデータによって示される走行軌跡に沿って前記後続有人車両を走行させるべく、前記後続有人車両の操縦を制御すると共に、誤差が所定の閾値を超えたと前記誤差判定段階において判定された場合、前記後続有人車両を停止させるべく、前記後続有人車両の操縦を制御する操縦制御段階と
含む隊列走行方法。
A row running method for running multiple vehicles in a row,
A head unmanned vehicle controller, which is mounted on a leading unmanned vehicle in a platoon where no person is on board and controls the operation of the leading unmanned vehicle, receives data indicating video captured by photographing means provided in the leading unmanned vehicle. A video data transmission stage that is mounted on a subsequent manned vehicle on which a person gets on among the following vehicles and transmits to a subsequent manned vehicle controller that controls the operation of the subsequent manned vehicle;
The subsequent manned vehicle controller receives data indicating the video from the leading unmanned vehicle controller; and
The subsequent manned vehicle controller outputs the data received in the video data receiving step to a display means provided in the subsequent manned vehicle, and
A control data input accepting step in which the succeeding manned vehicle controller accepts input of data for controlling the maneuvering of the leading unmanned vehicle from maneuvering means provided in the succeeding manned vehicle;
The subsequent manned vehicle controller calculates a route on which the leading unmanned vehicle should travel based on data received in the control data input accepting step;
The subsequent manned vehicle controller transmits the data accepted in the control data input accepting step to the leading unmanned vehicle controller,
A control data receiving step in which the leading unmanned vehicle controller receives data for controlling the operation of the leading unmanned vehicle from the subsequent manned vehicle controller;
The leading unmanned vehicle controller controls the maneuvering of the leading unmanned vehicle based on the data received in the control data receiving step ,
A traveling locus data transmission step of transmitting data indicating a traveling locus of the leading unmanned vehicle that has traveled by the leading unmanned vehicle controller being controlled in the steering control step to the subsequent manned vehicle controller;
The subsequent manned vehicle controller receives data indicating the traveling locus from the leading unmanned vehicle controller, a traveling locus data receiving step;
The subsequent manned vehicle controller compares the route calculated in the route calculating step with the traveling locus of the leading unmanned vehicle indicated by the data received in the traveling locus data receiving step, and the error is a predetermined threshold value. An error determination stage for determining whether or not
The succeeding manned vehicle controller controls the maneuvering of the succeeding manned vehicle in order to cause the succeeding manned vehicle to travel along the traveling locus indicated by the data received in the traveling locus data receiving step, and an error is predetermined. A row running method comprising: a steering control step of controlling a steering of the succeeding manned vehicle so as to stop the succeeding manned vehicle when it is determined in the error judging step that a threshold value has been exceeded .
複数の車両を隊列走行させる隊列走行システムにおいて、人が乗車しない隊列の先頭無人車両に搭載されて、前記先頭無人車両の操縦を制御する先頭無人車両コントローラとして第1のコンピュータを機能させ、隊列の後続の車両のうち人が乗車する後続有人車両に搭載されて、前記後続有人車両の操縦を制御する後続有人車両コントローラとして第2のコンピュータを機能させるプログラムであって、
前記第1のコンピュータを、
前記先頭無人車両に設けられた撮影手段によって撮影された映像を示すデータを、前記後続有人車両コントローラに送信する映像データ送信部、
前記先頭無人車両の操縦を制御するためのデータを前記後続有人車両コントローラから受信する制御データ受信部、
前記制御データ受信部が受信したデータに基づいて、前記先頭無人車両の操縦を制御する操縦制御部
前記操縦制御部が制御したことによって走行した前記先頭無人車両の走行軌跡を示すデータを前記後続有人車両コントローラに送信する走行軌跡データ送信部
として機能させ、
前記第2のコンピュータを、
前記映像を示すデータを前記先頭無人車両コントローラから受信する映像データ受信部、
前記映像データ受信部が受信したデータを、前記後続有人車両に設けられた表示手段に出力する映像データ出力部、
前記先頭無人車両の操縦を制御するためのデータの入力を、前記後続有人車両に設けられた操縦手段から受け付ける制御データ入力受付部、
前記制御データ入力受付部が入力を受け付けたデータを前記先頭無人車両コントローラに送信する制御データ送信部
前記制御データ入力受付部が入力を受け付けたデータに基づいて、前記先頭無人車両が走行すべき経路を算出する経路算出部、
前記走行軌跡を示すデータを前記先頭無人車両コントローラから受信する走行軌跡データ受信部、
前記経路算出部が算出した経路と、前記走行軌跡データ受信部が受信したデータによって示される前記先頭無人車両の走行軌跡とを比較し、その誤差が所定の閾値を超えたか否かを判定する誤差判定部、
前記走行軌跡データ受信部が受信したデータによって示される走行軌跡に沿って前記後続有人車両を走行させるべく、前記後続有人車両の操縦を制御すると共に、誤差が所定の閾値を超えたと前記誤差判定部が判定した場合、前記後続有人車両を停止させるべく、前記後続有人車両の操縦を制御する操縦制御部
として機能させるプログラム。
In a row running system for running a plurality of vehicles in a row , the first computer is functioned as a head unmanned vehicle controller that is mounted on a head unmanned vehicle in a row where a person does not ride and controls the operation of the head unmanned vehicle, A program for causing a second computer to function as a subsequent manned vehicle controller that is mounted on a subsequent manned vehicle on which a person rides among the following vehicles and controls the operation of the subsequent manned vehicle,
The first computer ;
The leading data indicating the image photographed by the photographing means provided on the unmanned vehicle, the image data transmission unit to be transmitted to said subsequent manned vehicle controller,
A control data receiving unit for receiving data for controlling the operation of the leading unmanned vehicle from the subsequent manned vehicle controller;
Based on the data received by the control data receiving unit, a steering control unit that controls the steering of the leading unmanned vehicle ,
Function as a travel locus data transmission unit that transmits data indicating the travel locus of the leading unmanned vehicle that has traveled by being controlled by the steering control unit to the subsequent manned vehicle controller ;
Said second computer ;
A video data receiving unit for receiving data indicating the video from the leading unmanned vehicle controller;
A video data output unit for outputting the data received by the video data receiving unit to display means provided in the subsequent manned vehicle;
A control data input accepting unit for accepting input of data for controlling the maneuvering of the leading unmanned vehicle from maneuvering means provided in the succeeding manned vehicle;
A control data transmission unit that transmits data received by the control data input reception unit to the leading unmanned vehicle controller ;
A route calculation unit that calculates a route on which the leading unmanned vehicle should travel based on data received by the control data input reception unit;
A travel locus data receiving unit for receiving data indicating the travel locus from the leading unmanned vehicle controller;
An error for comparing the route calculated by the route calculation unit and the traveling locus of the leading unmanned vehicle indicated by the data received by the traveling locus data receiving unit, and determining whether or not the error exceeds a predetermined threshold Determination part,
In order to drive the succeeding manned vehicle along the traveling locus indicated by the data received by the traveling locus data receiving unit, the control of the succeeding manned vehicle is controlled, and when the error exceeds a predetermined threshold, the error determining unit If determined, a program that functions as an operation control unit that controls operation of the subsequent manned vehicle to stop the subsequent manned vehicle .
複数の車両を隊列走行させる隊列走行システムにおいて、人が乗車しない隊列の先頭無人車両に搭載されて、前記先頭無人車両の操縦を制御する先頭無人車両コントローラとして第1のコンピュータを機能させ、隊列の後続の車両のうち人が乗車する後続有人車両に搭載されて、前記後続有人車両の操縦を制御する後続有人車両コントローラとして第2のコンピュータを機能させるプログラムを記録した記録媒体であって、In a row running system for running a plurality of vehicles in a row, the first computer is functioned as a head unmanned vehicle controller that is mounted on a head unmanned vehicle in a row where a person does not get on and controls the operation of the head unmanned vehicle, A recording medium in which a program for causing a second computer to function as a subsequent manned vehicle controller that is mounted on a subsequent manned vehicle on which a person rides among the following vehicles and controls the operation of the subsequent manned vehicle is recorded,
前記第1のコンピュータを、The first computer;
前記先頭無人車両に設けられた撮影手段によって撮影された映像を示すデータを、前記後続有人車両コントローラに送信する映像データ送信部、A video data transmission unit that transmits data indicating video captured by the imaging means provided in the leading unmanned vehicle to the subsequent manned vehicle controller;
前記先頭無人車両の操縦を制御するためのデータを前記後続有人車両コントローラから受信する制御データ受信部、A control data receiving unit for receiving data for controlling the operation of the leading unmanned vehicle from the subsequent manned vehicle controller;
前記制御データ受信部が受信したデータに基づいて、前記先頭無人車両の操縦を制御する操縦制御部、Based on the data received by the control data receiving unit, a steering control unit that controls the steering of the leading unmanned vehicle,
前記操縦制御部が制御したことによって走行した前記先頭無人車両の走行軌跡を示すデータを前記後続有人車両コントローラに送信する走行軌跡データ送信部A travel trajectory data transmission unit that transmits data indicating the travel trajectory of the leading unmanned vehicle that has traveled under the control of the steering control unit to the subsequent manned vehicle controller.
として機能させ、Function as
前記第2のコンピュータを、Said second computer;
前記映像を示すデータを前記先頭無人車両コントローラから受信する映像データ受信部、A video data receiving unit for receiving data indicating the video from the leading unmanned vehicle controller;
前記映像データ受信部が受信したデータを、前記後続有人車両に設けられた表示手段に出力する映像データ出力部、A video data output unit for outputting the data received by the video data receiving unit to display means provided in the subsequent manned vehicle;
前記先頭無人車両の操縦を制御するためのデータの入力を、前記後続有人車両に設けられた操縦手段から受け付ける制御データ入力受付部、A control data input accepting unit for accepting input of data for controlling the maneuvering of the leading unmanned vehicle from maneuvering means provided in the succeeding manned vehicle;
前記制御データ入力受付部が入力を受け付けたデータを前記先頭無人車両コントローラに送信する制御データ送信部、A control data transmission unit that transmits data received by the control data input reception unit to the leading unmanned vehicle controller;
前記制御データ入力受付部が入力を受け付けたデータに基づいて、前記先頭無人車両が走行すべき経路を算出する経路算出部、A route calculation unit that calculates a route on which the leading unmanned vehicle should travel based on data received by the control data input reception unit;
前記走行軌跡を示すデータを前記先頭無人車両コントローラから受信する走行軌跡データ受信部、A travel locus data receiving unit for receiving data indicating the travel locus from the leading unmanned vehicle controller;
前記経路算出部が算出した経路と、前記走行軌跡データ受信部が受信したデータによって示される前記先頭無人車両の走行軌跡とを比較し、その誤差が所定の閾値を超えたか否かを判定する誤差判定部、An error for comparing the route calculated by the route calculation unit and the traveling locus of the leading unmanned vehicle indicated by the data received by the traveling locus data receiving unit, and determining whether or not the error exceeds a predetermined threshold Judgment part,
前記走行軌跡データ受信部が受信したデータによって示される走行軌跡に沿って前記後続有人車両を走行させるべく、前記後続有人車両の操縦を制御すると共に、誤差が所定の閾値を超えたと前記誤差判定部が判定した場合、前記後続有人車両を停止させるべく、前記後続有人車両の操縦を制御する操縦制御部In order to drive the succeeding manned vehicle along the traveling locus indicated by the data received by the traveling locus data receiving unit, the control of the succeeding manned vehicle is controlled, and when the error exceeds a predetermined threshold, the error determining unit Control unit for controlling the maneuvering of the subsequent manned vehicle to stop the manned vehicle
として機能させるプログラムを記録した記録媒体。A recording medium that records a program that functions as a computer.
隊列の後続の車両のうち人が乗車する後続有人車両に搭載されて、前記後続有人車両の操縦を制御する後続有人車両コントローラであって、
人が乗車しない隊列の先頭無人車両に設けられた撮影手段によって撮影された映像を示すデータを、前記先頭無人車両に搭載されて、前記先頭無人車両の操縦を制御する先頭無人車両コントローラから受信する映像データ受信部と、
前記映像データ受信部が受信したデータを、前記後続有人車両に設けられた表示手段に出力する映像データ出力部と、
前記先頭無人車両の操縦を制御するためのデータの入力を、前記後続有人車両に設けられた操縦手段から受け付ける制御データ入力受付部と、
前記制御データ入力受付部が入力を受け付けたデータを前記先頭無人車両コントローラに送信する制御データ送信部と
前記制御データ入力受付部が入力を受け付けたデータに基づいて、前記先頭無人車両が走行すべき経路を算出する経路算出部と、
前記先頭無人車両の走行軌跡を示すデータを前記先頭無人車両コントローラから受信する走行軌跡データ受信部と、
前記経路算出部が算出した経路と、前記走行軌跡データ受信部が受信したデータによって示される前記先頭無人車両の走行軌跡とを比較し、その誤差が所定の閾値を超えたか否かを判定する誤差判定部と、
前記走行軌跡データ受信部が受信したデータによって示される走行軌跡に沿って前記後続有人車両を走行させるべく、前記後続有人車両の操縦を制御すると共に、誤差が所定の閾値を超えたと前記誤差判定部が判定した場合、前記後続有人車両を停止させるべく、前記後続有人車両の操縦を制御する操縦制御部と
を備える後続有人車両コントローラ。
A succeeding manned vehicle controller that is mounted on a succeeding manned vehicle on which a person rides among the following vehicles in the formation and controls the maneuvering of the succeeding manned vehicle;
Data indicating an image captured by a photographing unit provided in a leading unmanned vehicle of a platoon where a person does not get on is received from a leading unmanned vehicle controller that is mounted on the leading unmanned vehicle and controls the operation of the leading unmanned vehicle. A video data receiver;
A video data output unit for outputting the data received by the video data receiving unit to display means provided in the subsequent manned vehicle;
A control data input receiving unit that receives input of data for controlling the maneuvering of the leading unmanned vehicle from maneuvering means provided in the succeeding manned vehicle;
A control data transmission unit that transmits data received by the control data input reception unit to the leading unmanned vehicle controller ;
A route calculation unit that calculates a route on which the leading unmanned vehicle should travel based on data received by the control data input reception unit;
A traveling locus data receiving unit for receiving data indicating the traveling locus of the leading unmanned vehicle from the leading unmanned vehicle controller;
An error for comparing the route calculated by the route calculation unit and the traveling locus of the leading unmanned vehicle indicated by the data received by the traveling locus data receiving unit, and determining whether or not the error exceeds a predetermined threshold A determination unit;
In order to drive the succeeding manned vehicle along the traveling locus indicated by the data received by the traveling locus data receiving unit, the control of the succeeding manned vehicle is controlled, and when the error exceeds a predetermined threshold, the error determining unit A subsequent manned vehicle controller comprising: a maneuvering control unit that controls maneuvering of the succeeding manned vehicle to stop the manned vehicle after the determination .
隊列の後続の車両のうち人が乗車する後続有人車両の操縦を制御する操縦制御方法であって、
前記後続有人車両に搭載されて、前記後続有人車両の操縦を制御する後続有人車両コントローラが、人が乗車しない隊列の先頭無人車両に設けられた撮影手段によって撮影された映像を示すデータを、前記先頭無人車両に搭載されて、前記先頭無人車両の操縦を制御する先頭無人車両コントローラから受信する映像データ受信段階と、
前記後続有人車両コントローラが、前記映像データ受信段階において受信されたデータを、前記後続有人車両に設けられた表示手段に出力する映像データ出力段階と、
前記後続有人車両コントローラが、前記先頭無人車両の操縦を制御するためのデータの入力を、前記後続有人車両に設けられた操縦手段から受け付ける制御データ入力受付段階と、
前記後続有人車両コントローラが、前記制御データ入力受付段階において入力が受け付けられたデータを前記先頭無人車両コントローラに送信する制御データ送信段階と
前記後続有人車両コントローラが、前記制御データ入力受付段階において入力が受け付けられたデータに基づいて、前記先頭無人車両が走行すべき経路を算出する経路算出段階と、
前記後続有人車両コントローラが、前記先頭無人車両の走行軌跡を示すデータを前記先頭無人車両コントローラから受信する走行軌跡データ受信段階と、
前記後続有人車両コントローラが、前記経路算出段階において算出された経路と、前記走行軌跡データ受信段階において受信されたデータによって示される前記先頭無人車両の走行軌跡とを比較し、その誤差が所定の閾値を超えたか否かを判定する誤差判定段階と、
前記後続有人車両コントローラが、前記走行軌跡データ受信段階において受信されたデータによって示される走行軌跡に沿って前記後続有人車両を走行させるべく、前記後続有人車両の操縦を制御すると共に、誤差が所定の閾値を超えたと前記誤差判定段階において判定された場合、前記後続有人車両を停止させるべく、前記後続有人車両の操縦を制御する操縦制御段階と
含む操縦制御方法。
A control method for controlling the maneuvering of a subsequent manned vehicle on which a person rides among the following vehicles in the formation,
The succeeding manned vehicle controller that is mounted on the succeeding manned vehicle and controls the maneuvering of the succeeding manned vehicle , the data indicating the image photographed by the photographing means provided in the leading unmanned vehicle of the row where no person is on board, A video data receiving step that is mounted on the leading unmanned vehicle and received from the leading unmanned vehicle controller that controls the operation of the leading unmanned vehicle;
The subsequent manned vehicle controller outputs the data received in the video data receiving step to a display means provided in the subsequent manned vehicle, and
A control data input accepting step in which the succeeding manned vehicle controller accepts input of data for controlling the maneuvering of the leading unmanned vehicle from maneuvering means provided in the succeeding manned vehicle;
The subsequent manned vehicle controller transmits the data accepted in the control data input accepting step to the leading unmanned vehicle controller ,
The subsequent manned vehicle controller calculates a route on which the leading unmanned vehicle should travel based on data received in the control data input accepting step;
The subsequent manned vehicle controller receives data indicating the traveling locus of the leading unmanned vehicle from the leading unmanned vehicle controller, and a traveling locus data receiving step.
The subsequent manned vehicle controller compares the route calculated in the route calculating step with the traveling locus of the leading unmanned vehicle indicated by the data received in the traveling locus data receiving step, and the error is a predetermined threshold value. An error determination stage for determining whether or not
The succeeding manned vehicle controller controls the maneuvering of the succeeding manned vehicle in order to cause the succeeding manned vehicle to travel along the traveling locus indicated by the data received in the traveling locus data receiving step, and an error is predetermined. A steering control method including a steering control step of controlling steering of the succeeding manned vehicle to stop the succeeding manned vehicle when it is determined in the error determining step that the threshold value has been exceeded .
隊列の後続の車両のうち人が乗車する後続有人車両に搭載されて、前記後続有人車両の操縦を制御する後続有人車両コントローラとしてコンピュータを機能させるプログラムであって、
前記コンピュータを、
人が乗車しない隊列の先頭無人車両に設けられた撮影手段によって撮影された映像を示すデータを、前記先頭無人車両に搭載されて、前記先頭無人車両の操縦を制御する先頭無人車両コントローラから受信する映像データ受信部、
前記映像データ受信部が受信したデータを、前記後続有人車両に設けられた表示手段に出力する映像データ出力部、
前記先頭無人車両の操縦を制御するためのデータの入力を、前記後続有人車両に設けられた操縦手段から受け付ける制御データ入力受付部、
前記制御データ入力受付部が入力を受け付けたデータを前記先頭無人車両コントローラに送信する制御データ送信部
前記制御データ入力受付部が入力を受け付けたデータに基づいて、前記先頭無人車両が走行すべき経路を算出する経路算出部、
前記先頭無人車両の走行軌跡を示すデータを前記先頭無人車両コントローラから受信する走行軌跡データ受信部、
前記経路算出部が算出した経路と、前記走行軌跡データ受信部が受信したデータによって示される前記先頭無人車両の走行軌跡とを比較し、その誤差が所定の閾値を超えたか否かを判定する誤差判定部、
前記走行軌跡データ受信部が受信したデータによって示される走行軌跡に沿って前記後続有人車両を走行させるべく、前記後続有人車両の操縦を制御すると共に、誤差が所定の閾値を超えたと前記誤差判定部が判定した場合、前記後続有人車両を停止させるべく、前記後続有人車両の操縦を制御する操縦制御部
として機能させるプログラム。
A program that is mounted on a succeeding manned vehicle on which a person rides among the following vehicles in a convoy, and causes a computer to function as a succeeding manned vehicle controller that controls the operation of the succeeding manned vehicle,
The computer ,
Data indicating an image captured by a photographing unit provided in a leading unmanned vehicle of a platoon where a person does not get on is received from a leading unmanned vehicle controller that is mounted on the leading unmanned vehicle and controls the operation of the leading unmanned vehicle. Video data receiver,
A video data output unit for outputting the data received by the video data receiving unit to display means provided in the subsequent manned vehicle;
A control data input accepting unit for accepting input of data for controlling the maneuvering of the leading unmanned vehicle from maneuvering means provided in the succeeding manned vehicle;
A control data transmission unit that transmits data received by the control data input reception unit to the leading unmanned vehicle controller ;
A route calculation unit that calculates a route on which the leading unmanned vehicle should travel based on data received by the control data input reception unit;
A travel locus data receiving unit for receiving data indicating the travel locus of the leading unmanned vehicle from the leading unmanned vehicle controller;
An error for comparing the route calculated by the route calculation unit and the traveling locus of the leading unmanned vehicle indicated by the data received by the traveling locus data receiving unit, and determining whether or not the error exceeds a predetermined threshold Determination part,
In order to drive the succeeding manned vehicle along the traveling locus indicated by the data received by the traveling locus data receiving unit, the control of the succeeding manned vehicle is controlled, and when the error exceeds a predetermined threshold, the error determining unit If determined, a program that functions as an operation control unit that controls operation of the subsequent manned vehicle to stop the subsequent manned vehicle .
隊列の後続の車両のうち人が乗車する後続有人車両に搭載されて、前記後続有人車両の操縦を制御する後続有人車両コントローラとしてコンピュータを機能させるプログラムを記録した記録媒体であって、A recording medium that records a program that is mounted on a succeeding manned vehicle on which a person rides among the following vehicles in a platoon and that causes a computer to function as a succeeding manned vehicle controller that controls the operation of the succeeding manned vehicle,
前記コンピュータを、The computer,
人が乗車しない隊列の先頭無人車両に設けられた撮影手段によって撮影された映像を示すデータを、前記先頭無人車両に搭載されて、前記先頭無人車両の操縦を制御する先頭無人車両コントローラから受信する映像データ受信部、Data indicating an image captured by a photographing unit provided in a leading unmanned vehicle of a platoon where a person does not get on is received from a leading unmanned vehicle controller that is mounted on the leading unmanned vehicle and controls the operation of the leading unmanned vehicle. Video data receiver,
前記映像データ受信部が受信したデータを、前記後続有人車両に設けられた表示手段に出力する映像データ出力部、A video data output unit for outputting the data received by the video data receiving unit to display means provided in the subsequent manned vehicle;
前記先頭無人車両の操縦を制御するためのデータの入力を、前記後続有人車両に設けられた操縦手段から受け付ける制御データ入力受付部、A control data input accepting unit for accepting input of data for controlling the maneuvering of the leading unmanned vehicle from maneuvering means provided in the succeeding manned vehicle;
前記制御データ入力受付部が入力を受け付けたデータを前記先頭無人車両コントローラに送信する制御データ送信部、A control data transmission unit that transmits data received by the control data input reception unit to the leading unmanned vehicle controller;
前記制御データ入力受付部が入力を受け付けたデータに基づいて、前記先頭無人車両が走行すべき経路を算出する経路算出部、A route calculation unit that calculates a route on which the leading unmanned vehicle should travel based on data received by the control data input reception unit;
前記先頭無人車両の走行軌跡を示すデータを前記先頭無人車両コントローラから受信する走行軌跡データ受信部、A travel locus data receiving unit for receiving data indicating the travel locus of the leading unmanned vehicle from the leading unmanned vehicle controller;
前記経路算出部が算出した経路と、前記走行軌跡データ受信部が受信したデータによって示される前記先頭無人車両の走行軌跡とを比較し、その誤差が所定の閾値を超えたか否かを判定する誤差判定部、An error for comparing the route calculated by the route calculation unit and the traveling locus of the leading unmanned vehicle indicated by the data received by the traveling locus data receiving unit, and determining whether or not the error exceeds a predetermined threshold Judgment part,
前記走行軌跡データ受信部が受信したデータによって示される走行軌跡に沿って前記後続有人車両を走行させるべく、前記後続有人車両の操縦を制御すると共に、誤差が所定の閾値を超えたと前記誤差判定部が判定した場合、前記後続有人車両を停止させるべく、前記後続有人車両の操縦を制御する操縦制御部In order to drive the succeeding manned vehicle along the traveling locus indicated by the data received by the traveling locus data receiving unit, the control of the succeeding manned vehicle is controlled, and when the error exceeds a predetermined threshold, the error determining unit Control unit for controlling the maneuvering of the subsequent manned vehicle to stop the manned vehicle
として機能させるプログラムを記録した記録媒体。A recording medium that records a program that functions as a computer.
JP2010011995A 2010-01-22 2010-01-22 Convoy travel system, convoy travel method, trailing manned vehicle controller, steering control method, program, and recording medium Active JP5473628B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2010011995A JP5473628B2 (en) 2010-01-22 2010-01-22 Convoy travel system, convoy travel method, trailing manned vehicle controller, steering control method, program, and recording medium

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2010011995A JP5473628B2 (en) 2010-01-22 2010-01-22 Convoy travel system, convoy travel method, trailing manned vehicle controller, steering control method, program, and recording medium

Publications (2)

Publication Number Publication Date
JP2011150580A JP2011150580A (en) 2011-08-04
JP5473628B2 true JP5473628B2 (en) 2014-04-16

Family

ID=44537485

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2010011995A Active JP5473628B2 (en) 2010-01-22 2010-01-22 Convoy travel system, convoy travel method, trailing manned vehicle controller, steering control method, program, and recording medium

Country Status (1)

Country Link
JP (1) JP5473628B2 (en)

Families Citing this family (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
SE537615C2 (en) * 2012-03-27 2015-08-04 Scania Cv Ab Device and method for transmitting route information to a vehicle
CN110418745B (en) 2016-11-02 2023-01-13 佩路通科技股份有限公司 Clearance measurement for vehicle convoying
CN106696962B (en) * 2016-12-12 2020-04-14 东莞前沿技术研究院 Traffic system, vehicle and control method thereof

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2000311300A (en) * 1999-04-28 2000-11-07 Honda Motor Co Ltd Remote controller for automatic following traveling system

Also Published As

Publication number Publication date
JP2011150580A (en) 2011-08-04

Similar Documents

Publication Publication Date Title
US11657604B2 (en) Systems and methods for estimating future paths
US10248116B2 (en) Remote operation of autonomous vehicle in unexpected environment
JP6711631B2 (en) Monitoring system
JP5595030B2 (en) MOBILE BODY CONTROL SYSTEM, CONTROL DEVICE, CONTROL METHOD, PROGRAM, AND RECORDING MEDIUM
US10452065B2 (en) Human-machine interface (HMI) architecture
CN107672507B (en) Autonomous ship launching
JP5473628B2 (en) Convoy travel system, convoy travel method, trailing manned vehicle controller, steering control method, program, and recording medium
JP2019185406A (en) Control program, control method, and control device
US20200398985A1 (en) Detachable drone guide for vehicle
JP3913295B2 (en) Automatic tracking system
JP7102765B2 (en) Vehicle control device
KR20180012128A (en) Apparatus for estimating 3d position of vehicle and method thereof
JP7372144B2 (en) In-vehicle processing equipment and in-vehicle processing systems
JP6080998B1 (en) Vehicle control information generation apparatus and vehicle control information generation method
WO2012096282A1 (en) Controller, model device and control method
WO2022125391A1 (en) Systems, apparatus, and methods for transmitting image data
JP7478285B2 (en) Vehicle, vehicle control method, and vehicle control program
JP7476263B2 (en) Vehicle control device, vehicle control method, and vehicle control program
JP2000172982A (en) Moving body monitoring system storing actually picked up picture data
US20230176572A1 (en) Remote operation system and remote operation control method
JP7483627B2 (en) Information processing device, information processing method, program, mobile body control device, and mobile body
JP2018002143A (en) Travel device, travel control system, travel control method and program
US11526175B1 (en) Sensor data prioritization for autonomous vehicle based on vehicle operation data
JP7429112B2 (en) control device
US20220196422A1 (en) Parking assistance device and parking assistance method

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20120914

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20130917

A521 Written amendment

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20131115

A521 Written amendment

Free format text: JAPANESE INTERMEDIATE CODE: A821

Effective date: 20131118

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20140204

R151 Written notification of patent or utility model registration

Ref document number: 5473628

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R151