JP5382793B2 - Semi-autonomous unmanned vehicle remote control system - Google Patents

Semi-autonomous unmanned vehicle remote control system Download PDF

Info

Publication number
JP5382793B2
JP5382793B2 JP2009195625A JP2009195625A JP5382793B2 JP 5382793 B2 JP5382793 B2 JP 5382793B2 JP 2009195625 A JP2009195625 A JP 2009195625A JP 2009195625 A JP2009195625 A JP 2009195625A JP 5382793 B2 JP5382793 B2 JP 5382793B2
Authority
JP
Japan
Prior art keywords
area
semi
unmanned vehicle
remote control
traveling
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
JP2009195625A
Other languages
Japanese (ja)
Other versions
JP2011048565A (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.)
IHI Corp
IHI Aerospace Co Ltd
Original Assignee
IHI Corp
IHI Aerospace Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by IHI Corp, IHI Aerospace Co Ltd filed Critical IHI Corp
Priority to JP2009195625A priority Critical patent/JP5382793B2/en
Publication of JP2011048565A publication Critical patent/JP2011048565A/en
Application granted granted Critical
Publication of JP5382793B2 publication Critical patent/JP5382793B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Description

本発明は、遠隔操縦装置と、測距データに基づく自律走行を行うとともに、遠隔操縦装置によって遠隔操縦される半自律型無人車両とを有する半自律型無人車両の遠隔操縦システムに関する。   The present invention relates to a semi-autonomous unmanned vehicle remote control system having a remote control device and a semi-autonomous unmanned vehicle that performs autonomous traveling based on distance measurement data and is remotely controlled by the remote control device.

従来、この種の半自律型無人車両の遠隔操縦システムとして、無人車両とした名称において特許文献1に記載された構成のものがある。
特許文献1に記載された無人車両は、予め与えられた節点を結んだ走行経路に従って自律走行する手段と、操舵角及び車速を遠隔操作する手段とを併せ持ち、自律走行モードと遠隔操縦モードとを切替可能な無人車両において、前記走行経路上の障害物を検出する手段と、検出した前記障害物を回避する複数の回避経路を生成する手段と、前記複数の回避経路と車両本体の状態とを遠隔操縦システムに提示する手段と、これらの回避経路の何れか一つを当該遠隔操縦システムで選択する手段と、前記自律走行モードで前記走行経路上に障害物を検出した場合に、前記車両本体を停止し、前記複数の回避経路を前記遠隔操縦システムに提示して当該複数の回避経路の何れか一つを選択して前記自律走行モードで前記障害物を回避するか或いは遠隔操縦モードに切り替えて操縦者の操作により回避を実行するかを選択する手段とを備えた構成のものである。
Conventionally, as a remote control system for this type of semi-autonomous unmanned vehicle, there is a configuration described in Patent Document 1 under the name of an unmanned vehicle.
The unmanned vehicle described in Patent Document 1 has both a means for autonomously traveling according to a travel route connecting previously given nodes and a means for remotely operating a steering angle and a vehicle speed. In a switchable unmanned vehicle, means for detecting an obstacle on the travel route, means for generating a plurality of avoidance routes to avoid the detected obstacle, and the plurality of avoidance routes and the state of the vehicle body Means for presenting to the remote control system; means for selecting any one of these avoidance routes by the remote control system; and when an obstacle is detected on the travel route in the autonomous travel mode, the vehicle body Stop, present the plurality of avoidance routes to the remote control system and select any one of the plurality of avoidance routes to avoid the obstacle in the autonomous driving mode or It is of the structure and means for selecting whether to switch to maneuvering mode executes avoided by operator manipulation.

特開2007‐310698号公報JP 2007-310698 A

しかしながら、特許文献1に記載のものは、無人車両を自律移動させるものではあるが、走行方向の前方に障害物を検出した場合、その障害物を回避するための複数の回避経路を生成し、その後、走行を一旦停止して、生成した複数の複数の回避経路のいずれかを操作者に提示して選択させるようにしている。   However, although the thing of patent documents 1 makes an unmanned vehicle move autonomously, when an obstacle is detected ahead of a run direction, a plurality of avoidance routes for avoiding the obstacle are generated, Thereafter, the traveling is temporarily stopped, and one of the plurality of generated avoidance routes is presented to the operator for selection.

また、障害物を検出した場合のみならず、走行領域の環境をセンジングできないときにも、走行可否の判断を行うことができず、従って、危険を回避するための減速や停止を繰り返さざるを得ず、高速走行を行うことができないばかりか、その回避操作が煩雑であるという欠点がある。   In addition, not only when an obstacle is detected, but also when the environment of the traveling area cannot be sensed, it is not possible to determine whether or not the vehicle can travel. Therefore, it is necessary to repeatedly decelerate and stop to avoid danger. In addition, there is a disadvantage that not only high-speed traveling cannot be performed but also the avoidance operation is complicated.

さらに、走行可否の判別ができない走行可否識別不能領域であっても、遠隔操縦システムに設けられているディスプレイに提示された当該走行可否識別不能領域を見れば、走行可能であると操作者が判断できたとしても、その走行可否識別不能領域への進入走行を行うことができないという問題もある。   Furthermore, even if the region is indistinguishable / unidentifiable where it is not possible to determine whether or not it is possible to travel, the operator determines that it is possible to travel by looking at the unacceptable region that is displayed on the display provided in the remote control system. Even if it is possible, there is also a problem that it is not possible to enter and travel to the region where it is impossible to identify whether or not the vehicle can travel.

そこで本発明は、簡単な操作によって高速走行を行うことができるとともに、走行の可否判別できない領域と識別されたときにも、必要に応じて進入走行することができる半自律型無人車両の遠隔操縦システムの提供を目的としている。   Therefore, the present invention provides remote control of a semi-autonomous unmanned vehicle that can perform high-speed traveling by a simple operation and can enter and travel as necessary even when it is identified as an area where it is not possible to determine whether or not traveling is possible. The purpose is to provide a system.

上記目的を達成するための本発明に係る半自律型無人車両の遠隔操縦システムは、走行領域内の測距データを取得するための測距部、その走行領域の画像を取得するための撮像部及び走行するための走行機構を有し、取得した測距データに基づく自律走行を行うとともに、遠隔操縦装置よって遠隔操縦を行う半自律型無人車両と、上記撮像部によって撮像した走行領域の画像を表示する表示部、及びその表示部に表示された走行領域の画像に基づいて半自律型無人車両を遠隔操縦するための遠隔操縦装置とを、電気通信回線を通じて接続可能な構成になっている。
本発明においては、半自律型無人車両の走行が可能な走行可能領域、当該走行の可否判別が不能な走行可否識別不能領域及び当該走行が不可能な走行不可能領域を判別する領域判別手段と、
走行領域内の走行可否識別不能領域への進入の許可情報を受信したか否かを判定する許可情報受信判定手段と、当該許可情報を受信したと判定したときには、判別された走行不可能領域に基づき、走行可能領域及び進入が許可された走行可否識別不能領域内における自律走行のための走行経路を生成する走行経路生成手段と、生成した走行経路に従い、走行機構を介して半自律型無人車両を走行させる走行手段と、判別した走行可能領域、走行可否識別不能領域及び走行不可能領域を含む走行領域の画像を遠隔操縦装置に向けて送信する送信手段とを半自律型無人車両に設けたこと、上記走行可能領域、走行可否識別不能領域及び走行不可能領域を含む走行領域の画像を表示部に表示する画像表示手段と、走行可否識別不能領域への進入が許可されたか否かを判定する進入許否判定手段と、走行可否識別不能領域への進入を許可されたと判定したときには、走行可否識別不能領域への進入の許可情報を半自律型無人車両に向けて送出する許可情報送出手段とを遠隔操縦装置に設けたものとしている。
In order to achieve the above object, a remote control system for a semi-autonomous unmanned vehicle according to the present invention includes a distance measuring unit for acquiring distance measurement data in a traveling region, and an imaging unit for acquiring an image of the traveling region. and has a traveling mechanism for traveling, performs autonomous based on the acquired distance measurement data, and a semi-autonomous unmanned vehicle to perform Accordingly remote control in the remote control apparatus, an image of the travel area captured by the imaging unit And a remote control device for remotely maneuvering a semi-autonomous unmanned vehicle based on an image of a travel area displayed on the display unit can be connected through an electric communication line. .
In the present invention, an area discriminating means for discriminating a travelable area where a semi-autonomous unmanned vehicle can travel, a travel feasibility unidentifiable area where the travel feasibility cannot be determined, and a travel impossible area where the travel is impossible ,
A permission information reception determination unit that determines whether or not permission information for entering a travel permission / impossibility discriminating area within the travel area has been received, and when it is determined that the permission information has been received , Based on a travel route generating means for generating a travel route for autonomous travel in a travelable region and a travel permission / impossibility discriminating region permitted to enter, and a semi-autonomous unmanned vehicle via a travel mechanism according to the generated travel route The semi-autonomous unmanned vehicle is provided with a traveling means for traveling the vehicle, and a transmission means for transmitting the image of the travel area including the determined travelable area, the travel identifiable area and the travel impossible area to the remote control device. it, the travelable area, and an image display means for displaying an image of the traveling area including the traveling possibility unidentifiable region and running-prohibited area display unit, entering the travel permission unidentifiable region Huh When it is determined that entry into the runnable / unrecognizable area is permitted, the permission information for entering the runnable / unrecognizable area is sent to the semi-autonomous unmanned vehicle. The permission information sending means is provided in the remote control device.

