Calculation device
Patent Information
- Application Number
- JP2023190098
- Authority / Receiving Office
- JP · JP
- Patent Type
- Patents
- Current Assignee / Owner
- Priority Date
- 2023-05-17
- Filing Date
- 2023-11-07
- Publication Date
- 2026-09-01
- Estimated Expiration
- 2043-11-07
AI Technical Summary
【0006】 (1)本開示の第1形態によれば、算出装置が提供される。無人運転により移動可能な移動体を移動させるために用いられる算出装置は、センサによって取得されたセンサ情報と、前記センサとしての搭載測距装置を搭載した搭載移動体であって、前記搭載測距装置の検出範囲内に対象移動体を含む搭載移動体が存在するか否かを示す存否情報と、を取得する取得部と、前記取得部によって取得された前記センサ情報を用いて、前記対象移動体の位置と向きとの少なくとも一方を算出する算出部と、を備え、前記算出部は、前記搭載移動体が存在する場合に、少なくとも前記搭載測距装置によって取得された搭載測距装置情報を前記センサ情報として用いて、前記対象移動体の前記位置と前記向きとの少なくとも一方を算出し、前記搭載移動体が存在しない場合に、前記対象移動体および前記搭載移動体とは異なる場所に設置された前記センサとしての外部カメラによって取得された画像情報と、前記対象移動体および前記搭載移動体とは異なる場所に設置された前記センサとしての外部測距装置によって取得された外部測距装置情報と、の少なくとも一方を前記センサ情報として用いることで、前記対象移動体の前記位置と前記向きとの少なくとも一方を算出する。この形態によれば、搭載移動体が存在する場合に、外部測距装置情報および画像情報を用いることなく、搭載移動体に搭載された搭載測距装置によって取得された搭載測距装置情報を用いて、対象移動体の位置と向きとの少なくとも一方を算出することができる。このようにすると、搭載移動体が存在する場合に、例えば、外部カメラおよび外部測距装置と対象移動体との距離が大きくなるほどに、対象移動体の位置および向きの算出精度が低下することを抑制できる。これにより、無人運転によって対象移動体を移動させる場合において、対象移動体の位置および向きの算出精度を向上させることができる。 (2)上記形態であって、前記搭載移動体が複数存在する場合に、前記算出部は、複数の前記搭載移動体が有する複数の前記搭載測距装置のうち、最も正確に前記対象移動体を検出可能な前記搭載測距装置によって取得された前記搭載測距装置情報を前記センサ情報として用いてもよい。この形態によれば、搭載移動体が複数存在する場合に、最も正確に対象移動体を検出可能な搭載測距装置によって取得された搭載測距装置情報を用いて、対象移動体の位置と向きとの少なくとも一方を算出することができる。これにより、対象移動体の位置および向きの算出精度を向上させることができる。 (3)上記形態であって、前記取得部は、さらに、前記搭載測距装置の校正が完了しているか否かを示す校正情報を取得し、前記算出部は、前記搭載移動体が存在する場合において、前記搭載測距装置の校正が完了している場合に、少なくとも前記搭載測距装置情報を前記センサ情報として用いることで、前記対象移動体の前記位置と前記向きとの少なくとも一方を算出し、前記搭載移動体が存在する場合において、前記搭載測距装置の校正が完了していない場合に、前記搭載測距装置情報を前記センサ情報として用いることなく、前記画像情報と前記外部測距装置情報との少なくとも一方を前記センサ情報として用いることで、前記対象移動体の前記位置と前記向きとの少なくとも一方を算出してもよい。この形態によれば、搭載測距装置の校正が完了していない場合に、搭載測距装置情報を用いることなく、画像情報と外部測距装置情報との少なくとも一方を用いて、対象移動体の位置と向きとの少なくとも一方を算出することができる。これにより、対象移動体の位置および向きの算出精度が低下することをより確実に抑制できる。 (4)上記形態であって、前記搭載移動体が存在する場合に、前記取得部は、前記搭載測距装置情報に加えて、前記画像情報と前記外部測距装置情報との少なくとも一方を前記センサ情報として取得し、前記算出部は、前記搭載測距装置情報を前記センサ情報として用いて前記対象移動体の前記位置と前記向きとの少なくとも一方を算出し、前記画像情報と前記外部測距装置情報との少なくとも一方を前記センサ情報として用いて前記対象移動体の前記位置と前記向きとの少なくとも一方を算出し、(i)前記搭載測距装置情報を用いて算出された前記対象移動体の前記位置と、前記画像情報と前記外部測距装置情報との少なくとも一方を用いて算出された前記対象移動体の前記位置と、の差が予め定められた位置閾値以上である場合と、(ii)前記搭載測距装置情報を用いて算出された前記対象移動体の前記向きと、前記画像情報と前記外部測距装置情報との少なくとも一方を用いて算出された前記対象移動体の前記向きと、の差が予め定められた方向閾値以上である場合と、の少なくとも一方の場合に、前記算出部は、前記センサ情報を用いた前記対象移動体の前記位置および前記向きの算出を停止してもよい。この形態によれば、センサの検出精度が低下している可能性がある場合に、対象移動体の位置および向きの算出を停止することができる。これにより、精度が低下している可能性のあるセンサ情報を基に、対象移動体の位置および向きを算出することを回避できる。 (5)上記形態であって、さらに、前記移動体の動作を制御するための制御信号を生成する信号生成部と、前記信号生成部によって生成された前記制御信号を前記移動体に送信する送信部と、備え、前記搭載移動体が存在する場合に、前記取得部は、前記搭載測距装置情報に加えて、前記画像情報と前記外部測距装置情報との少なくとも一方を前記センサ情報として取得し、前記算出部は、前記搭載測距装置情報を前記センサ情報として用いて前記対象移動体の前記位置と前記向きとの少なくとも一方を算出し、前記画像情報と前記外部測距装置情報との少なくとも一方を前記センサ情報として用いて前記対象移動体の前記位置と前記向きとの少なくとも一方を算出し、(i)前記搭載測距装置情報を用いて算出された前記対象移動体の前記位置と、前記画像情報と前記外部測距装置情報との少なくとも一方を用いて算出された前記対象移動体の前記位置と、の差が予め定められた位置閾値以上である場合と、(ii)前記搭載測距装置情報を用いて算出された前記対象移動体の前記向きと、前記画像情報と前記外部測距装置情報との少なくとも一方を用いて算出された前記対象移動体の前記向きと、の差が予め定められた方向閾値以上である場合と、の少なくとも一方の場合に、前記信号生成部は、(a)前記移動体を停止させるための停止制御信号と、(b)前記搭載移動体が前記無人運転により移動するときの目的地を、予め定められた目標場所から、前記搭載測距装置を修理する修理処理と前記搭載測距装置を校正する校正処理との少なくとも一方を行うメンテナンス場所に変更するための変更制御信号と、のいずれか一方を前記制御信号として生成してもよい。この形態によれば、センサの検出精度が低下している可能性がある場合に、移動体をより安全に停止させたり、搭載測距装置をメンテナンスしたりすることができる。 本開示は、上記の算出装置以外の種々の形態で実現することが可能である。例えば、移動体の位置と向きとの少なくとも一方の算出方法、算出装置の製造方法、算出装置の制御方法、その制御方法を実現するコンピュータプログラム、そのコンピュータプログラムを記録した一時的でない記録媒体等の形態で実現することができる。
Smart Images