上記の半自律型無人車両側においては、走行領域内の走行可否識別不能領域への進入の許可情報を受信したか否かを判定し、当該許可情報を受信したと判定したときには、判別された走行不可能領域に基づき、走行可能領域及び進入が許可された走行可否識別不能領域内における自律走行のための走行経路を生成するとともに、生成した走行経路に従い走行機構を介して走行し、判別した走行可否識別不能領域を含む走行領域の画像を遠隔操縦装置に向けて送信する。 On the above semi-autonomous unmanned vehicle side, it is determined whether or not the permission information for entering the travel enable / disable discriminating area in the travel area has been received, and when it is determined that the permission information has been received, it is determined . Based on the travel impossible region, a travel route for autonomous travel in the travel possible region and the travel permitted / unrecognizable region permitted to enter is generated, and traveled through the travel mechanism according to the generated travel route is determined. An image of the travel area including the travel identifiable area is transmitted to the remote control device.

一方、遠隔操縦装置側では、走行可否識別不能領域を含む走行領域の画像を表示部に表示する。また、走行可否識別不能領域への進入が許可されたか否かを判定し、走行可否識別不能領域への進入を許可されたと判定したときには、走行可否識別不能領域への進入の許可情報を半自律型無人車両に向けて送出している。   On the other hand, on the side of the remote control device, an image of the travel area including the travel identifiable area is displayed on the display unit. Further, it is determined whether or not entry into the runnable / unrecognizable area is permitted, and when it is determined that entry into the runnable / unrecognizable area is permitted, the permission information for entering the runnable / unidentifiable area is semi-autonomous. It is sent to the type unmanned vehicle.

本発明によれば、簡単な操作によって高速走行を行うことができるとともに、走行できるか否かを判別できないと識別された領域であっても、必要に応じて進入走行することができる。   According to the present invention, it is possible to perform high-speed traveling by a simple operation and to enter and travel as necessary even in an area that is identified as being unable to determine whether or not it is possible to travel.

本発明の一実施形態に係る半自律型無人車両の遠隔操縦システムの全体構成を示す説明図である。It is explanatory drawing which shows the whole structure of the remote control system of the semi-autonomous unmanned vehicle which concerns on one Embodiment of this invention. 同上の半自律型無人車両の遠隔操縦システムの一部をなす半自律型無人車両の構成を概略的に示す説明図である。It is explanatory drawing which shows roughly the structure of the semi-autonomous unmanned vehicle which comprises a part of the remote control system of a semi-autonomous unmanned vehicle same as the above. 同上の半自律型無人車両に設けた制御回路のブロック図である。It is a block diagram of the control circuit provided in the semiautonomous unmanned vehicle same as the above. 同上の半自律型無人車両に設けた車両制御用コンピュータが有する機能を示すブロック図である。It is a block diagram which shows the function which the computer for vehicle control provided in the semi-autonomous unmanned vehicle same as the above has. 表示部に表示される走行可能領域、走行可否識別不能領域及び走行不可能領域の画像を示す説明図である。It is explanatory drawing which shows the image of the driving | running | working possible area | region displayed on a display part, a driving | running | working availability discrimination impossible area, and a driving impossible area. 走行可能領域内のみと、走行可能領域内及び走行可否識別不能領域内で走行経路を生成したときの走行速度を比較した説明図である。It is explanatory drawing which compared the driving speed when a driving | running route was produced | generated only in a driving | running | working possible area | region, and a driving | running | working possible area | region and a driving | running | working availability discrimination | determination area | region. 走行速度の上限を決めるときの概念図である。It is a conceptual diagram when determining the upper limit of traveling speed. 同上の半自律型無人車両の遠隔操縦システムの一部をなす半自律型無人車両の制御フローチャートである。It is a control flowchart of the semiautonomous unmanned vehicle which forms a part of the remote control system of a semiautonomous unmanned vehicle same as the above. 同上の半自律型無人車両の遠隔操縦システムの一部をなす遠隔操縦装置に設けた制御回路のブロック図である。It is a block diagram of the control circuit provided in the remote control apparatus which comprises a part of the remote control system of a semi-autonomous unmanned vehicle same as the above. 同上の半自律型無人車両の遠隔操縦システムの一部をなす遠隔操縦装置による遠隔操縦を示すフローチャートである。It is a flowchart which shows the remote control by the remote control apparatus which comprises a part of the remote control system of a semi-autonomous unmanned vehicle same as the above.

以下に、本発明を実施するための形態について、図面を参照して説明する。図1は、本発明の一実施形態に係る半自律型無人車両の遠隔操縦システムの全体構成を示す説明図、図2は、その半自律型無人車両の遠隔操縦システムの一部をなす半自律型無人車両の構成を概略的に示す説明図である。また、図3は、その半自律型無人車両に設けた制御回路のブロック図である。   EMBODIMENT OF THE INVENTION Below, the form for implementing this invention is demonstrated with reference to drawings. FIG. 1 is an explanatory diagram showing the overall configuration of a semi-autonomous unmanned vehicle remote control system according to an embodiment of the present invention, and FIG. 2 is a semi-autonomous system that forms part of the semi-autonomous unmanned vehicle remote control system. It is explanatory drawing which shows the structure of a type | mold unmanned vehicle roughly. FIG. 3 is a block diagram of a control circuit provided in the semiautonomous unmanned vehicle.

図1に示すように、本発明の一実施形態に係る半自律型無人車両の遠隔操縦システムA1は、半自律型無人車両Bと、遠隔操縦装置Cとを電気通信回線を通じて接続可能に構成されている。   As shown in FIG. 1, a semi-autonomous unmanned vehicle remote control system A1 according to an embodiment of the present invention is configured to connect a semi-autonomous unmanned vehicle B and a remote control device C through an electric communication line. ing.

半自律型無人車両Bは、一般の乗用車両のハンドル/アクセル/ブレーキを、図2,3に示す車両制御用,走行用コンピュータ10,30によって操縦できるように、各種のアクチュエータを付加した構成のものであり、その詳細は次のとおりである。   The semi-autonomous unmanned vehicle B has a configuration in which various actuators are added so that the steering wheel / accelerator / brake of a general passenger vehicle can be controlled by the vehicle control and traveling computers 10 and 30 shown in FIGS. The details are as follows.

すなわち、半自律型無人車両Bは、CPU(Central Processing Unit)やインターフェース回路(いずれも図示しない)等からなる車両制御用コンピュータ10と、同じく走行用コンピュータ30とによって制御されるようになっている。   That is, the semi-autonomous unmanned vehicle B is controlled by the vehicle control computer 10 including a CPU (Central Processing Unit), an interface circuit (none of which are shown), and the traveling computer 30. .

車両制御用コンピュータ10と、走行用コンピュータ30とは、イーサネット(登録商標)11を介して互いに接続されている。
接続方式には、イーサネット(登録商標)以外にもCAN(Controller Area Network)等の車内ネットワークを用いることができる。
The vehicle control computer 10 and the travel computer 30 are connected to each other via the Ethernet (registered trademark) 11.
In addition to Ethernet (registered trademark), in-vehicle networks such as CAN (Controller Area Network) can be used as the connection method.

走行用コンピュータ30は、CPU(Central Processing Unit)やインターフェース回路(いずれも図示しない)等からなるものであり、これの入力ポートには、走行領域内の測距データを取得するための測距部33が接続されている。
測距部33は、走行用カメラ14,31と、レーザーセンサ(以下、「LRF」という。)32a,32bを有して構成されている(図3参照)。
The traveling computer 30 includes a CPU (Central Processing Unit), an interface circuit (none of which is shown), and the like, and a ranging unit for acquiring ranging data in the traveling region is provided at an input port thereof. 33 is connected.
The distance measuring unit 33 includes traveling cameras 14 and 31 and laser sensors (hereinafter referred to as “LRF”) 32a and 32b (see FIG. 3).

LRF32a,32bは、レーザ光の投光から受光までの時間を計測するタイムオブフライト方式による測距を行うものであり、本実施形態において示すものは、1つのレーザ光源を用い、光軸を光学的又は機械的に掃引することにより、物体の3次元的な形状を取得するスキャンタイプのものである。
本実施形態においては、一方のLRF32aが遠距離用のものであり、他方のLRF32bが近距離用のものであり、遠近を問わず走行領域をカバーできるようにしている。
The LRFs 32a and 32b perform distance measurement by a time-of-flight method for measuring the time from projecting to receiving of laser light. In the present embodiment, one laser light source is used and the optical axis is optical. This is a scan type that acquires a three-dimensional shape of an object by sweeping mechanically or mechanically.
In the present embodiment, one LRF 32a is for a long distance, and the other LRF 32b is for a short distance, so that the traveling area can be covered regardless of the distance.

走行用カメラ14,31は、自律走行を行うときに必要な画像データを取得するためのものであり、走行方向に向け、かつ、車幅方向において左右対称に配列されている。   The traveling cameras 14 and 31 are for acquiring image data necessary for autonomous traveling, and are arranged in a lateral direction symmetrically in the traveling direction and in the vehicle width direction.

車両制御用コンピュータ10は、CPU(Central Processing Unit)、インターフェース回路及びメモリ(いずれも図示しない)等からなるものである。
この車両制御用コンピュータ10の入力ポートには、イーサネット(登録商標)12を介して無線LAN13と撮像部である遠隔操縦用カメラ19が、また、GPS(Global Positioning System)15、バーチカルジャイロ16、車速パルス17及びオドメトリ18がそれぞれシリアル回線を介して接続されている。なお、符号20は、無線LAN13に接続されているアンテナを示している。
なお、無線LAN以外にも携帯電話、PHS、衛星回線等を用いることができることは勿論である。
The vehicle control computer 10 includes a CPU (Central Processing Unit), an interface circuit, a memory (all not shown), and the like.
An input port of the vehicle control computer 10 includes a wireless LAN 13 and a remote control camera 19 as an imaging unit via an Ethernet (registered trademark) 12, a GPS (Global Positioning System) 15, a vertical gyro 16, a vehicle speed. A pulse 17 and an odometry 18 are connected via a serial line. Reference numeral 20 denotes an antenna connected to the wireless LAN 13.
Of course, a mobile phone, PHS, satellite line, etc. can be used in addition to the wireless LAN.

また、出力ポートには、モータドライバ21を介して、ステアリング用アクチュエータ22、ブレーキ/アクセル用アクチュエータ23がそれぞれ接続されている。
なお、図1に示す9は走行輪であり、それらの走行輪9とともに、モータドライバ21、ステアリング用アクチュエータ22、ブレーキ/アクセル用アクチュエータ23により走行機構Dを構成している。
Further, a steering actuator 22 and a brake / accelerator actuator 23 are connected to the output port via a motor driver 21, respectively.
1 is a traveling wheel, and together with these traveling wheels 9, a motor driver 21, a steering actuator 22, and a brake / accelerator actuator 23 constitute a traveling mechanism D.

バーチカルジャイロ16は、半自律型無人車両Bの鉛直面内における傾斜姿勢、従ってまた、上記した走行用カメラ14,31、及びLRF32a,32bの光軸姿勢(向き)情報を取得するものである。   The vertical gyro 16 obtains the inclined posture in the vertical plane of the semi-autonomous unmanned vehicle B, and thus the optical axis posture (orientation) information of the above-described traveling cameras 14 and 31 and LRFs 32a and 32b.

オドメトリ18は、半自律型無人車両Bの走行輪9の各回転量に基づいて、自己の位置情報を取得するためのセンサである。
GPS15は、半自律型無人車両Bの測位情報を取得するためのものである。
車速パルス17は、半自律型無人車両Bの走行速度を測定するためのものであり、その走行速度をパルス情報として出力するものである。
The odometry 18 is a sensor for acquiring own position information based on each rotation amount of the traveling wheel 9 of the semi-autonomous unmanned vehicle B.
The GPS 15 is for acquiring positioning information of the semi-autonomous unmanned vehicle B.
The vehicle speed pulse 17 is for measuring the traveling speed of the semi-autonomous unmanned vehicle B, and outputs the traveling speed as pulse information.

車両制御用コンピュータ10は、イーサネット(登録商標)11,無線LAN13及びアンテナ20を通じて、GPS15、バーチカルジャイロ16で取得した各種の情報を、後述する遠隔操縦装置Cに向けて送信する機能の他、その遠隔操縦装置Cから送信される操縦情報に基づき、ステアリング用アクチュエータ22、ブレーキ/アクセル用アクチュエータ23をモータドライバ21を介して駆動制御する機能を有している。
すなわち、遠隔操縦装置Cから送信される半自律型無人車両Bに対する操縦情報に基づいて、ステアリング用アクチュエータ22及びブレーキ/アクセル用アクチュエータ23を駆動する機能を有している。
The vehicle control computer 10 has a function of transmitting various information acquired by the GPS 15 and the vertical gyro 16 to the remote control device C, which will be described later, through the Ethernet (registered trademark) 11, the wireless LAN 13, and the antenna 20. Based on the steering information transmitted from the remote control device C, the steering actuator 22 and the brake / accelerator actuator 23 are driven and controlled via the motor driver 21.
That is, it has a function of driving the steering actuator 22 and the brake / accelerator actuator 23 based on the operation information for the semi-autonomous unmanned vehicle B transmitted from the remote control device C.

車両制御用コンピュータ10は、図示しないメモリに記憶されている所要のプログラムの実行により、次の各機能を発揮する。図4は、半自律型無人車両に設けた車両制御用コンピュータが有する機能を示すブロック図、図5は、表示部に表示される走行可能領域、走行可否識別不能領域及び走行不可能領域の画像を示す説明図である。また、図6は、走行可能領域内のみと、走行可能領域内及び走行可否識別不能領域内で走行経路を生成したときの走行速度を比較した説明図、図7は、走行速度の上限を決めるときの概念図である。   The vehicle control computer 10 exhibits the following functions by executing required programs stored in a memory (not shown). FIG. 4 is a block diagram showing functions of a vehicle control computer provided in a semi-autonomous unmanned vehicle, and FIG. 5 is an image of a travelable area, a travelable / unrecognizable area, and a travelable area displayed on the display unit. It is explanatory drawing which shows. FIG. 6 is an explanatory diagram comparing travel speeds when travel routes are generated only within the travelable area, within the travelable area, and within the travelability discriminating area, and FIG. 7 determines the upper limit of the travel speed. It is a conceptual diagram of time.

(1)半自律走行コマンドが受信されたか否かを判定する機能。この機能を「コマンド判定手段10a」という。
(2)測距部33により取得した測距データに基づいて、環境地図を作成する機能。この機能を「地図作成手段10b」という。
本実施形態においては、LRF32a,32bにより取得したレーザー光データに基づいて環境地図を作成している。
また、作成した環境地図は、自律走行制御コンピュータ10内のメモリ(図示しない)に順次記憶されていくようになっている。
(1) A function for determining whether or not a semi-autonomous running command has been received. This function is referred to as “command determination means 10a”.
(2) A function for creating an environmental map based on distance measurement data acquired by the distance measurement unit 33. This function is referred to as “map creation means 10b”.
In the present embodiment, an environmental map is created based on the laser beam data acquired by the LRFs 32a and 32b.
Further, the created environment map is sequentially stored in a memory (not shown) in the autonomous running control computer 10.

(3)半自律型無人車両Bの走行状態を取得する機能。これを「走行状態取得手段10c」という。
本実施形態において示す「走行状態」は、半自律型無人車両Bの走行速度、操舵角及び傾き(水平面に対する)である。
これらのデータは、上記した車速パルス17、オドメトリ18及びバーチカルジャイロ16によって取得している。
(3) A function of acquiring the traveling state of the semi-autonomous unmanned vehicle B. This is referred to as “running state acquisition means 10c”.
The “traveling state” shown in the present embodiment is the traveling speed, steering angle, and inclination (relative to the horizontal plane) of the semi-autonomous unmanned vehicle B.
These data are acquired by the vehicle speed pulse 17, the odometry 18 and the vertical gyro 16 described above.

(4)上記環境地図に基づいて、走行領域内の少なくとも走行可否識別不能領域を判別する機能。この機能を「領域判別手段10d」という。
本実施形態においては、図5に示すように、半自律型無人車両Bの走行が可能な走行可能領域a1、当該走行の可否識別が不能な走行可否識別不能領域a2及び当該走行が不可能な走行不可能領域a3を判別している。
走行可否識別不能領域a2の抽出は、LRF32a,32bにより取得したレーザー光が反射しないことによる。換言すると、レーザー光データの取得ができない領域のことである。
(4) A function of discriminating at least a travelable / unrecognizable region in the travel region based on the environment map. This function is referred to as “region discrimination means 10d”.
In the present embodiment, as shown in FIG. 5, a travelable area a1 in which the semi-autonomous unmanned vehicle B can travel, a travelable / unrecognizable area a2 in which it is impossible to identify whether the travel is possible, and the travel are impossible. The travel impossible area a3 is determined.
The extraction of the runnable / unidentifiable area a2 is based on the fact that the laser light acquired by the LRFs 32a and 32b is not reflected. In other words, it is an area where laser light data cannot be acquired.