Figure 0007913484000001 
Figure 0007913484000002 
Figure 0007913484000003
Abstract
Description
[Technical Field]
[0001] The present disclosure relates to a calculation device. [Background Art]
[0002] Conventionally, vehicles that autonomously travel via remote control are known (Patent Document 1). [Prior Art Literature] [Patent Literature]
[0003] [Patent Document 1] Japanese National Publication of International Patent Application No. 2017-538619 [Summary of the Invention] [Problem to be Solved by the Invention]
[0004] When moving a moving body such as a vehicle by unmanned driving, it is desired to accurately calculate the position and orientation of the moving body. [Means for Solving the Problem]
[0005] The present disclosure can be implemented in the following modes.
[0006] (1) According to a first embodiment of the present disclosure, a calculation device is provided. The calculation device used to move a mobile body that can be moved by unmanned operation includes: an acquisition unit that acquires sensor information acquired by a sensor and existence information indicating whether or not there is a mobile body equipped with a mounted distance measuring device as a sensor, and that includes a target mobile body within the detection range of the mounted distance measuring device; and a calculation unit that uses the sensor information acquired by the acquisition unit to calculate at least one of the position and orientation of the target mobile body. The calculation unit calculates at least one of the position and orientation of the target mobile body by using at least the mounted distance measuring device information acquired by the mounted distance measuring device as the sensor information when the mobile body is present, and by using at least one of the image information acquired by an external camera as a sensor installed at a location different from the target mobile body and the mobile body, and external distance measuring device information acquired by an external distance measuring device installed at a location different from the target mobile body and the mobile body as the sensor, as the sensor information when the mobile body is not present, to calculate at least one of the position and orientation of the target mobile body. In this configuration, when a mobile object is present, at least one of the position and orientation of the target mobile object can be calculated using the onboard rangefinder information acquired by the onboard rangefinder mounted on the mobile object, without using external rangefinder information or image information. This suppresses the decrease in the accuracy of calculating the position and orientation of the target mobile object, which occurs when, for example, the distance between the external camera and external rangefinder and the target mobile object increases when a mobile object is present. As a result, the accuracy of calculating the position and orientation of the target mobile object can be improved when the target mobile object is moved by unmanned operation. (2) In the above configuration, if there are multiple mounted mobile bodies, the calculation unit may use the mounted distance measuring device information obtained by the mounted distance measuring device that can most accurately detect the target mobile body from among the multiple mounted distance measuring devices of the multiple mounted mobile bodies as the sensor information. According to this configuration, when there are multiple mounted mobile bodies, at least one of the position and orientation of the target mobile body can be calculated using the mounted distance measuring device information obtained by the mounted distance measuring device that can most accurately detect the target mobile body. This improves the accuracy of calculating the position and orientation of the target mobile body. (3) In the above configuration, the acquisition unit further acquires calibration information indicating whether or not the calibration of the mounted distance measuring device has been completed, and the calculation unit calculates at least one of the position and orientation of the target moving object by using at least the mounted distance measuring device information as the sensor information when the mounted moving object is present and the calibration of the mounted distance measuring device has been completed, and when the mounted moving object is present and the calibration of the mounted distance measuring device has not been completed, the calculation unit may use at least one of the image information and the external distance measuring device information as the sensor information without using the mounted distance measuring device information as the sensor information to calculate at least one of the position and orientation of the target moving object. (4) In the above configuration, if the mounted moving body is present, the acquisition unit acquires at least one of the image information and the external distance measuring device information as sensor information in addition to the mounted distance measuring device information, and the calculation unit uses the mounted distance measuring device information as sensor information to calculate at least one of the position and orientation of the target moving body, and uses at least one of the image information and the external distance measuring device information as sensor information to calculate at least one of the position and orientation of the target moving body, (i) the target moving (i) If the difference between the position of the moving body and the position of the target moving body calculated using at least one of the image information and the external distance measuring device information is greater than or equal to a predetermined position threshold, (ii) if the difference between the orientation of the target moving body calculated using the mounted distance measuring device information and the orientation of the target moving body calculated using at least one of the image information and the external distance measuring device information is greater than or equal to a predetermined direction threshold, the calculation unit may stop calculating the position and orientation of the target moving body using the sensor information. According to this configuration, the calculation of the position and orientation of the target moving body can be stopped if there is a possibility that the detection accuracy of the sensor has decreased. This makes it possible to avoid calculating the position and orientation of the target moving body based on sensor information that may have decreased accuracy. (5) The above configuration further comprises a signal generation unit that generates a control signal for controlling the operation of the mobile body, and a transmission unit that transmits the control signal generated by the signal generation unit to the mobile body, wherein when the mounted mobile body exists, the acquisition unit acquires at least one of the image information and the external distance measuring device information as the sensor information in addition to the mounted distance measuring device information, the calculation unit calculates at least one of the position and orientation of the target mobile body using the mounted distance measuring device information as the sensor information, and calculates at least one of the position and orientation of the target mobile body using at least one of the image information and the external distance measuring device information as the sensor information, (i) the position of the target mobile body calculated using the mounted distance measuring device information and the image information and the external distance measuring device information In at least one of the following cases, the signal generation unit may generate either (a) a stop control signal for stopping the moving object, or (b) a change control signal for changing the destination when the moving object is moving under unmanned operation from a predetermined target location to a maintenance location where at least one of a repair process for repairing the moving object and a calibration process for calibrating the moving object is performed. This configuration allows the moving object to be stopped more safely or the moving object to be maintained when the detection accuracy of the sensor may be reduced. This disclosure can be implemented in various forms other than the calculation device described above. For example, it can be implemented in the form of a method for calculating at least one of the position and orientation of a moving object, a method for manufacturing the calculation device, a method for controlling the calculation device, a computer program for implementing the control method, and a non-temporary recording medium on which the computer program is stored. [Brief explanation of the drawing]
[0007] [Figure 1] This figure shows the schematic configuration of the calculation system in the first embodiment. [Figure 2] This figure shows the detailed configuration of the calculation system in the first embodiment. [Figure 3] This is a flowchart showing the processing procedure for vehicle driving control in the first embodiment. [Figure 4] This is a flowchart showing the calculation method and operation control method of the first embodiment. [Figure 5] This figure shows the method for calculating the position and orientation of the target vehicle. [Figure 6] This diagram shows the method for calculating the orientation of the target vehicle. [Figure 7] This is a flowchart showing the calculation method in the second embodiment. [Figure 8] This is a flowchart showing the operation control method in the second embodiment. [Figure 9] This figure shows the configuration of the calculation system in the third embodiment. [Figure 10] This is a flowchart showing the processing procedure for vehicle driving control in the third embodiment. [Modes for carrying out the invention]
[0008] A. First Embodiment: Figure 1 is a diagram illustrating the schematic configuration of the calculation system 1 in the first embodiment. The calculation system 1 calculates at least one of the position and orientation of the target vehicle 101 as a moving object. The calculation system 1 comprises one or more vehicles 10 including the target vehicle 101, one or more external sensors 300 installed in locations different from the vehicles 10, and a calculation device 5. Figure 1 illustrates the case where the target vehicle 101 and the mounted vehicle 102 are traveling on a road R. The mounted vehicle 102 is a vehicle 10 equipped with an on-board LiDAR (Light Detection and Ranging) 161 that includes the target vehicle 101 within its detection range RG1. The on-board LiDAR 161 has a detection range RG1. The on-board LiDAR 161 detects the target vehicle 101 when the target vehicle 101 is located within the detection range RG1. The on-board LiDAR 161 is an example of a mounted distance measuring device as a distance measuring device mounted on the vehicle 10. In other embodiments, the distance measuring device may be other sensors such as a stereo camera. When there is no need to distinguish between vehicles 101 and 102, they are simply referred to as "vehicle 10".
[0009] In this disclosure, “mobile object” means an object that can move, such as a vehicle or an electric vertical take-off and landing aircraft (so-called flying car). A vehicle may be a wheeled vehicle or a tracked vehicle, such as a passenger car, truck, bus, motorcycle, car, tank, or construction vehicle. Vehicles include electric vehicles (BEVs: Battery Electric Vehicles), gasoline vehicles, hybrid vehicles, and fuel cell vehicles. If the mobile object is not a vehicle, the terms “vehicle” and “car” in this disclosure may be replaced with “mobile object” as appropriate, and the term “driving” may be replaced with “moving” as appropriate.
[0010] Vehicle 10 is configured to operate autonomously. "Autonomous operation" means operation without the operation of a passenger. Operation refers to operations related to at least one of the following: "going," "turning," or "stopping" of vehicle 10. Autonomous operation is achieved by automatic or manual remote control using a device located outside vehicle 10, or by autonomous control of vehicle 10. A passenger who does not perform operation may be on board vehicle 10 while it is operating autonomously. A passenger who does not perform operation includes, for example, a person simply sitting in the seat of vehicle 10, or a person performing tasks other than operation, such as assembly, inspection, or operating switches, while on board vehicle 10. Operation by a passenger is sometimes called "manned operation."
[0011] In this specification, "remote control" includes "fully remote control," in which all operations of the vehicle 10 are completely determined from outside the vehicle 10, and "partial remote control," in which some operations of the vehicle 10 are determined from outside the vehicle 10. Furthermore, "autonomous control" includes "fully autonomous control," in which the vehicle 10 autonomously controls its own operations without receiving any information from external devices, and "partial autonomous control," in which the vehicle 10 autonomously controls its own operations using information received from external devices.
[0012] In this embodiment, the calculation system 1 is used in a factory that manufactures the vehicle 10. The factory's reference coordinate system is the global coordinate system. That is, any location within the factory is represented by X, Y, Z coordinates in the global coordinate system. In other embodiments, the calculation system 1 may be used in locations other than a factory.
[0013] FIG. 2 is a diagram showing the detailed configuration of the calculation system 1 according to the first embodiment. A vehicle 10 includes an actuator group 120. The actuator group 120 includes an actuator of a drive device for accelerating the vehicle 10, an actuator of a steering device for changing the traveling direction of the vehicle 10, and an actuator of a braking device for decelerating the vehicle 10. Furthermore, the vehicle 10 includes a communication device 130 for communicating with other devices (e.g., a calculation device 5) other than the host vehicle 10 and other vehicles 10 using wireless communication or the like, a vehicle control device 150 for controlling the operation of the vehicle 10, and an in-vehicle sensor group 160 having one or more types of internal sensors.
[0014] The vehicle control device 150 includes a vehicle CPU 111, a vehicle storage unit 112, an input / output interface 113, and an internal bus 114. The input / output interface 113 is used for communicating with various devices mounted on the host vehicle 10 (e.g., a drive device), the in-vehicle sensor group 160, and the like. The vehicle CPU 111, the vehicle storage unit 112, and the input / output interface 113 are communicatively connected bidirectionally via the internal bus 114. The vehicle CPU 111 executes a program PG1 stored in the vehicle storage unit 112, thereby realizing various functions including a function as the vehicle control unit 115.
[0015] The vehicle control unit 115 causes the vehicle 10 to travel by controlling the actuator group 120. The vehicle control unit 115 can cause the vehicle 10 to travel by controlling the actuator group 120 using a travel control signal received from the calculation device 5. The travel control signal is a control signal for causing the vehicle 10 to travel. In the present embodiment, the travel control signal includes the acceleration and steering angle of the vehicle 10 as parameters. In other embodiments, the travel control signal may include the speed of the vehicle 10 as a parameter instead of or in addition to the acceleration of the vehicle 10.
[0016] The on-vehicle sensor group 160 includes, for example, an on-vehicle camera, an on-vehicle radar, and an on-vehicle LiDAR 161 as sensors that acquire surrounding information indicating the state of the surrounding area of the vehicle 10. The on-vehicle camera captures an image of the state of the surrounding area of the vehicle 10. The on-vehicle radar and the on-vehicle LiDAR 161 detect objects present in the surrounding area of the vehicle 10. Note that the configuration of the vehicle 10 is not limited to the above.
[0017] One or more types of external sensors 300 installed at a location different from the vehicle 10 acquire bird's-eye view information indicating the states of the vehicle 10 and the surrounding area of the vehicle 10. The external sensors 300 are sensors located outside the vehicle 10. In the present embodiment, the calculation system 1 includes one or more external LiDARs 90 as the external sensors 300 that acquire bird's-eye view information. The external LiDAR 90 is an example of an external distance measuring device installed at a location different from the vehicle 10.
[0018] The external LiDAR 90 is a LiDAR (Light Detection And Ranging) that detects the target vehicle 101 from outside the target vehicle 101. The external LiDAR 90 irradiates a predetermined detection range RG2 with laser light, and detects reflected light reflected by an object such as the target vehicle 101, thereby detecting the distance and angle between the external LiDAR 90 and the object, the shape of the object, and the like. The external LiDAR 90 transmits the acquired external LiDAR information to the calculation device 5. The installation position and the number of installed external LiDARs 90 are determined in consideration of the detection range RG2 of each external LiDAR 90 and objects (obstacles) present in the surrounding area of the travel path R in order to detect the entire travel path R by one or more external LiDARs 90. Note that the configuration of the external LiDAR 90 is not limited to the above.
[0019] The calculation device 5 uses sensor information to calculate at least one of the position and orientation of the target vehicle 101. In this embodiment, the calculation device 5 is a server installed in a location different from the vehicle 10. In this embodiment, the calculation device 5 calculates the position and orientation of the target vehicle 101. The calculation device 5 also generates a driving control signal that defines the driving operation of the target vehicle 101 and transmits the driving control signal to the target vehicle 101. Sensor information is acquired by a sensor that acquires at least one of overhead information and surrounding information. Sensor information is at least one of, for example, onboard lidar information, which is onboard lidar information acquired by an onboard lidar 161 as an onboard distance measuring device, and external lidar information, which is external lidar information acquired by an external lidar 90 as an external distance measuring device. The position of the vehicle 10 is the position of a positioning point 10e that is pre-set for a specific part of the vehicle 10. The position of the positioning point 10e is expressed as a coordinate value in the global coordinate system. The orientation of vehicle 10 is represented by a vector that points from the rear side Re to the front side Fr of vehicle 10, along the longitudinal axis passing through the center of gravity of vehicle 10.
[0020] The calculation device 5 comprises a communication device 51, a device storage unit 53, a device CPU 52, an input / output interface 54, and an internal bus 55. The device storage unit 53, the device CPU 52, and the input / output interface 54 are connected via the internal bus 55 to enable bidirectional communication. The input / output interface 54 is connected to a communication device 51 for communicating with various devices outside the calculation device 5. The communication device 51 can communicate with a communication device 130 mounted on the vehicle 10 and an external rider 90, etc. The communication device 51 is, for example, a wireless communication device. The device storage unit 53 includes, for example, RAM, ROM, and a hard disk drive (HDD). The device CPU 52 implements various functions, including those of an acquisition unit 521, a calculation unit 522, a signal generation unit 523, and a transmission unit 524, by deploying various programs PG2 stored in the device storage unit 53.
[0021] The acquisition unit 521 acquires various types of information. In this embodiment, the acquisition unit 521 acquires various types of information, including existence / non-existence information and sensor information. The existence / non-existence information indicates whether or not a vehicle 102, including the target vehicle 101, exists within the detection range RG1. The acquisition unit 521 acquires existence / non-existence information, for example, by referring to an existence / non-existence database and scheduled information stored in advance in the device storage unit 53. The existence / non-existence database is, for example, a database that links vehicle identification information that identifies a vehicle 10, whether or not an on-board rider 161 is installed, and the detection range RG1 of the on-board rider 161. The scheduled information is, for example, information that indicates which vehicle 10 is scheduled to travel to which position on the reference route RR during unmanned driving, at what time. Note that the method of acquiring existence / non-existence information is not limited to the above. For example, the acquisition unit 521 may acquire existence / non-existence information through vehicle-to-vehicle communication between the target vehicle 101 and a vehicle 10 other than the target vehicle 101 equipped with the on-board rider 161. Furthermore, the acquisition unit 521 may acquire whether or not the target vehicle 101 is included in the in-vehicle rider information as existence / non-existence information.
[0022] The calculation unit 522 uses the sensor information acquired by the acquisition unit 521 to calculate at least one of the position and orientation of the target vehicle 101. In this embodiment, the calculation unit 522 acquires vehicle position information for the target vehicle 101 by calculating the position and orientation of the target vehicle 101 using the sensor information. The vehicle position information is the position information that forms the basis for generating the driving control signal. In this embodiment, the vehicle position information includes the position and orientation of the vehicle 10 in the factory's global coordinate system.
[0023] The signal generation unit 523 generates a driving control signal to define the driving operation of the vehicle 10 and control the vehicle 10. For example, the signal generation unit 523 generates a standard control signal, which is a driving control signal for driving the vehicle 10 along a predetermined reference path RR. The signal generation unit 523 may also generate the following driving control signals, for example, depending on the accuracy of the position and orientation of the target vehicle 101 calculated by the calculation unit 522 and the driving status of the vehicle 10. In this case, the signal generation unit 523 may generate a stop control signal, which is a driving control signal for stopping the vehicle 10, or a change control signal, which is a driving control signal for changing the destination of the mounted vehicle 102.
[0024] The transmitting unit 524 transmits various types of information. For example, the transmitting unit 524 transmits the driving control signal generated by the signal generation unit 523 to the vehicle 10 to be controlled. However, the configuration of the device CPU 52 is not limited to the above. At least some of the functions of the device CPU 52 may be implemented as a function of another device (for example, an external rider 90, an on-board rider 161, or a vehicle control device 150).
[0025] Figure 3 is a flowchart showing the processing procedure for controlling the vehicle 10's movement in the first embodiment. The flow shown in Figure 3 is executed repeatedly at predetermined intervals, for example, from the moment the vehicle 10 starts moving under remote control.
[0026] In step 1, the calculation unit 522 of the calculation device 5 acquires vehicle position information using sensor information.
[0027] In step 2, the signal generation unit 523 determines the next target location that the vehicle 10 should head to. In this embodiment, the target location is represented by X, Y, Z coordinates in the global coordinate system. The device storage unit 53 has a reference route RR, which is the route that the vehicle 10 should travel, pre-stored in it. The route is represented by a node indicating the starting point, nodes indicating waypoints, a node indicating the destination, and links connecting each node. The signal generation unit 523 uses the vehicle position information and the reference route RR to determine the next target location that the vehicle 10 should head to. The signal generation unit 523 determines the target location on the reference route RR beyond the current location of the vehicle 10.
[0028] In step 3, the signal generation unit 523 generates a driving control signal to drive the vehicle 10 toward the determined target position. The signal generation unit 523 calculates the vehicle's speed from the change in the vehicle's position and compares the calculated speed with the target speed. Overall, the signal generation unit 523 determines the acceleration so that the vehicle 10 accelerates if the speed is lower than the target speed, and determines the acceleration so that the vehicle 10 decelerates if the speed is higher than the target speed. Furthermore, if the vehicle 10 is located on the reference path RR, the signal generation unit 523 determines the steering angle and acceleration so that the vehicle 10 does not deviate from the reference path RR, and if the vehicle 10 is not located on the reference path RR, in other words, if the vehicle 10 has deviated from the reference path RR, the signal generation unit 523 determines the steering angle and acceleration so that the vehicle 10 returns to the reference path RR.
[0029] In step 4, the transmitting unit 524 transmits the generated driving control signal to the vehicle 10. The calculation device 5 repeats the acquisition of vehicle position information, determination of target position, generation of driving control signal, and transmission of driving control signal at predetermined intervals.
[0030] In step 5, the vehicle control unit 115 of the vehicle control device 150 mounted on the vehicle 10 receives a driving control signal transmitted from the calculation device 5. In step 6, the vehicle control unit 115 uses the received driving control signal to control the actuator group 120, thereby driving the vehicle 10 at the acceleration and steering angle expressed in the driving control signal. The vehicle control device 150 repeats the reception of the driving control signal and the control of the actuator group 120 at predetermined intervals. According to the calculation system 1 in this embodiment, the vehicle 10 can be driven by remote control, and the vehicle 10 can be moved without using transport equipment such as cranes or conveyors.
[0031] Figure 4 is a flowchart showing the calculation method and operation control method in the first embodiment. The calculation method is a method for calculating the position and orientation of the target vehicle 101. The operation control method is a method for controlling the driving operation of the vehicle 10 by generating and transmitting a driving control signal using the position and orientation of the target vehicle 101 calculated by the execution of the calculation method. The flowchart shown in Figure 4 is executed, for example, when the power to the calculation device 5, external rider 90, target vehicle 101, and mounted vehicle 102 is turned on.
[0032] In step 101, the acquisition unit 521 of the calculation device 5 acquires existence information. If the mounted vehicle 102 exists (step 102: Yes), in step 103, the transmission unit 524 transmits a request signal to the mounted vehicle 102 requesting sensor information. On the other hand, if the mounted vehicle 102 does not exist (step 102: No), in step 104, the transmission unit 524 transmits a request signal to the external lidar 90.
[0033] If the vehicle control device 150 of the mounted vehicle 102 receives a request signal (step 105: Yes), in step 106, the vehicle control device 150 of the mounted vehicle 102 acquires onboard rider information from the onboard rider 161. Then, in step 107, the vehicle control device 150 of the mounted vehicle 102 transmits the onboard rider information to the calculation device 5. As a result, the acquisition unit 521 of the calculation device 5 acquires the onboard rider information as sensor information if the mounted vehicle 102 is present.
[0034] If the external RID 90 receives a request signal (step 108: Yes), in step 109, the external RID 90 transmits the external RID information to the calculation device 5. As a result, the acquisition unit 521 of the calculation device 5 acquires the external RID information as sensor information if the mounted vehicle 102 does not exist.
[0035] If the sensor information acquired by the acquisition unit 521 is in-vehicle sensor information (step 110: Yes), in step 111, the calculation unit 522 uses the in-vehicle lid information to calculate the position and orientation of the target vehicle 101. As a result, the calculation unit 522 acquires vehicle position information.
[0036] Figure 5 illustrates an example of a method for calculating the position and orientation of a target vehicle 101 using onboard RID information acquired by an onboard RID 161 mounted on a vehicle 102. In this embodiment, the target vehicle 101 is described as traveling parallel to the vehicle 102. In this disclosure, the X direction along the X-axis is the longitudinal (overall length) direction of the vehicle 10, with the +X direction being the front side Fr of the vehicle 10 and the -X direction being the rear side Re of the vehicle 10. Therefore, the forward direction of the vehicle 10 is the +X direction, and the backward direction of the vehicle 10 is the -X direction. Also, the Y direction along the Y-axis is the left-right (vehicle width) direction of the vehicle 10, with the +Y direction being the left side Lf of the vehicle 10 and the -Y direction being the right side Ri of the vehicle 10. Furthermore, the Z-direction along the Z-axis represents the vertical (vehicle height) direction of the vehicle 10, with the +Z direction being the upper side Tp (ceiling side) of the vehicle 10 and the -Z direction being the lower side Bt (floor side).
[0037] In the example shown in Figure 5, a reference object 8 capable of reflecting laser light emitted by the on-board lidar 161 is illustrated. Multiple reference objects 8 may be placed at different locations. The coordinate values (absolute positions) of one or more reference objects 8 in the global coordinate system are known. The calculation unit 522 calculates the position of the mounted vehicle 102 by detecting one or more reference objects 8 capable of reflecting laser light using the on-board lidar 161. Then, based on the calculated position of the mounted vehicle 102 and the first detection vector Vs1, it calculates the position and orientation of the target vehicle 101. The first detection vector Vs1 is a vector pointing from the mounted vehicle 102 to the target vehicle 101. The first detection vector Vs1 has the distance L1 between the mounted vehicle 102 and the target vehicle 101, and the orientation from the mounted vehicle 102 to the target vehicle 101. In Figure 5, the orientation from the mounted vehicle 102 to the target vehicle 101 is represented by the angle θ1 between the optical axis reference Ls and the first detection vector Vs1. The optical axis reference Ls corresponds to the center line of the detection range RG1, which is the irradiation range of the laser light emitted from the projector of the on-board ridiculer 161. The reference object 8 is, for example, a pole (support) to which a reflective material that reflects laser light is attached. Information regarding the absolute position of the reference object 8 and information regarding the on-board ridiculer 161 are stored in advance in, for example, the device memory unit 53. Information regarding the on-board ridiculer 161 includes, for example, the installation position of the on-board ridiculer 161 relative to the mounted vehicle 102, the relative positional relationship between the on-board ridiculer 161 and the positioning point 10e of the mounted vehicle 102, and the angular difference θs between the longitudinal axis Cp1 of the mounted vehicle 102 and the optical axis reference Ls of the on-board ridiculer 161.
[0038] The on-board lidar 161 emits laser light from its projector and measures the time it takes for the reflected light, which has been reflected by a reflector attached to the reference object 8, to be received by the receiver, thereby obtaining the distance L2 from the installation position of the on-board lidar 161 to the reference object 8. Similarly, the on-board lidar 161 obtains the distance L1 from the installation position of the on-board lidar 161 to the target vehicle 101 by receiving reflected light from the target vehicle 101. Furthermore, the on-board lidar 161 obtains the laser light emission angle θ2 to the reference object 8 with respect to the optical axis reference Ls as the orientation from the on-board lidar 161 to the reference object 8. Similarly, the on-board lidar 161 obtains the laser light emission angle θ1 to the target vehicle 101 with respect to the optical axis reference Ls as the orientation from the on-board lidar 161 to the target vehicle 101. Then, the distances L1 and L2 acquired by the on-board lidar 161, and the angular differences θ1 and θ2 between the optical axis reference Ls and the detected vectors Vs1 and Vs2 are transmitted to the calculation device 5 as on-board lidar information, and the acquisition unit 521 of the calculation device 5 acquires the on-board lidar information.
[0039] The calculation unit 522 calculates the position of the mounted vehicle 102 in order to calculate the position of the target vehicle 101. Specifically, the calculation unit 522 performs the following processing using the absolute position of the reference object 8, the distance L2 from the installation position of the on-board lidar 161 to the reference object 8, and the angular difference θ2 between the optical axis reference Ls of the on-board lidar 161 and the second detection vector Vs2. In this case, the calculation unit 522 uses trigonometric functions to calculate the difference in coordinate values ΔX1 in the X direction between the on-board lidar 161 and a specific reference object 8, which is a specific reference object 8, and the difference in coordinate values ΔY1 in the Y direction between the on-board lidar 161 and the specific reference object 8. Then, the calculation unit 522 takes into account the angular difference θ2 between the optical axis reference Ls of the on-board lidar 161 and the second detection vector Vs2, and reflects the difference in the X direction ΔX1 and the difference in the Y direction ΔY1, respectively, in the coordinate value indicating the absolute position of the specific reference object 8. As a result, the calculation unit 522 calculates the coordinate values of the in-vehicle lidar 161 in the global coordinate system.
[0040] Next, the calculation unit 522 performs the following processing using the calculated position of the on-board lidar 161, the distance L1 from the on-board lidar 161 to the target vehicle 101, and the angular difference θ1 between the optical axis reference Ls of the on-board lidar 161 and the first detection vector Vs1. In this case, the calculation unit 522 uses trigonometric functions to calculate the difference in coordinate values ΔX2 in the X direction between the on-board lidar 161 and the target vehicle 101, and the difference in coordinate values ΔY2 in the Y direction between the on-board lidar 161 and the target vehicle 101. Then, taking into account the angular difference θ1 between the optical axis reference Ls of the on-board lidar 161 and the first detection vector Vs1, the calculation unit 522 reflects the difference in the X direction ΔX2 and the difference in the Y direction ΔY2, respectively, in the coordinate value indicating the position of the on-board lidar 161. As a result, the calculation unit 522 calculates the coordinate value in the global coordinate system of the specific part 10f of the target vehicle 101 as measured by the on-board lidar 161. The calculation unit 522 calculates the coordinate value of the positioning point 10e of the target vehicle 101 in the global coordinate system from the calculated coordinate value of the specific part 10f of the target vehicle 101 in the global coordinate system, based on the relative positional relationship between the specific part 10f of the target vehicle 101 and the positioning point 10e. The calculation unit 522 then adopts the coordinate value of the positioning point 10e of the target vehicle 101 in the global coordinate system as the position of the target vehicle 101.
[0041] The calculation unit 522 calculates the orientation of the vehicle 10 using, for example, the calculated position of a specific part 10f of the target vehicle 101 and the relative positional relationship between the front center point Cf, the rear center point Cr, and the specific part 10f. The front center point Cf is located in the center of the front side Fr of the target vehicle 101. The rear center point Cr is located in the center of the rear side Re of the target vehicle 101. The front center point Cf and the rear center point Cr are both located on the longitudinal axis Cp2 of the target vehicle 101. To calculate the orientation of the target vehicle 101, the calculation unit 522 calculates the coordinate values of the front center point Cf and the rear center point Cr based on the coordinate values indicating the position of the specific part 10f of the target vehicle 101. Next, the calculation unit 522 calculates the longitudinal axis Cp2 of the target vehicle 101 by connecting the front center point Cf and the rear center point Cr. As a result, the calculation unit 522 sets the direction vector Va, which is a vector pointing in the forward direction along the longitudinal axis Cp2 of the calculated target vehicle 101, as the orientation of the target vehicle 101.
[0042] Furthermore, the method shown in Figure 5 may also be applied when calculating the position and orientation of the target vehicle 101 using external RIDER information. In addition, when the position and orientation of the target vehicle 101 are calculated using either in-vehicle RIDER information or external RIDER information, it is not essential to use information about the reference object 8.
[0043] As shown in Figure 4, if the sensor information acquired by the acquisition unit 521 is external RID information (step 110: No), in step 112, the calculation unit 522 uses the external RID information to calculate the position and orientation of the target vehicle 101. As a result, the calculation unit 522 acquires vehicle position information.
[0044] Figure 6 is a diagram illustrating an example of a method for calculating the orientation of a target vehicle 101 using in-vehicle or external LID information. In the example shown in Figure 6, the calculation unit 522 calculates the orientation of the target vehicle 101 using coordinate values indicating the positions of multiple detection points Dp1 to Dp4 of the target vehicle 101 detected from the 3D point cloud information included in the external LID information. In Figure 6, the multiple detection points Dp1 to Dp4 of the target vehicle 101 are the first detection point Dp1, the second detection point Dp2, the third detection point Dp3, and the fourth detection point Dp4. The first detection point Dp1 is located at the left rear end of the target vehicle 101. The second detection point Dp2 is located at the left front end of the target vehicle 101. The third detection point Dp3 is located at the right front end of the target vehicle 101. The fourth detection point Dp4 is located at the right rear end of the target vehicle 101. The following describes a method for calculating the orientation of the target vehicle 101 using the four detection points Dp1 to Dp4 located at the four corners of the target vehicle 101.
[0045] First, the in-vehicle lidar 161 and the external lidar 90 acquire the relative positional relationship between the four detection points Dp1 to Dp4 of the target vehicle 101 and the specific reference object 8, and transmit this as sensor information to the calculation device 5. Next, the calculation device 5 uses the absolute position of the specific reference object 8 and the sensor information acquired by the acquisition unit 521 to calculate the coordinate values of each detection point Dp1 to Dp4 in the global coordinate system. Next, the calculation unit 522 calculates the intermediate points Mp1 and Mp2 on the front side Fr and rear side Re of the target vehicle 101, respectively. Specifically, the calculation unit 522 calculates the first intermediate point Mp1, which has the coordinate value of the intermediate position between the second detection point Dp2 and the third detection point Dp3, and the second intermediate point Mp2, which has the coordinate value of the intermediate position between the first detection point Dp1 and the fourth detection point Dp4. The calculation unit 522 only needs to calculate coordinate values in at least the X and Y directions when calculating each intermediate point Mp1 and Mp2. Next, the calculation unit 522 calculates the intermediate axis Ci, which is the axis connecting the first intermediate point Mp1 and the second intermediate point Mp2. Then, based on the result of determining whether the target vehicle 101 is traveling in the forward or reverse direction, the calculation unit 522 calculates an intermediate vector Vi along the intermediate axis Ci. The calculation unit 522 sets the direction in which the intermediate vector Vi is pointing as the direction of the target vehicle 101.
[0046] The number of detection points and their positions on the target vehicle 101 are not limited to those described above. There may be as few as two detection points; for example, one detection point may be an antenna mounted on the roof of the target vehicle 101, and the other detection point may be an emblem mounted on the front grille or the like on the front side Fr of the target vehicle 101. In this case, the calculation unit 522 uses the coordinate values of the two detection points in the global coordinate system and the installation positions of the antenna and emblem relative to the target vehicle 101, that is, the relative positional relationship of the antenna and emblem with respect to the longitudinal axis of the target vehicle 101, to calculate the orientation of the target vehicle 101.
[0047] As shown in Figure 4, in step 113, the signal generation unit 523 of the calculation device 5 performs the following processing using the vehicle position information and reference path RR for the target vehicle 101. In this case, the signal generation unit 523 determines the target position to which the target vehicle 101 should next go and generates a first control signal to drive the target vehicle 101 toward the determined target position. The first control signal is, for example, a standard control signal. Then, in step 114, the transmission unit 524 transmits the first control signal to the target vehicle 101. If the vehicle control device 150 of the target vehicle 101 receives the first control signal (step 115: Yes), in step 116, the vehicle control device 150 of the target vehicle 101 controls the actuator group 120 using the received first control signal. The signal generation unit 523 may also generate a first control signal to control the operation of the mounted vehicle 102 using the vehicle position information and reference path RR for the mounted vehicle 102.
[0048] According to the first embodiment described above, when a mounted vehicle 102 is present, the position and orientation of the target vehicle 101 can be calculated using the on-board rider information acquired by the on-board rider 161 mounted on the mounted vehicle 102. When using a sensor located in a different location from the vehicle 10, such as an external rider 90, the proportion of the vehicle 10 shown in the detection range RG2 decreases as the distance between the vehicle 10 and the sensor increases. Therefore, there is a risk that the accuracy of calculating the position and orientation of the target vehicle 101 will decrease. On the other hand, according to the first embodiment described above, when the target vehicle 101 is equipped with an on-board rider 161, the position and orientation of the target vehicle 101 can be calculated without using sensor information acquired by a sensor located in a different location from the vehicle 10, such as an external rider 90. This makes it possible to suppress a decrease in the accuracy of calculating the position and orientation of the target vehicle 101 when a mounted vehicle 102 is present.
[0049] Furthermore, according to the first embodiment described above, when the mounted vehicle 102 is not present, the position and orientation of the target vehicle 101 can be calculated using external LiDAR information. For example, when calculating the position and orientation of the target vehicle 101 by analyzing image information including the target vehicle 101, the accuracy of calculating the position and orientation of the target vehicle 101 may decrease due to differences in imaging conditions such as weather, season, time of day, and location of imaging. On the other hand, according to the first embodiment described above, the position and orientation of the target vehicle 101 can be calculated without using image information. This makes it possible to suppress a decrease in the accuracy of calculating the position and orientation of the target vehicle 101 when the mounted vehicle 102 is not present.
[0050] Furthermore, according to the first embodiment described above, when the vehicle 10 is driven by unmanned operation, the driving operation of the vehicle 10 can be controlled by generating a control signal using the calculated position and orientation of the vehicle 10.
[0051] B. Second Embodiment: Figure 7 is a flowchart showing the calculation method in the second embodiment. Figure 8 is a flowchart showing the operation control method in the second embodiment. In this embodiment, a method for generating different driving control signals according to the detection accuracy of the sensor that acquires sensor information will be described.
[0052] As shown in Figure 7, in step 201, the acquisition unit 521 of the calculation device 5 acquires existence information. If the mounted vehicle 102 exists (step 202: Yes), in step 203, the transmission unit 524 transmits a request signal to the mounted vehicle 102 and the external Rider 90. On the other hand, if the mounted vehicle 102 does not exist (step 202: No), in step 204, the transmission unit 524 transmits a request signal to the external Rider 90.
[0053] If the vehicle control device 150 of the mounted vehicle 102 receives a request signal (step 205: Yes), in step 206, the vehicle control device 150 of the mounted vehicle 102 acquires onboard RID information from the onboard RID 161. Then, in step 207, the vehicle control device 150 of the mounted vehicle 102 transmits the onboard RID information to the calculation device 5. If the external RID 90 receives a request signal (step 208: Yes), in step 209, the external RID 90 transmits external RID information to the calculation device 5.
[0054] If a mounted vehicle 102 exists, that is, if the acquisition unit 521 acquires both in-vehicle Rider information and external Rider information (step 210: Yes), the calculation unit 522 executes steps 211 and 212. In step 211, the calculation unit 522 acquires vehicle position information by calculating the position and orientation of the target vehicle 101 using the in-vehicle Rider information. Furthermore, in step 212, the calculation unit 522 acquires vehicle position information by calculating the position and orientation of the target vehicle 101 using the external Rider information. Steps 211 and 212 may be executed in any order, or they may be executed concurrently.
[0055] As shown in Figure 8, if the position difference is less than a predetermined position threshold (step 214: No), the signal generation unit 523 executes step 215. The position difference is the difference between the position of the positioning point 10e of the target vehicle 101 calculated using the on-board RIDER information and the position of the positioning point 10e of the target vehicle 101 calculated using the external RIDER information corresponding to the acquisition timing of the on-board RIDER information. If the direction difference is less than a predetermined direction threshold (step 215: No), the signal generation unit 523 executes step 216. In step 216, the signal generation unit 523 generates a first control signal. The direction difference is the difference between the vector Va indicating the orientation of the target vehicle 101 calculated using the on-board RIDER information and the vector Vi indicating the orientation of the target vehicle 101 calculated using the external RIDER information corresponding to the acquisition timing of the on-board RIDER information. In step 217, the signal generation unit 523 generates a second control signal if at least one of the following is true: if the position difference is greater than or equal to the position threshold (step 214: Yes), or if the direction difference is greater than or equal to the direction threshold (step 215: Yes). The second control signal is, for example, a driving control signal which is either a stop control signal or a change control signal. The stop control signal is a driving control signal which is used to stop at least one of the target vehicle 101 and the mounted vehicle 102. The change control signal is a driving control signal which is used to change the destination of the mounted vehicle 102 when it is driven by remote control from an external source, from a predetermined target location to a maintenance location. The maintenance location is a location where at least one of the following is performed: a repair process to repair the onboard lidar 161, and a calibration process to calibrate the onboard lidar 161. The calibration process is, for example, a process which is used to adjust the optical axis reference Ls of the onboard lidar 161 as shown in Figure 5, or to correct the distances L1, L2 and angle differences θ1, θ2 acquired by the onboard lidar 161 so that they are correct. As shown in Figure 8, in step 218, the transmitting unit 524 transmits the driving control signal generated by the signal generation unit 523 to the vehicle 10 whose driving operation is to be controlled. If the vehicle control device 150 of the vehicle 10 receives the driving control signal (step 219: Yes), in step 220, the vehicle control device 150 uses the received driving control signal to control the actuator group 120.
[0056] On the other hand, as shown in Figure 7, if the mounted vehicle 102 does not exist, that is, if the acquisition unit 521 acquires external Rider information without acquiring on-board Rider information (step 210: No), the calculation unit 522 executes step 213. In step 213, the calculation unit 522 acquires vehicle position information by calculating the position and orientation of the target vehicle 101 using the external Rider information. Then, as shown in Figure 8, in step 216, the signal generation unit 523 generates a first control signal. Note that when the mounted vehicle 102 does not exist, each step from step 216 onward is the same as when the mounted vehicle 102 exists.
[0057] According to the second embodiment described above, when a vehicle 102 is present, onboard lidar information and external lidar information are acquired as sensor information, and the position and orientation of the target vehicle 101 are calculated from each sensor information, thereby calculating the position difference and the orientation difference. If at least one of the position difference and the orientation difference is greater than or equal to a threshold, a stop control signal is generated, allowing the vehicle 10 to be stopped more safely. In this way, it is possible to understand that the detection accuracy of at least one of the sensors, the onboard lidar 161 and the external lidar 90, may be degraded. If at least one of the position difference and the orientation difference is greater than or equal to a threshold, that is, if the detection accuracy of the sensor may be degraded, the vehicle 10 can be stopped more safely.
[0058] Furthermore, according to the second embodiment described above, if at least one of the positional difference and the directional difference is greater than or equal to a threshold, a change control signal is generated, and the mounted vehicle 102 can be driven toward the maintenance location. In this way, if the detection accuracy of the on-board lidar 161 may be degraded, the on-board lidar 161 can be maintained. In addition, by inspecting whether or not there is a malfunction such as misalignment of the optical axis in the on-board lidar 161 at the maintenance location, it is possible to estimate whether the malfunction is in the on-board lidar 161 or the external lidar 90.
[0059] C. Third Embodiment: Figure 9 shows the configuration of the calculation system 1v in the third embodiment. In this embodiment, the functions of the calculation device 5 are realized by the vehicle control device 150v. As a result, the vehicle 10v in this embodiment can be driven by autonomous control of the vehicle 10v.
[0060] The vehicle CPU 111v of the vehicle control device 150v executes the program PG1v stored in the vehicle memory unit 112v, thereby realizing various functions including those of the acquisition unit 116, the calculation unit 117, the signal generation unit 118, and the vehicle control unit 115v.
[0061] Figure 10 is a flowchart showing the processing procedure for controlling the vehicle 10v's driving in the third embodiment. The flow shown in Figure 10 is executed repeatedly at predetermined intervals, for example, from the time the vehicle 10v starts driving under autonomous control.
[0062] In step 11, the calculation unit 117 of the vehicle control device 150v mounted on the vehicle 10v acquires vehicle position information using sensor information. In step 21, the signal generation unit 118 determines the target position to which the vehicle 10v should next go. In step 31, the signal generation unit 118 generates a driving control signal to drive the vehicle 10v toward the determined target position. In step 41, the vehicle control unit 115v controls the actuator group 120 using the generated driving control signal to drive the vehicle 10v according to the parameters expressed in the driving control signal. The vehicle control device 150v repeats the acquisition of vehicle position information, determination of target position, generation of driving control signals, and control of actuators at predetermined intervals. According to the calculation system 1v in this embodiment, the vehicle 10v can be driven by autonomous control of the vehicle 10v without remote control of the vehicle 10v by a calculation device 5 installed in a different location from the vehicle 10v, such as a server.
[0063] D. Other embodiments: D-1. Other Embodiments 1: When there are multiple mounted vehicles 102 for a single target vehicle 101, the calculation units 117 and 522 may use the following sensor information as on-board lidar information. In this case, the calculation units 117 and 522 may use the on-board lidar information acquired by the on-board lidar 161 that can most accurately detect the target vehicle 101 among the multiple on-board lidars 161 possessed by the multiple mounted vehicles 102 as sensor information. The detection accuracy of the target vehicle 101 is determined, for example, by the distance L1 between the target vehicle 101 and the mounted vehicle 102, the shape and size of the target vehicle 101, the angular difference θ1 between the front-rear axis Cp2 of the target vehicle 101 and the optical axis reference Ls of the on-board lidar 161, and the presence or absence of obstacles in the surrounding area of the target vehicle 101 and the mounted vehicle 102. For example, if the angle difference θ1 between the optical axis reference Ls of the onboard lidars 161 mounted on each of the target vehicle 101 and the multiple mounted vehicles 102 is the same, and there are no obstacles in the surrounding area, the calculation unit 117,522 makes the following determination. In this case, the calculation unit 117,522 determines that the onboard lidar 161 mounted on the mounted vehicle 102 that is closer to the target vehicle 101 in distance L1 can detect the target vehicle 101 most accurately. In this configuration, when there are multiple mounted vehicles 102, the position and orientation of the target vehicle 101 can be calculated using the onboard lidar information acquired by the onboard lidar 161 that can detect the target vehicle 101 most accurately. This improves the accuracy of calculating the position and orientation of the target vehicle 101.
[0064] D-2. Other Embodiments 2: The calculation system 1,1v may include an external camera as an external sensor 300 that acquires overhead information installed at a location different from the vehicles 10,10v, in place of or in addition to the external lidar 90. The external camera is an imaging device such as a CCD image sensor that acquires captured images as image information including the target vehicle 101 as sensor information and outputs the captured images as detection results. When the external sensor 300 is an external camera, the calculation unit 117,522 acquires vehicle position information using the captured images acquired from the external camera, which is the external sensor 300. Specifically, the calculation unit 117,522, for example, detects the outline of the vehicles 10,10v from the captured images, calculates the coordinates of the positioning point 10e of the vehicles 10,10v in the coordinate system of the captured images, i.e., the local coordinate system, and acquires the position of the vehicles 10,10v by converting the calculated coordinates to coordinates in the global coordinate system. The outlines of vehicles 10 and 10v included in the captured images can be detected, for example, by inputting the captured images into a detection model utilizing artificial intelligence. The detection model is prepared, for example, within or outside of the calculation system 1 and 1v and pre-stored in the memory units 53 and 112v. Examples of detection models include pre-trained machine learning models that have been trained to implement either semantic segmentation or instance segmentation. As this machine learning model, for example, a convolutional neural network (CNN) trained by supervised learning using a training dataset can be used. The training dataset includes, for example, multiple training images containing vehicles 10 and 10v, and labels indicating whether each region in the training image represents a region representing a vehicle 10 or 10v or a region representing something other than a vehicle 10 or 10v. When training the CNN, it is preferable to update the CNN parameters by backpropagation to reduce the error between the output result of the detection model and the labels. Furthermore, the calculation units 117 and 522 can obtain the orientation of vehicles 10 and 10v by, for example, using the optical flow method, estimating the orientation of the movement vector of vehicles 10 and 10v calculated from the positional changes of feature points of vehicles 10 and 10v between frames of the captured image.In this configuration, the position and orientation of the target vehicle 101 can be calculated by inputting the image information into a pre-trained machine learning model that has been trained to detect the outline (contour) of the target vehicle 101 in the image.
[0065] D-3. Other Embodiments 3: If a vehicle 102 exists and the calibration of the on-board lidar 161 mounted on the vehicle 102 has not been completed, the calculation units 117,522 may calculate the position and orientation of the target vehicle 101 by using at least one of the image information and the external lidar information as sensor information, without using the on-board lidar information as sensor information. In this case, for example, the acquisition units 116,521 acquire calibration information indicating whether or not the calibration of the on-board lidar 161 has been completed. Specifically, the acquisition units 116,521 acquire calibration information for the on-board lidar 161 mounted on the vehicle 102 by referring to a calibration database, for example. The calibration database is, for example, a database that links vehicle identification information, on-board lidar identification information that identifies the on-board lidar 161, and the calibration status of the on-board lidar 161. In this way, the calculation device 5 selects the type of sensor information to be used when calculating the position and orientation of the target vehicle 101 based on the calibration information. If the calibration of the on-board lidar 161 is not complete, the acquisition units 116,521 may acquire only at least one of the image information and the external lidar information as sensor information without acquiring the on-board lidar information. Alternatively, even if the calibration of the on-board lidar 161 is not complete, the acquisition units 116,521 may acquire the on-board lidar information as sensor information in addition to at least one of the image information and the external lidar information. In this case, the calculation units 117,522 calculate the position and orientation of the target vehicle 101 using the information other than the on-board lidar information from the acquired sensor information. Furthermore, if the calibration of the on-board lidar 161 is not complete, the vehicle control device 150 of the mounted vehicle 102 may transmit an incomplete signal indicating that the calibration of the on-board lidar 161 is not complete to a calculation device 5, such as a server, located at a different location from the vehicle 10,10v, without acquiring the on-board lidar information. Furthermore, even if the calibration of the on-board lidar 161 is not yet complete, the vehicle control devices 150 and 150v of the vehicle 102 may acquire the on-board lidar information. In this case, the vehicle control device 150 of the vehicle 102 may transmit an incomplete signal to the calculation device 5, such as a server, instead of the acquired on-board lidar information.In this configuration, the position and orientation of the target vehicle 101 can be calculated using the on-board lidar information acquired by the calibrated on-board lidar 161. This makes it possible to more reliably suppress a decrease in the accuracy of calculating the position and orientation of the target vehicle 101. This reduces the possibility of generating driving control signals based on sensor information that may have reduced detection accuracy. Therefore, it is possible to suppress the target vehicle 101 from traveling along a route different from the desired driving path.
[0066] D-4. Other Embodiments 4: When a mounted vehicle 102 is present, the calculation units 117 and 522 may stop calculating the position and orientation of the target vehicle 101 using sensor information if the position difference is greater than or equal to the position threshold, or if the orientation difference is greater than or equal to the orientation threshold, in at least one of these cases. This allows the calculation of the position and orientation of the target vehicle 101 to be stopped if there is a possibility that the sensor detection accuracy has decreased. This avoids calculating the position and orientation of the target vehicle 101 based on sensor information that may have decreased detection accuracy. Therefore, it is possible to avoid generating a driving control signal based on an incorrect position and orientation of the target vehicle 101. Thus, it is possible to suppress the target vehicle 101 from traveling along a path different from the desired driving path.
[0067] D-5. Other Embodiments 5: When a mounted vehicle 102 exists, the calculation unit 117,522 may estimate the malfunctioning sensor if, at least one of the following occurs: the position difference is greater than or equal to the position threshold, or the direction difference is greater than or equal to the direction threshold. The calculation unit 117,522 estimates the malfunctioning sensor by, for example, comparing the position difference and direction difference calculated from sensor information of the on-board rider 161 and the external rider 90 acquired at multiple different timings. The calculation unit 117,522 may then stop calculating the position and direction of the target vehicle 101 using sensor information from the sensor estimated to be malfunctioning, without stopping the calculation of the position and direction of the target vehicle 101 using sensor information from sensors other than the one estimated to be malfunctioning. In this configuration, it is possible to estimate which sensor is malfunctioning. This allows the calculation of the position and direction of the target vehicle 101 to continue using sensor information acquired by sensors that are less likely to have reduced detection accuracy.
[0068] D-6. Other Embodiments 6: The calculation device 5 may further include a notification control unit that notifies the user of specific information in at least one of the following cases when a mounted vehicle 102 is present: when the position difference is greater than or equal to a position threshold, or when the direction difference is greater than or equal to a direction threshold. The specific information is information indicating that the detection accuracy of the sensor that acquires sensor information may be degraded. When there is a possibility that the sensor's detection accuracy is degraded, the notification control unit notifies the user of the specific information, for example, by displaying a message indicating the specific information on a display device or by playing an audio message indicating the specific information from a speaker. In this form, the user can be notified as quickly as possible that the sensor's detection accuracy may be degraded. This reduces the possibility of generating a driving control signal based on information indicating that the detection accuracy may be degraded, and reduces the number of vehicles 10,10v that stop due to receiving a stop control signal.
[0069] D-7. Other Embodiments 7: The calculation device 5 may calculate only one of the position or orientation of the target vehicle 101. Even in this configuration, at least one of the position or orientation of the target vehicle 101 can be used as one of the pieces of information when generating the control signal.
[0070] D-8. Other Embodiments 8: In each of the embodiments from the first to the third described above, the calculation device 5 selected the type of sensor information to be used when calculating the position and orientation of the target vehicle 101 based on existence information. In contrast, the calculation device 5 may include a determination unit that determines whether or not the mounted vehicle 102 exists based on information about whether or not information from the mounted lidar 161 could be obtained from the mounted vehicle 102, and information about whether or not the target vehicle 101 is included in the mounted lidar information. In such a configuration, the type of sensor information to be used when calculating the position and orientation of the target vehicle 101 can be selected based on whether or not onboard lidar information can be obtained and whether or not the target vehicle 101 is included in the mounted lidar information.
[0071] D-9. Other Embodiments 9: In the calculation system 1,1v, the functions of the calculation device 5 may be realized by multiple devices. For example, the calculation system 1,1v may include a calculation device 5 comprising acquisition units 116,521 and calculation units 117,522, and a remote control device comprising signal generation units 118,523 and transmission unit 524. In this case, the calculation device 5 and the remote control device are installed in locations different from the vehicles 10,10v. Even in this configuration, the position and orientation of the target vehicle 101 can be calculated using sensor information, depending on the mounting status of the on-board lidar 161.
[0072] D-10. Other Embodiments 10: Multiple reference objects 8 may be installed near the track R. If multiple reference objects 8 are installed near the track R, reflective material may be attached to each reference object 8 in a manner that differs in arrangement pattern, such as mounting position, mounting range, and number of objects. In this case, when the on-board lidar 161 and the external lidar 90 detect the reference objects 8, differences will occur in the 3D point cloud information representing each reference object 8 in the on-board lidar information and the external lidar information. This allows the calculation device 5 to distinguish between multiple reference objects 8 included in the on-board lidar information and the external lidar information. Alternatively, the calculation device 5 may distinguish between multiple reference objects 8 based, for example, on the positional relationship (distance between them) between the position of the vehicle 10 and the absolute position of each reference object 8. In this configuration, the position and orientation of the target vehicle 101 can be calculated using multiple reference objects 8 whose absolute positions are known as indicators. Therefore, the accuracy of calculating the position and orientation of the target vehicle 101 can be improved.
[0073] D-11. Other Embodiments 11: When calculating the position and orientation of vehicles 10 and 10v using 3D point cloud information as external lidar information, the calculation units 117 and 522 may acquire vehicle position information as follows. In this case, the calculation units 117 and 522 may acquire vehicle position information by template matching using, for example, 3D point cloud information as external lidar information output from the external lidar 90 as a detection result and pre-prepared reference point cloud information.
[0074] D-12. Other Embodiments 12: In the first and second embodiments described above, the calculation device 5 performs the processing from acquiring vehicle position information to generating a driving control signal. In contrast, the vehicle 10 may perform at least a part of the processing from acquiring vehicle position information to generating a driving control signal. For example, the following forms (1) to (3) may also be used.
[0075] (1) The calculation device 5 may acquire vehicle position information, determine the next target location that the vehicle 10 should head to, and generate a route from the vehicle 10's current location, as shown in the acquired vehicle position information, to the target location. The calculation device 5 may generate a route to the target location between the current location and the destination, or it may generate a route to the destination. The calculation device 5 may transmit the generated route to the vehicle 10. The vehicle 10 may generate a driving control signal so that the vehicle 10 travels along the route received from the calculation device 5, and may use the generated driving control signal to control the actuator group 120.
[0076] (2) The calculation device 5 may acquire vehicle position information and transmit the acquired vehicle position information to the vehicle 10. The vehicle 10 may determine the next target position to which the vehicle 10 should go, generate a route from the vehicle 10's current location shown in the received vehicle position information to the target position, generate a driving control signal so that the vehicle 10 travels along the generated route, and control the actuator group 120 using the generated driving control signal.
[0077] (3) In the embodiments of (1) and (2) above, the vehicle 10 is equipped with internal sensors, and the detection results output from the internal sensors may be used in at least one of the generation of the route and the generation of the driving control signal. The internal sensors are sensors mounted on the vehicle 10. The internal sensors may include, for example, sensors that detect the motion state of the vehicle 10, sensors that detect the operating state of each part of the vehicle 10, and sensors that detect the environment around the vehicle 10. Specifically, the internal sensors may include, for example, cameras, LiDAR, millimeter-wave radar, ultrasonic sensors, GPS sensors, acceleration sensors, gyro sensors, etc. For example, in the embodiment of (1) above, the calculation device 5 may acquire the detection results of the internal sensors and reflect the detection results of the internal sensors in the route when generating the route. In the embodiment of (1) above, the vehicle 10 may acquire the detection results of the internal sensors and reflect the detection results of the internal sensors in the driving control signal when generating the driving control signal. In the embodiment of (2) above, the vehicle 10 may acquire the detection results of the internal sensors and reflect the detection results of the internal sensors in the route when generating the route. In the embodiment described in (2) above, the vehicle 10 may acquire the detection results of the internal sensors and reflect the detection results of the internal sensors in the driving control signal when generating the driving control signal.
[0078] D-13. Other Embodiments 13: In the third embodiment described above, the vehicle 10v is equipped with an internal sensor, and the detection result output from the internal sensor may be used in at least one of the generation of the route and the generation of the driving control signal. For example, the vehicle 10v may acquire the detection result from the internal sensor and reflect the detection result from the internal sensor in the route when generating the route. The vehicle 10v may acquire the detection result from the internal sensor and reflect the detection result from the internal sensor in the driving control signal when generating the driving control signal.
[0079] D-14. Other Embodiments 14: In the third embodiment described above, the vehicle 10v acquires vehicle position information using the detection results of the external sensor 300. Alternatively, the vehicle 10v may be equipped with an internal sensor, which can acquire vehicle position information using the detection results of the internal sensor, determine the next target location to which the vehicle 10v should go, generate a route from the vehicle 10v's current location to the target location as shown in the acquired vehicle position information, generate a driving control signal for traveling along the generated route, and control the actuator group 120 using the generated driving control signal. In this case, the vehicle 10v can travel without using the detection results of the external sensor 300 at all. The vehicle 10v may also acquire target arrival time and congestion information from outside the vehicle 10v and reflect the target arrival time and congestion information in at least one of the route and the driving control signal. Furthermore, the functional configuration of the calculation systems 1 and 1v may all be provided in the vehicle 10v. In other words, the processing realized by the calculation systems 1 and 1v in this disclosure may be realized by the vehicle 10v alone. For example, a vehicle 102 equipped with an on-board lidar 161 can implement all the functions of the calculation system 1,1v using only the vehicle's 10v.
[0080] D-15. Other Embodiments 15: In the first and second embodiments described above, the calculation device 5 automatically generates a driving control signal to be transmitted to the vehicle 10. In contrast, the calculation device 5 may generate a driving control signal to be transmitted to the vehicle 10 according to the operation of an external operator located outside the vehicle 10. For example, the external operator may operate a control device that includes a display for displaying captured images output from the external sensor 300, a steering wheel for remotely controlling the vehicle 10, an accelerator pedal, a brake pedal, and a communication device for communicating with the calculation device 5 via wired or wireless communication, and the calculation device 5 may generate a driving control signal in response to the operation applied to the control device. In this case, the calculation device 5 may, for example, notify the external operator by displaying the calculated position and orientation of the vehicle 10 on the display of the control device.
[0081] D-16. Other Embodiments 16: In each of the above embodiments, the vehicles 10 and 10v only need to be configured to be able to move by unmanned operation, and may, for example, be in the form of a platform having the configuration described below. Specifically, in order for the vehicles 10 and 10v to perform the three functions of "driving," "turning," and "stopping" by unmanned operation, they only need to be equipped with at least a vehicle control device 150 and 150v and an actuator group 120. When the vehicles 10 and 10v acquire information from the outside for unmanned operation, they may further be equipped with a communication device 130. That is, the vehicles 10 and 10v that can move by unmanned operation do not need to be equipped with at least some of the interior parts such as the driver's seat and dashboard, at least some of the exterior parts such as the bumper and fender, and do not need to be equipped with a body shell. In this case, the remaining parts such as the body shell may be attached to the vehicle 10,10v before it is shipped from the factory, or the remaining parts such as the body shell may be attached to the vehicle 10,10v after it has been shipped from the factory, while the remaining parts such as the body shell are not attached to the vehicle 10,10v. Each part may be attached from any direction, such as the top, bottom, front, rear, right, or left side of the vehicle 10, and each part may be attached from the same direction or from different directions. The position of the platform may also be determined in the same way as the vehicle 10,10v in the first embodiment.
[0082] D-17. Other Embodiments 17: Vehicle 10,10v may be manufactured by combining multiple modules. A module means a unit composed of multiple parts grouped together according to the part or function of vehicle 10,10v. For example, the platform of vehicle 10,10v may be manufactured by combining a front module that constitutes the front part of the platform, a central module that constitutes the central part of the platform, and a rear module that constitutes the rear part of the platform. The number of modules that make up the platform is not limited to three, and may be two or fewer, or four or more. In addition to, or instead of, the parts that make up the platform may be modularized, as well as parts that make up parts of vehicle 10,10v that are different from the platform. Various modules may also include any exterior parts such as bumpers and grilles, or any interior parts such as seats and consoles. Furthermore, not limited to vehicle 10,10v, any type of mobile body may be manufactured by combining multiple modules. Such modules may be manufactured, for example, by joining multiple parts by welding or fasteners, or by integrally molding at least a part of the parts that make up the module as a single part by casting. A molding technique for integrally molding a single component, especially a relatively large component, is also called gigacast or megacast. For example, the front module, central module, and rear module mentioned above may be manufactured using gigacast.
[0083] D-18. Other Embodiments 18: The use of unmanned operation of the 10,10v vehicle to transport the vehicle is also called "autonomous transport." The configuration for realizing autonomous transport is also called a "vehicle remote control autonomous driving transport system." Furthermore, a production method that uses autonomous transport to produce the 10,10v vehicle is also called "autonomous production." In autonomous production, for example, in a factory that manufactures the 10,10v vehicle, at least a portion of the transport of the 10,10v vehicle is realized by autonomous transport.
[0084] This disclosure is not limited to the embodiments described above, and can be implemented in various configurations without departing from its spirit. For example, the technical features of the embodiments corresponding to the technical features in each form described in the summary of the invention can be replaced or combined as appropriate in order to solve some or all of the above-described problems, or to achieve some or all of the above-described effects. Furthermore, if a technical feature is not described as essential in this specification, it can be deleted as appropriate. [Explanation of Symbols]
[0085] 1,1v...Calculation system, 5...Calculation device, 8...Reference object, 10,10v...Vehicle, 10e...Positioning point, 10f...Specific part, 51...Communication device of the calculation device, 52...Device CPU, 53...Device memory unit, 54...Input / output interface of the calculation device, 55...Internal bus of the calculation device, 90...External lider, 101...Target vehicle, 102...Vehicle on which it is mounted, 111,111v...Vehicle CPU, 112,112v...Vehicle memory unit, 113...Input / output interface of the vehicle control device, 114...Internal bus of the vehicle control device, 115,115v...Vehicle control unit, 116,521...Acquisition unit, 117,522...Calculation unit, 118,523...Signal generation unit, 120...Actuator group, 130...Vehicle communication device, 150,150v...Vehicle control Your device, 160...Vehicle sensor group, 161...Vehicle lidar, 300...External sensor, 524...Transmitter, Bt...Downward side, Cf...Front center point, Ci...Intermediate axis, Cp1...Front-rear axis of the mounted vehicle, Cp2...Front-rear axis of the target vehicle, Cr...Rear center point, Dp1...First detection point, Dp2...Second detection point, Dp3...Third detection point, Dp4...Fourth detection point, Fr...Front side, L1,L2...Distance, Lf...Left side, Ls...Optical axis reference, Mp1...First midpoint, Mp2...Second midpoint, PG1,PG1v,PG2...Program, R...Track, RG1,RG2...Detection range, Re...Rear side, Ri...Right side, RR...Reference path, Tp...Upward side, Va...Direction vector, Vi...Intermediate vector, Vs1...First detection vector, Vs2...Second detection vector
Claims
1. A calculation device used to move a mobile object that can be moved by unmanned operation, An acquisition unit that acquires sensor information obtained by a sensor, and existence information indicating whether or not there is a mounted mobile body equipped with a mounted distance measuring device, which includes a target mobile body, within the detection range of the mounted distance measuring device. The system includes a calculation unit that uses the sensor information acquired by the acquisition unit to calculate at least one of the position and orientation of the target moving object, The calculation unit described above, If the mounted moving body exists, the mounted distance measuring device information acquired by at least the mounted distance measuring device is used as the sensor information to calculate at least one of the position and orientation of the target moving body. If the mounted mobile body does not exist, at least one of the following is used as sensor information: image information acquired by an external camera acting as a sensor installed at a location different from the target mobile body and the mounted mobile body, and external distance measuring device information acquired by an external distance measuring device acting as a sensor installed at a location different from the target mobile body and the mounted mobile body, to calculate at least one of the position and orientation of the target mobile body. The aforementioned calculation device further, A signal generation unit that generates a control signal for controlling the movement of the moving body, A transmitting unit that transmits the control signal generated by the signal generation unit to the mobile body, When the aforementioned mounted mobile body exists, The acquisition unit acquires, in addition to the mounted distance measuring device information, at least one of the image information and the external distance measuring device information as the sensor information. The calculation unit uses the mounted distance measuring device information as sensor information to calculate at least one of the position and orientation of the target moving object, and uses at least one of the image information and the external distance measuring device information as sensor information to calculate at least one of the position and orientation of the target moving object. Calculation device, in at least one of the following cases: (i) when the difference between the position of the target moving object calculated using the mounted distance measuring device information and the position of the target moving object calculated using at least one of the image information and the external distance measuring device information is greater than or equal to a predetermined position threshold; and (ii) when the difference between the orientation of the target moving object calculated using the mounted distance measuring device information and the orientation of the target moving object calculated using at least one of the image information and the external distance measuring device information is greater than or equal to a predetermined direction threshold, the signal generation unit generates either (a) a stop control signal for stopping the moving object, or (b) a change control signal for changing the destination of the mounted moving object when it moves by unmanned operation from a predetermined target location to a maintenance location where at least one of a repair process for repairing the mounted distance measuring device and a calibration process for calibrating the mounted distance measuring device is performed, as the control signal.
2. A calculation device according to claim 1, In the case where there are multiple mounted mobile bodies, the calculation unit uses the mounted distance measuring device information obtained by the mounted distance measuring device that can most accurately detect the target mobile body among the multiple mounted distance measuring devices of the multiple mounted mobile bodies as the sensor information.
3. A calculation device according to claim 1, The acquisition unit further acquires calibration information indicating whether or not the calibration of the mounted distance measuring device has been completed. The calculation unit described above, When the mounted mobile body exists and the calibration of the mounted distance measuring device has been completed, at least one of the position and orientation of the target mobile body is calculated by using the mounted distance measuring device information as the sensor information. A calculation device that, when the mounted moving body exists and the calibration of the mounted distance measuring device has not been completed, calculates at least one of the position and orientation of the target moving body by using at least one of the image information and the external distance measuring device information as the sensor information, without using the mounted distance measuring device information as the sensor information.
Citation Information
Patent Citations
Axis adjusting method of radar device and axis adjusting device
JP2009281862A
Vehicle-use radio communication apparatus and communication system
JP2013025423A
Navigation device, navigation method, and navigation program
JP2016105056A
Method for operating a vehicle and method for operating a manufacturing system
JP2017538619A
Information generation system, information generation apparatus, information generation method, and computer program
JP2019079453A