(5)判別した走行可否識別不能領域a3への進入の許可情報を受信したか否かを判定する機能。この機能を「許可情報受信判定手段10e」という。
(6)当該許可情報を受信したと判定したときには、走行可能領域a1及び進入が許可された走行可否識別不能領域a2内における自律走行のための走行経路を生成する機能。この機能を「走行経路生成手段10f」という。
また、許可情報を受信していないと判定したときには、走行可能領域a1内における自律走行のための走行経路を生成する。
すなわち、「走行経路」は、走行可能領域a1内又は走行可能領域a1及び進入が許可された走行可否識別不能領域a2内における半自律型無人車両Bの走行ルートであり、本実施形態においてはポテンシャル法を用いて生成している。
また、走行可能領域a1内又は走行可能領域a1及び進入が許可された走行可否識別不能領域a2内の自律移動の妨げとなる障害物を検出したときには、その障害物を回避するための走行経路を作成する。
(5) A function of determining whether or not the permission information for entering the determined travelability discriminating area a3 has been received. This function is referred to as “permission information reception determination means 10e”.
(6) A function of generating a travel route for autonomous traveling in the travelable region a1 and the travelable / unrecognizable region a2 permitted to enter when it is determined that the permission information has been received. This function is referred to as “travel route generation means 10f”.
Moreover, when it determines with not receiving permission information, the driving | running route for the autonomous driving | running | working in the driving | running | working possible area | region a1 is produced | generated.
That is, the “travel route” is a travel route of the semi-autonomous unmanned vehicle B in the travelable region a1 or the travelable region a1 and the travelable / unrecognizable region a2 permitted to enter. It is generated using the method.
In addition, when an obstacle that hinders autonomous movement in the travelable area a1 or in the travelable area a1 and in the travelable / unidentifiable area a2 permitted to enter, a travel route for avoiding the obstacle is detected. create.

(7)生成した走行経路に応じて走行速度を増減計画する機能。この機能を「速度計画手段10g」という。
「走行経路に応じた半自律型無人車両Bの走行速度」は、走行可能領域a1内において走行経路を生成した場合、図6に(ア)で示す上限速度で制限された走行速度になる。
また、詳細を後述する進入許否スイッチ65をオン操作したときには、走行可否識別不能領域a3への進入が許されるので、(イ)で示すように、その分だけ上限速度が高くなって走行速度を増加させることができる。
(7) A function for increasing / decreasing the traveling speed according to the generated traveling route. This function is referred to as “speed planning means 10 g”.
The “travel speed of the semi-autonomous unmanned vehicle B according to the travel route” is a travel speed limited by the upper limit speed shown in FIG. 6A when the travel route is generated in the travelable area a1.
Further, when an entry permission / rejection switch 65, which will be described in detail later, is turned on, entry into the runnable / unrecognizable area a3 is allowed, so as shown in (a), the upper limit speed is increased accordingly and the running speed is increased. Can be increased.

詳細に説明すると、図7に示すとおりである。
Bk(v+aδt)<L
Bk():停止可能距離
(通常を警戒領域/急停止を危険領域)
δt:通信・制御等の時間遅れ分
v:走行速度
L:半自律型無人車両Bの走行方向における走行不可能領域a1まで、又は進入が許可された走行可否識別不能領域a2までの距離
上記式を満たす「a」を警戒/危険加速度と定義
This will be described in detail as shown in FIG.
Bk (v + aδt) <L
Bk (): Stoppable distance (normal warning area / sudden stop danger area)
δt: Time delay for communication, control, etc. v: Travel speed L: Distance to the travel impossibility region a1 in the travel direction of the semi-autonomous unmanned vehicle B, or to the travel permit / impossibility discriminable region a2 permitted to enter "A" that satisfies the condition is defined as warning / dangerous acceleration

(8)判別された走行可否識別不能領域a2を遠隔操縦装置Cに向けて送信する機能。この機能を「送信手段10h」という。
(9)遠隔操縦装置Cによる遠隔操縦又は生成した走行経路及び計画速度に従い、走行機構Dを介して半自律型無人車両Bを走行させる機能。これを「走行手段10i」という。
「操縦情報」は、少なくとも走行方向、走行速度及び半自律型無人車両Bの加減速データを含むものである。
(8) A function of transmitting the determined travel possibility / impossibility discriminating area a2 to the remote control device C. This function is referred to as “transmission means 10h”.
(9) A function of causing the semi-autonomous unmanned vehicle B to travel through the travel mechanism D according to the remote control by the remote control device C or the generated travel route and the planned speed. This is referred to as “traveling means 10i”.
The “control information” includes at least the traveling direction, the traveling speed, and the acceleration / deceleration data of the semi-autonomous unmanned vehicle B.

(10)走行可否識別不能領域a2を識別するための識別化処理を行う機能。この機能を「識別化手段10j」という。
具体的には、少なくとも走行可否識別不能領域a2を他の移動領域とは異なる視覚効果処理を行うものであり、走行可否識別不能領域a2に色彩を付する等である。これにより、走行可否識別不能領域a2を視覚的に強調することができ、識別を容易に行うことができる。
なお、本実施形態においては、走行可能領域a1、走行可否識別不能領域a2及び走行不可能領域a3をそれぞれ互いに識別できるように色彩を付している。
(10) A function of performing identification processing for identifying the runnable / unidentifiable area a2. This function is referred to as “identification means 10j”.
Specifically, visual effect processing is performed at least for the travel feasible / unrecognizable area a2 different from other moving areas, and the run feasible / unrecognizable area a2 is colored. As a result, the runnable / unrecognizable region a2 can be visually emphasized, and identification can be easily performed.
In the present embodiment, the runnable area a1, the runnable / unrecognizable area a2 and the unrunnable area a3 are colored so that they can be distinguished from each other.

(11)撮像部33により撮像した走行領域の画像に識別化処理した走行可否識別不能領域a2の画像を重畳処理する機能。この機能を「重畳処理手段10k」という。
具体的には、遠隔操縦用カメラ19によって取得した走行領域の画像に、本実施形態においては、それぞれ識別化処理した走行可能領域a1、走行可否識別不能領域a2、走行不可能領域a3及び生成した走行経路等を重畳処理している。
(11) A function of superimposing the image of the travelable / unrecognizable area a2 that has been subjected to the classification process on the image of the traveled area captured by the imaging unit 33. This function is referred to as “superimposition processing means 10k”.
Specifically, in the present embodiment, an image of the travel area acquired by the remote control camera 19 is generated in the present embodiment, the travel enable area a1, the travel enable / disable discriminable area a2, and the travel impossible area a3 that are identified. The travel route is superimposed.

次に、図8を参照して半自律型無人車両の制御フローチャートについて説明する。図8は、半自律型無人車両の制御フローチャートである。
<半自律型無人車両側の制御フローチャート>
ステップ1(図中、「S1」と略記する。以下、同様。):各部の初期化処理を行ってステップ2に進む。
Next, a control flowchart of the semi-autonomous unmanned vehicle will be described with reference to FIG. FIG. 8 is a control flowchart of the semi-autonomous unmanned vehicle.
<Semi-autonomous unmanned vehicle control flowchart>
Step 1 (abbreviated as “S1” in the figure. The same applies hereinafter): Initialization processing of each part is performed, and the process proceeds to Step 2.

ステップ2:遠隔操縦装置Cから送信された操縦者Qによる操縦情報(操縦コマンド)を受信して、ステップ3に進む。
ステップ3:終了コマンドを受信したか否かを判定し、終了コマンドを受信すればステップ00に進んで、そうでなければステップ4に進む。
Step 2: The control information (control command) by the operator Q transmitted from the remote control device C is received, and the process proceeds to Step 3.
Step 3: It is determined whether or not an end command is received. If an end command is received, the process proceeds to Step 00, and if not, the process proceeds to Step 4.

ステップ4:LRF32a,32bによって測距データを取得する。
ステップ5:取得した測距データに基づいて、環境地図を作成する。
ステップ6:半自律型無人車両Bの走行状態を取得する。
Step 4: Distance measurement data is acquired by the LRFs 32a and 32b.
Step 5: Create an environmental map based on the acquired distance measurement data.
Step 6: The traveling state of the semi-autonomous unmanned vehicle B is acquired.

ステップ7:作成した環境地図に基づいて、走行可能領域、走行可否識別不能領域及び走行不可能領域を判別する。
ステップ8:許可情報を受信したか否かを判定し、その許可情報を受信したと判定されればステップ9に進み、そうでなければステップ14に進む。
Step 7: Based on the created environment map, a travelable area, a travelable / unrecognizable area, and a travelable area are determined.
Step 8: It is determined whether or not permission information has been received. If it is determined that the permission information has been received, the process proceeds to Step 9; otherwise, the process proceeds to Step 14.

ステップ9:走行可能領域及び走行可否識別不能領域において走行経路を生成する。
ステップ10:生成した走行経路に応じた走行速度を生成する。
ステップ11:走行可能領域a1、走行可否識別不能領域a2及び走行不可能領域a3を識別化処理する。
ステップ12:識別化した走行可能領域a1、走行可否識別不能領域a2及び走行不可能領域a3とともに、生成した走行経路を走行領域に重畳処理する。
Step 9: A travel route is generated in the travelable area and the travel identifiable area.
Step 10: Generate a traveling speed according to the generated traveling route.
Step 11: The travelable area a1, the travelable / unrecognizable area a2, and the untravelable area a3 are identified.
Step 12: The generated travel route is superimposed on the travel region together with the identified travelable region a1, travel feasibility unidentifiable region a2, and travel impossible region a3.

ステップ13:重畳処理した画像や走行状態を遠隔操縦装置に向けて送信し、ステップ2に戻る。
ステップ14:走行可能領域のみにおいて走行経路を生成する。
ステップ15:終了処理を行う。
Step 13: The superimposed image and the running state are transmitted to the remote control device, and the process returns to Step 2.
Step 14: A travel route is generated only in the travelable area.
Step 15: End processing is performed.

次に、遠隔操縦装置について、図9,10を参照して説明する。図9は、遠隔操縦装置に設けた制御回路のブロック図、図10は、遠隔操縦装置による遠隔操縦を示すフローチャートである。
本実施形態において示す遠隔操縦装置Cは、図1に示すように、装置本体50上に表示部60を配設した外観構成になっている。以下、表示部をディスプレイという。
Next, the remote control device will be described with reference to FIGS. FIG. 9 is a block diagram of a control circuit provided in the remote control device, and FIG. 10 is a flowchart showing remote control by the remote control device.
As shown in FIG. 1, the remote control device C shown in the present embodiment has an external configuration in which a display unit 60 is disposed on the device main body 50. Hereinafter, the display unit is referred to as a display.

装置本体50は、基台62の一端部に操作盤63が起立して配設されており、その操作盤63の上部にステアリングホイール56が、また、その下部にアクセルペダル57がそれぞれ配設されている。   In the apparatus main body 50, an operation panel 63 is disposed upright at one end of a base 62, a steering wheel 56 is disposed above the operation panel 63, and an accelerator pedal 57 is disposed below the operation panel 63. ing.

操作盤63には、図9に示すように、走行可否識別不能領域a3への進入の許否を設定するための進入許否スイッチ65が配設されている。
操縦者Qは、基台62に配設された椅子64に腰掛けた状態で、ステアリングホイール56、アクセルペダル57及び進入許否スイッチ65の操作を行えるようにしている。
As shown in FIG. 9, the operation panel 63 is provided with an entry permission / denial switch 65 for setting permission / inhibition of entry into the travel permission / inhibition discriminable area a3.
The operator Q can operate the steering wheel 56, the accelerator pedal 57 and the entry permission / denial switch 65 while sitting on a chair 64 disposed on the base 62.

装置本体50内には、CPU(Central Processing Unit)やインターフェース回路(いずれも図示しない)等からなる入力ポートに、無線LAN52、回転角センサ53、ステアリングホイール56、アクセルペダル57、進入許否スイッチ65、また、出力ポートにステアリング加重機構54、アクセル加重機構55、ディスプレイ60を接続した制御装置51が配設されている。なお、符号58で示すものはアンテナである。   In the apparatus main body 50, an input port including a CPU (Central Processing Unit), an interface circuit (none of which is shown), and the like are connected to a wireless LAN 52, a rotation angle sensor 53, a steering wheel 56, an accelerator pedal 57, an entry permission / denial switch 65, Further, a control device 51 in which a steering weight mechanism 54, an accelerator weight mechanism 55, and a display 60 are connected to the output port is provided. In addition, what is shown with the code | symbol 58 is an antenna.

ステアリングホイール56は、半自律型無人車両Bの走行方向を操縦するためのものであり、これには、上記ステアリング加重機構54と回転角センサ53とが取り付けられている。
本実施形態において示すステアリング加重機構54は、ステアリング56の上記した操縦警戒角度範囲において、そのステアリングホイール56の操縦力を増減加重するものであり、本実施形態においては、図示しないアクチュエータを有する構成になっている。
The steering wheel 56 is for steering the traveling direction of the semi-autonomous unmanned vehicle B, to which the steering weight mechanism 54 and the rotation angle sensor 53 are attached.
The steering weight mechanism 54 shown in the present embodiment increases or decreases the steering force of the steering wheel 56 in the above-described steering warning angle range of the steering 56. In this embodiment, the steering weight mechanism 54 has an actuator (not shown). It has become.

アクセルペダル57は、半自律型無人車両Bの加減速を操縦するためのものであり、これには、上記したアクセル加重機構55が取り付けられている。
アクセル加重機構55は、アクセルペダル57の操縦力を加重するものであり、図示しない仮想バネの挙動を示すようにしている。
The accelerator pedal 57 is for maneuvering the acceleration / deceleration of the semi-autonomous unmanned vehicle B, and the accelerator weighting mechanism 55 described above is attached thereto.
The accelerator weighting mechanism 55 weights the steering force of the accelerator pedal 57 and exhibits the behavior of a virtual spring (not shown).

ディスプレイ60には、上記したカメラ14,31によって取得した走行領域の画像に、識別化した走行可能領域a1、走行可否識別不能領域a2及び走行不可能領域a3等が重畳表示されるようになっている。   On the display 60, the identified travelable area a 1, travelable / unrecognizable area a 2, unrunnable area a 3, and the like are superimposed and displayed on the images of the travel areas acquired by the cameras 14 and 31. Yes.

制御装置51は、所要のプログラムの実行により次の各機能を発揮する。
(12)半自律型無人車両Bと遠隔操縦装置Cとの間における通信遅延時間を算出する機能。この機能を「遅延時間算出手段51a」という。
本実施形態においては、半自律型無人車両Bと遠隔操縦装置Cの間において、pingの要領でデータの往復時間を推定している。
また、半自律型無人車両Bと遠隔操縦装置C双方にGPSを搭載しておき、そのGPSを用いて双方のコンピュータによって精度の高い時刻同期を行い、受信したデータのタイムスタンプに基づいて遅延時間を推定するようにしてもよい。
(13)半自律型無人車両Bから送信された画像をディスプレイ60に表示する機能。この機能を「画像表示手段51b」という。
The control device 51 exhibits the following functions by executing a required program.
(12) A function of calculating a communication delay time between the semi-autonomous unmanned vehicle B and the remote control device C. This function is referred to as “delay time calculation means 51a”.
In this embodiment, the round trip time of data is estimated between the semi-autonomous unmanned vehicle B and the remote control device C in the manner of ping.
In addition, GPS is installed in both the semi-autonomous unmanned vehicle B and the remote control device C, time synchronization with high accuracy is performed by both computers using the GPS, and the delay time is based on the time stamp of the received data. May be estimated.
(13) A function of displaying an image transmitted from the semi-autonomous unmanned vehicle B on the display 60. This function is referred to as “image display means 51b”.

(14)走行領域の画像を撮像した時刻から所要時間経過後までの半自律型無人車両Bの走行予定経路及び算出した推定遅延時間に基づいて、その半自律型無人車両Bが遠隔操縦装置Cによって遠隔操縦される時刻における車両位置を推定する機能。この機能を「車両位置推定手段51c」という。 (14) Based on the planned travel route of the semi-autonomous unmanned vehicle B and the calculated estimated delay time from the time when the image of the travel region was captured until the lapse of the required time, the semi-autonomous unmanned vehicle B is operated by the remote control device C. A function to estimate the vehicle position at the time of being remotely controlled by. This function is referred to as “vehicle position estimation means 51c”.

(15)進入許否スイッチ65の操作に従って、走行可否識別不能領域a2への進入の許否を判定する機能。この機能を「進入許否判定手段51d」という。
「進入許否スイッチ65の操作」は、操縦者Qがディスプレイ60に表示されている画像を見て、例えば走行可否識別不能領域a3が走行可能であると判断したときに、その進入許否スイッチ65をオン操作する。これにより、走行可否識別不能領域a2への進入ができるようになる。
(15) A function for determining whether or not to enter the travel allowance / disapproval discrimination area a2 in accordance with the operation of the entry permit / denial switch 65. This function is referred to as “entry permission / non-permission determination means 51d”.
“Operation of entry permission switch 65” refers to the entry permission switch 65 when, for example, the operator Q sees the image displayed on the display 60 and determines that the traveling permission / disapproval discriminating region a3 can travel. Turn on. As a result, it becomes possible to enter the travel-availability discriminating area a2.

(16)ステアリングホイール56の上記した操縦警戒角度に応じて、ステアリング加重機構54によってステアリングホイール56の操縦力を増減加重する機能。この機能を「ステアリング増減加重手段51e」という。
具体的には、ステアリングホイール56の操縦角度が大きくなるに従って大きな力が必要となるようにしている。
(16) A function of increasing or decreasing the steering force of the steering wheel 56 by the steering weight mechanism 54 in accordance with the above-described steering warning angle of the steering wheel 56. This function is referred to as “steering increase / decrease weighting means 51e”.
Specifically, a greater force is required as the steering angle of the steering wheel 56 increases.

(17)アクセルペダル57の操縦警戒角度に応じて、アクセル加重機構55によってアクセル57の操縦力を増減加重する機能。この機能を「アクセル増減加重手段51h」という。
具体的には、アクセルペダル57の踏込み角度が大きくなるに従って大きな力が必要となるようにしている。
(17) A function of increasing or decreasing the steering force of the accelerator 57 by the accelerator weighting mechanism 55 according to the steering warning angle of the accelerator pedal 57. This function is referred to as “accelerator increase / decrease weighting means 51h”.
Specifically, a greater force is required as the depression angle of the accelerator pedal 57 increases.

(18)ステアリングホイール56やアクセルペダル57の操縦情報を生成する機能。この機能を「操縦情報生成手段51f」という。
(19)走行可否識別不能領域への進入を許可されたと判定したときには、走行可否識別不能領域への進入の許可情報を半自律型無人車両に向けて送出する機能。この機能を「許可情報送出手段51g」という。
なお、遠隔操縦装置Cからは、上記許可情報の他、生成した操縦情報等が半自律型無人車両Bに向けて送信されるようになっている。
(18) A function for generating steering information of the steering wheel 56 and the accelerator pedal 57. This function is referred to as “steering information generating means 51f”.
(19) A function of sending permission information for entering the runnable / unidentifiable area to the semi-autonomous unmanned vehicle when it is determined that the entry into the unrecognizable area is allowed. This function is referred to as “permission information sending means 51g”.
The remote control device C transmits the generated control information and the like to the semi-autonomous unmanned vehicle B in addition to the permission information.

次に、図10を参照して、遠隔操縦装置による遠隔操縦について説明する。
ステップ1(図中、「S1」と略記する。以下、同様。):各部の初期化処理を行ってステップ2に進む。
ステップ2:半自律型無人車両Bから送信された画像や車両情報(速度等)及びコマンドを受信して、ステップ3に進む。
ステップ3:通信遅延時間を算出して、ステップ4に進む。
Next, remote control by the remote control device will be described with reference to FIG.
Step 1 (abbreviated as “S1” in the figure. The same applies hereinafter): Initialization processing of each part is performed, and the process proceeds to Step 2.
Step 2: The image, vehicle information (speed, etc.) and command transmitted from the semi-autonomous unmanned vehicle B are received, and the process proceeds to Step 3.
Step 3: Calculate the communication delay time and proceed to Step 4.

ステップ4:カメラ14,31で撮像した画像に、算出した通信遅延時間による半自律型半自律型無人車両Bの走行量を補正した上で、カメラ14,31で撮像した画像に、識別化した走行可能領域a1、走行可否識別不能領域a2及び走行不可能領域a3を重畳処理した画像、及び受信した車両情報を重畳表示してステップ5に進む。   Step 4: After correcting the travel amount of the semi-autonomous semi-autonomous unmanned vehicle B based on the calculated communication delay time on the images captured by the cameras 14 and 31, the images captured by the cameras 14 and 31 are identified. An image obtained by superimposing the travelable area a1, the travelability indistinguishable area a2 and the travel impossible area a3 and the received vehicle information are superimposed and displayed, and the process proceeds to Step 5.

ステップ5:ディスプレイ60に表示されている、識別化した走行可否判別不能領域を含む画像及び受信した車両情報を参照しながら、アクセルペダル57、ステアリングホイール56を操縦するとともに、必要に応じて進入許否スイッチ65を操作する。   Step 5: The accelerator pedal 57 and the steering wheel 56 are operated while referring to the image including the identified travel feasibility discriminating area and the received vehicle information displayed on the display 60, and entry permission / rejection as necessary. The switch 65 is operated.

ステップ6:進入許否スイッチ65の操作に従って走行可否識別不能領域a2への進入の許否を判定し、進入許否スイッチ65がオン操作されて走行可否識別不能領域a2への進入が許可されていると判定したときにはステップ7に進み、そうでなければステップ2に戻る。   Step 6: It is determined whether or not entry into the travel permission / inhibition discriminable area a2 is permitted according to the operation of the entry permission / inhibition switch 65, and it is determined that the entrance permission / inhibition switch 65 is turned on and entry into the travel permission / inhibit discrimination area a2 is permitted. If yes, go to Step 7, otherwise return to Step 2.

ステップ7:許可情報とともに生成した操縦情報を半自律型無人車両に向けて送信する。
ステップ8:アクセルへダル57と、ステアリングホイール56の操縦力を増減加重する。
Step 7: The control information generated together with the permission information is transmitted to the semi-autonomous unmanned vehicle.
Step 8: Increase / decrease the accelerator force 57 and the steering force of the steering wheel 56.

なお、本発明は上述した実施形態に限るものではなく、次のような変形実施が可能である。
・精度を補完する機能を付加する場合、次のようにすることができる。
車速パルスの補完として、車両の速度(積分して)/車両の傾き(重力を検出して)を測定するための加速度センサ、車両の速度を算出するためのタコメータを設けた構成にしてもよい。
・バーチカルジャイロの補完として、車両の傾き(水平面に対する)を検出するための傾斜角センサを配設してもよい。
The present invention is not limited to the above-described embodiments, and the following modifications can be made.
・ When adding a function to complement accuracy, the following can be done.
As a complement to the vehicle speed pulse, an acceleration sensor for measuring the vehicle speed (integrated) / vehicle inclination (by detecting gravity) and a tachometer for calculating the vehicle speed may be provided. .
A tilt angle sensor for detecting the tilt of the vehicle (relative to the horizontal plane) may be provided as a complement to the vertical gyro.

・上述した実施形態においては、車両制御用コンピュータと、走行用コンピュータの2つのコンピュータにより、半自律型無人車両全体を制御するものを例として説明したが、それら2つのコンピュータに分担させることなく、単一のコンピュータで制御するようにしてもよい。 -In embodiment mentioned above, although what controlled the semi-autonomous unmanned vehicle by the two computers of a vehicle control computer and a driving | running | working computer was demonstrated as an example, without making these two computers share, You may make it control by a single computer.

10b 地図作成手段
10d 領域判別手段
10e 許可情報受信判定手段
10f 走行経路生成手段
10g 速度計画手段
10h 送信手段
10i 走行手段
10j 識別化手段
10k 重畳処理手段
14 撮像部
33 測距部
51a 遅延時間算出手段
51b 画像表示手段
51c 車両位置推定手段
51d 進入許否判定手段
51g 許可情報送出手段
60 表示部(ディスプレイ)
65 進入許否スイッチ
a1 走行可能領域
a2 走行可否識別不能領域
a3 走行不可能領域
A 半自律型無人車両の遠隔操縦システム
B 半自律型無人車両
C 遠隔操縦装置
D 走行機構
10b Map creation means 10d Area determination means 10e Permission information reception determination means 10f Travel route generation means 10g Speed plan means 10h Transmission means 10i Travel means 10j Identification means 10k Superimposition processing means 14 Imaging part 33 Distance measurement part 51a Delay time calculation means 51b Image display means 51c Vehicle position estimation means 51d Entry permission determination means 51g Permission information sending means 60 Display unit (display)
65 Access permission switch a1 Travelable area a2 Travelable / unrecognizable area a3 Travelless area A Semi-autonomous unmanned vehicle remote control system B Semi-autonomous unmanned vehicle C Remote control device D Travel mechanism

Claims (6)

走行領域内の測距データを取得するための測距部、その走行領域の画像を取得するための撮像部及び走行するための走行機構を有し、取得した測距データに基づく自律走行を行うとともに、遠隔操縦装置よって遠隔操縦を行う半自律型無人車両と、上記撮像部によって撮像した走行領域の画像を表示する表示部、及びその表示部に表示された走行領域の画像に基づいて半自律型無人車両を遠隔操縦するための遠隔操縦装置とを、電気通信回線を通じて接続可能な半自律型無人車両の遠隔操縦システムにおいて、
半自律型無人車両の走行が可能な走行可能領域、当該走行の可否判別が不能な走行可否識別不能領域及び当該走行が不可能な走行不可能領域を判別する領域判別手段と、
上記走行可否識別不能領域への進入の許可情報を受信したか否かを判定する許可情報受信判定手段と、
当該許可情報を受信したと判定したときには、判別された走行不可能領域に基づき、走行可能領域及び進入が許可された走行可否識別不能領域内における自律走行のための走行経路を生成する走行経路生成手段と、
生成した走行経路に従い、走行機構を介して半自律型無人車両を走行させる走行手段と、
判別した走行可能領域、走行可否識別不能領域及び走行不可能領域を含む走行領域の画像を遠隔操縦装置に向けて送信する送信手段とを半自律型無人車両に設けたこと、
判別した走行可能領域、走行可否識別不能領域及び走行不可能領域を含む走行領域の画像を表示部に表示する画像表示手段と、
走行可否識別不能領域への進入が許可されたか否かを判定する進入許否判定手段と、
走行可否識別不能領域への進入を許可されたと判定したときには、走行可否識別不能領域への進入の許可情報を半自律型無人車両に向けて送出する許可情報送出手段とを遠隔操縦装置に設けたことを特徴とする半自律型無人車両の遠隔操縦システム。
It has a ranging unit for acquiring ranging data in the traveling area, an imaging unit for acquiring images of the traveling area, and a traveling mechanism for traveling, and performs autonomous traveling based on the acquired ranging data with a semi-autonomous unmanned vehicle to perform Accordingly remote control in the remote control apparatus, the display unit for displaying an image of the travel area captured by the imaging unit, and based on the image of the displayed running region on the display unit half In a semi-autonomous unmanned vehicle remote control system that can be connected to a remote control device for remotely controlling an autonomous unmanned vehicle through an electric communication line,
An area discriminating means for discriminating a runnable area in which a semi-autonomous unmanned vehicle can run, a runnable / unrecognizable area in which the runnability determination is impossible, and an unrunnable area in which the run is impossible;
And permission information reception determining means for determining whether or not it has received authorization information entry into the running permission unidentifiable region,
When it is determined that the permission information has been received, a travel route generation for generating a travel route for autonomous traveling in the travelable region and the travel-permitted / unrecognizable region where entry is permitted based on the determined travel-impossible region Means,
Traveling means for traveling the semi-autonomous unmanned vehicle via the traveling mechanism according to the generated traveling route;
A semi-autonomous unmanned vehicle is provided with a transmission means for transmitting an image of a travel region including the determined travelable region, a travelability determination impossible region, and a travel impossible region to the remote control device,
An image display means for displaying an image of the travel area including the determined travelable area, the travel identifiable area and the travel impossible area on the display unit;
An entry permission determination means for determining whether or not an entry into the runnable / unidentifiable area is permitted;
The remote control device is provided with permission information sending means for sending permission information for entering the runnable / unrecognizable area into the semi-autonomous unmanned vehicle when it is determined that entry into the unrecognizable area is allowed. A semi-autonomous unmanned vehicle remote control system.
走行領域内の測距データを取得するための測距部、その走行領域の画像を取得するための撮像部及び走行するための走行機構を有し、取得した測距データに基づく自律走行を行うとともに、遠隔操縦装置よって遠隔操縦を行う半自律型無人車両と、上記撮像部によって撮像した走行領域の画像を表示する表示部、及びその表示部に表示された走行領域の画像に基づいて半自律型無人車両を遠隔操縦するための遠隔操縦装置とを、電気通信回線を通じて接続可能な半自律型無人車両の遠隔操縦システムにおいて、
半自律型無人車両の走行が可能な走行可能領域、当該走行の可否判別が不能な走行可否識別不能領域及び当該走行が不可能な走行不可能領域を判別する領域判別手段と、
判別した走行可否識別不能領域への進入の許可情報を受信したか否かを判定する許可情報受信判定手段と、
当該許可情報を受信したと判定したときには、判別された走行不可能領域に基づき、走行可能領域及び進入が許可された走行可否識別不能領域内における自律走行のための走行経路を生成する走行経路生成手段と、
走行可能領域、走行可否識別不能領域及び走行不可能領域を含む走行領域の画像を遠隔操縦装置に向けて送信する送信手段とを半自律型無人車両に設けたこと、
生成した走行経路に応じて走行速度を増減計画する速度計画手段と、
遠隔操縦装置による遠隔操縦又は生成した走行経路及び計画速度に従い、走行機構を介して半自律型無人車両を走行させる走行手段と、
少なくとも走行可否識別不能領域を表示部上に視覚的に識別表示するための識別化処理を行う識別化手段と、
上記撮像部により撮像した走行領域の画像に識別化処理した走行可否識別不能領域の画像を重畳処理する重畳処理手段と、
重畳処理された画像を遠隔操縦装置に向けて送信する送信手段とを半自律型無人車両に設けたこと、
半自律型無人車両から送信された画像を表示部に表示する画像表示手段と、
走行可否識別不能領域への進入が許可されたか否かを判定する進入許否判定手段と、
走行可否識別不能領域への進入を許可されたと判定したときには、走行可否識別不能領域への進入の許可情報を半自律型無人車両に向けて送出する許可情報送出手段とを遠隔操縦装置に設けたことを特徴とする半自律型無人車両の遠隔操縦システム。
It has a ranging unit for acquiring ranging data in the traveling area, an imaging unit for acquiring images of the traveling area, and a traveling mechanism for traveling, and performs autonomous traveling based on the acquired ranging data with a semi-autonomous unmanned vehicle to perform Accordingly remote control in the remote control apparatus, the display unit for displaying an image of the travel area captured by the imaging unit, and based on the image of the displayed running region on the display unit half In a semi-autonomous unmanned vehicle remote control system that can be connected to a remote control device for remotely controlling an autonomous unmanned vehicle through an electric communication line,
An area discriminating means for discriminating a runnable area in which a semi-autonomous unmanned vehicle can run, a runnable / unrecognizable area in which the runnability determination is impossible, and an unrunnable area in which the run is impossible;
Permission information reception determination means for determining whether or not the permission information for entering the determined travel permission / impossibility discriminating area has been received;
When it is determined that the permission information has been received, a travel route generation for generating a travel route for autonomous traveling in the travelable region and the travel-permitted / unrecognizable region where entry is permitted based on the determined travel-impossible region Means,
A semi-autonomous unmanned vehicle is provided with a transmission means for transmitting an image of a travel region including a travelable region, a travelability determination impossible region and a travel impossible region to a remote control device,
Speed planning means for planning to increase or decrease the traveling speed according to the generated traveling route;
Traveling means for traveling a semi-autonomous unmanned vehicle via a traveling mechanism according to remote control by a remote control device or a generated travel route and a planned speed;
Discriminating means for performing a discriminating process for visually identifying and displaying at least a travelable / unidentifiable area on the display unit;
Superimposition processing means for performing superimposition processing on the image of the travelable / unrecognizable region that has been subjected to the identification processing on the image of the traveling region imaged by the imaging unit;
A semi-autonomous unmanned vehicle is provided with a transmission means for transmitting the superimposed image to the remote control device,
Image display means for displaying an image transmitted from the semi-autonomous unmanned vehicle on the display unit;
An entry permission determination means for determining whether or not an entry into the runnable / unidentifiable area is permitted;
The remote control device is provided with permission information sending means for sending permission information for entering the runnable / unrecognizable area into the semi-autonomous unmanned vehicle when it is determined that entry into the unrecognizable area is allowed. A semi-autonomous unmanned vehicle remote control system.
走行領域内の測距データを取得するための測距部、その走行領域の画像を取得するための撮像部及び走行するための走行機構を有し、取得した測距データに基づく自律走行を行うとともに、遠隔操縦装置よって遠隔操縦を行う半自律型無人車両と、上記撮像部によって撮像した走行領域の画像を表示する表示部、及びその表示部に表示された走行領域の画像に基づいて半自律型無人車両を遠隔操縦するための遠隔操縦装置とを、電気通信回線を通じて接続可能な半自律型無人車両の遠隔操縦システムにおいて、
測距部により取得した測距データに基づいて環境地図を作成する地図作成手段と、
作成した環境地図に基づいて、半自律型無人車両の走行が可能な走行可能領域、当該走行の可否判別が不能な走行可否識別不能領域及び当該走行が不可能な走行不可能領域を判別する領域判別手段と、
判別した走行可否識別不能領域への進入の許可情報を受信したか否かを判定する許可情報受信判定手段と、
当該許可情報を受信したと判定したときには、判別された走行不可能領域に基づき、走行可能領域及び進入が許可された走行可否識別不能領域内における自律走行のための走行経路を生成する走行経路生成手段と、
生成した走行経路に応じて走行速度を増減計画する速度計画手段と、
遠隔操縦装置による遠隔操縦又は生成した走行経路及び計画速度に従い、走行機構を介して半自律型無人車両を走行させる走行手段と、
少なくとも走行可否識別不能領域を表示部上に視覚的に識別表示するための識別化処理を行う識別化手段と、
上記撮像部により撮像した走行領域の画像に識別化処理した走行可否識別不能領域の画像を重畳処理する重畳処理手段と、
重畳処理された画像を遠隔操縦装置に向けて送信する送信手段とを半自律型無人車両に設けたこと、
半自律型無人車両から送信された画像を表示部に表示する画像表示手段と、
走行可否識別不能領域への進入が許可されたか否かを判定する進入許否判定手段と、
走行可否識別不能領域への進入を許可されたと判定したときには、走行可否識別不能領域への進入の許可情報を半自律型無人車両に向けて送出する許可情報送出手段とを遠隔操縦装置に設けたことを特徴とする半自律型無人車両の遠隔操縦システム。
It has a ranging unit for acquiring ranging data in the traveling area, an imaging unit for acquiring images of the traveling area, and a traveling mechanism for traveling, and performs autonomous traveling based on the acquired ranging data with a semi-autonomous unmanned vehicle to perform Accordingly remote control in the remote control apparatus, the display unit for displaying an image of the travel area captured by the imaging unit, and based on the image of the displayed running region on the display unit half In a semi-autonomous unmanned vehicle remote control system that can be connected to a remote control device for remotely controlling an autonomous unmanned vehicle through an electric communication line,
Map creation means for creating an environmental map based on distance measurement data acquired by the distance measurement unit;
Based on the created environmental map, a travelable area where the semi-autonomous unmanned vehicle can travel, a travelability determination impossible area where the travel possibility cannot be determined, and a travel impossible area where the travel is impossible Discrimination means;
Permission information reception determination means for determining whether or not the permission information for entering the determined travel permission / impossibility discriminating area has been received;
When it is determined that the permission information has been received, a travel route generation for generating a travel route for autonomous traveling in the travelable region and the travel-permitted / unrecognizable region where entry is permitted based on the determined travel-impossible region Means,
Speed planning means for planning to increase or decrease the traveling speed according to the generated traveling route;
Traveling means for traveling a semi-autonomous unmanned vehicle via a traveling mechanism according to remote control by a remote control device or a generated travel route and a planned speed;
Discriminating means for performing a discriminating process for visually identifying and displaying at least a travelable / unidentifiable area on the display unit;
Superimposition processing means for performing superimposition processing on the image of the travelable / unrecognizable region that has been subjected to the identification processing on the image of the traveling region imaged by the imaging unit;
A semi-autonomous unmanned vehicle is provided with a transmission means for transmitting the superimposed image to the remote control device,
Image display means for displaying an image transmitted from the semi-autonomous unmanned vehicle on the display unit;
An entry permission determination means for determining whether or not an entry into the runnable / unidentifiable area is permitted;
The remote control device is provided with permission information sending means for sending permission information for entering the runnable / unrecognizable area into the semi-autonomous unmanned vehicle when it is determined that entry into the unrecognizable area is allowed. A semi-autonomous unmanned vehicle remote control system.
遠隔操縦装置に、走行可否識別不能領域への進入の許否を設定するための進入許否スイッチが配設されており、
進入許否判定手段は、進入許否スイッチの操作に従って走行可否識別不能領域への進入の許否を判定することを特徴とする請求項1〜3のいずれか1項に記載の半自律型無人車両の遠隔操縦システム。
The remote control device is provided with an entry permission / rejection switch for setting permission / inhibition of entry into the area where it is impossible to identify whether traveling is possible,
The semi-autonomous unmanned vehicle remote control according to any one of claims 1 to 3, wherein the entry permission / rejection determination unit determines whether or not the vehicle is allowed to enter the unrecognizable region according to the operation of the entry permission / rejection switch. Steering system.
半自律型無人車両と遠隔操縦装置との間における通信遅延時間を算出する遅延時間算出手段を設けたことを特徴とする請求項1〜4のいずれか1項に記載の半自律型無人車両の遠隔操縦システム。   5. The semi-autonomous unmanned vehicle according to claim 1, further comprising delay time calculating means for calculating a communication delay time between the semi-autonomous unmanned vehicle and the remote control device. Remote control system. 走行領域の画像を撮像した時刻から所要時間経過後までの半自律型無人車両の走行予定経路及び推定遅延時間に基づいて、その半自律型無人車両が遠隔操縦装置によって遠隔操縦される時刻における車両位置を推定する車両位置推定手段を設けたことを特徴とする請求項4に記載の半自律型無人車両の遠隔操縦システム。   A vehicle at a time when the semi-autonomous unmanned vehicle is remotely controlled by a remote control device based on a scheduled travel route and an estimated delay time of the semi-autonomous unmanned vehicle from the time when the image of the traveling area is captured until the lapse of the required time 5. The semi-autonomous unmanned vehicle remote control system according to claim 4, further comprising vehicle position estimating means for estimating a position.
JP2009195625A 2009-08-26 2009-08-26 Semi-autonomous unmanned vehicle remote control system Active JP5382793B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2009195625A JP5382793B2 (en) 2009-08-26 2009-08-26 Semi-autonomous unmanned vehicle remote control system

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2009195625A JP5382793B2 (en) 2009-08-26 2009-08-26 Semi-autonomous unmanned vehicle remote control system

Publications (2)

Publication Number Publication Date
JP2011048565A JP2011048565A (en) 2011-03-10
JP5382793B2 true JP5382793B2 (en) 2014-01-08

Family

ID=43834827

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2009195625A Active JP5382793B2 (en) 2009-08-26 2009-08-26 Semi-autonomous unmanned vehicle remote control system

Country Status (1)

Country Link
JP (1) JP5382793B2 (en)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2016154940A1 (en) * 2015-03-31 2016-10-06 SZ DJI Technology Co., Ltd. Systems and methods for geo-fencing device identification and authentication
US9792613B2 (en) 2015-03-31 2017-10-17 SZ DJI Technology Co., Ltd Authentication systems and methods for generating flight regulations
US11094202B2 (en) 2015-03-31 2021-08-17 SZ DJI Technology Co., Ltd. Systems and methods for geo-fencing device communications

Families Citing this family (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP6267430B2 (en) * 2013-03-19 2018-01-24 株式会社Ihiエアロスペース Mobile environment map generation control device, mobile body, and mobile environment map generation method
JP2015056123A (en) * 2013-09-13 2015-03-23 株式会社Ihiエアロスペース Environmental map generation control device of moving body, moving body, and environmental map generation method of moving body
JP7226167B2 (en) * 2019-07-23 2023-02-21 トヨタ自動車株式会社 vehicle
EP4336296A1 (en) * 2021-05-19 2024-03-13 Yamabiko Corporation Robot work apparatus

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH11149315A (en) * 1997-11-19 1999-06-02 Mitsubishi Heavy Ind Ltd Robot control system
JP2001034898A (en) * 1999-07-21 2001-02-09 Toyota Central Res & Dev Lab Inc Investigation disable area estimating device and driving support system

Cited By (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2016154940A1 (en) * 2015-03-31 2016-10-06 SZ DJI Technology Co., Ltd. Systems and methods for geo-fencing device identification and authentication
US9792613B2 (en) 2015-03-31 2017-10-17 SZ DJI Technology Co., Ltd Authentication systems and methods for generating flight regulations
US9805372B2 (en) 2015-03-31 2017-10-31 SZ DJI Technology Co., Ltd Authentication systems and methods for generating flight regulations
US9805607B2 (en) 2015-03-31 2017-10-31 SZ DJI Technology Co., Ltd. Authentication systems and methods for generating flight regulations
US9870566B2 (en) 2015-03-31 2018-01-16 SZ DJI Technology Co., Ltd Authentication systems and methods for generating flight regulations
US11094202B2 (en) 2015-03-31 2021-08-17 SZ DJI Technology Co., Ltd. Systems and methods for geo-fencing device communications
US11120456B2 (en) 2015-03-31 2021-09-14 SZ DJI Technology Co., Ltd. Authentication systems and methods for generating flight regulations
US11367081B2 (en) 2015-03-31 2022-06-21 SZ DJI Technology Co., Ltd. Authentication systems and methods for generating flight regulations
US11961093B2 (en) 2015-03-31 2024-04-16 SZ DJI Technology Co., Ltd. Authentication systems and methods for generating flight regulations

Also Published As

Publication number Publication date
JP2011048565A (en) 2011-03-10

Similar Documents

Publication Publication Date Title
US11845473B2 (en) Autonomous driving apparatus including a driving state switcher
JP5382793B2 (en) Semi-autonomous unmanned vehicle remote control system
JP7136106B2 (en) VEHICLE DRIVING CONTROL DEVICE, VEHICLE DRIVING CONTROL METHOD, AND PROGRAM
US10248116B2 (en) Remote operation of autonomous vehicle in unexpected environment
JP6441455B2 (en) Method for generating a surrounding map of a surrounding area of a vehicle, a driving support system, and a vehicle
US10488863B2 (en) Autonomous vehicle post-fault operation
JP5786941B2 (en) Autonomous driving control system for vehicles
JP2011043884A (en) Remote control system for semi-autonomous unmanned vehicle
US20170108865A1 (en) Method for selecting an optimized trajectory
US20140114526A1 (en) Safety apparatus for a vehicle
JP2019532292A (en) Autonomous vehicle with vehicle location
US11537131B2 (en) Control device, control method, and mobile body
JP2018195121A (en) Abnormality detection device
WO2019181284A1 (en) Information processing device, movement device, method, and program
CN110979317A (en) Fixed camera positioning
JP5366702B2 (en) Unmanned vehicle remote control system
JP2019530609A (en) Modular architecture autonomous vehicle
JP2019530608A (en) Autonomous vehicle with object level fusion
US20220253065A1 (en) Information processing apparatus, information processing method, and information processing program
KR20210082448A (en) Information processing devices, information processing methods and information processing programs
CN112461249A (en) Sensor localization from external source data
JP2014016858A (en) Unmanned mobile body system
US11906970B2 (en) Information processing device and information processing method
JP2020004144A (en) Obstacle map generation device and autonomous mobile body
JP2020203587A (en) Automatic driving system

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20120229

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20130205

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20130212

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20130412

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

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20130930

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20130926

R150 Certificate of patent or registration of utility model

Ref document number: 5382793

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

Free format text: JAPANESE INTERMEDIATE CODE: R150

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250