WO1998036337A1 - Vehicle monitor - Google Patents
Vehicle monitor Download PDFInfo
- Publication number
- WO1998036337A1 WO1998036337A1 PCT/JP1998/000561 JP9800561W WO9836337A1 WO 1998036337 A1 WO1998036337 A1 WO 1998036337A1 JP 9800561 W JP9800561 W JP 9800561W WO 9836337 A1 WO9836337 A1 WO 9836337A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- vehicle
- vehicles
- monitoring station
- data
- transmitting
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Ceased
Links
Classifications
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
- G08G1/20—Monitoring the location of vehicles belonging to a group, e.g. fleet of vehicles, countable or determined number of vehicles
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
- E02F9/20—Drives; Control devices
- E02F9/2025—Particular purposes of control systems not otherwise provided for
- E02F9/2045—Guiding machines along a predetermined path
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
- E02F9/20—Drives; Control devices
- E02F9/2025—Particular purposes of control systems not otherwise provided for
- E02F9/205—Remotely operated machines, e.g. unmanned vehicles
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S11/00—Systems for determining distance or velocity not using reflection or reradiation
- G01S11/02—Systems for determining distance or velocity not using reflection or reradiation using radio waves
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0268—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means
- G05D1/027—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means comprising intertial navigation means, e.g. azimuth detector
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0287—Control of position or course in two dimensions specially adapted to land vehicles involving a plurality of land vehicles, e.g. fleet or convoy travelling
- G05D1/0291—Fleet control
- G05D1/0297—Fleet control by controlling means in a control room
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0276—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
- G05D1/0278—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle using satellite positioning signals, e.g. GPS
Definitions
- the present invention relates to a vehicle monitoring device comprising a plurality of vehicles provided with vehicle position measuring means for measuring a position of a vehicle of the vehicle, and a monitoring station transmitting instruction data for instructing the plurality of vehicles to travel. .
- a monitoring station In order to manage the operation of unmanned vehicles such as unmanned dump trucks that perform sediment transport and other operations at wide-area work sites such as quarries and mines, a monitoring station is set up as a ground station, and this monitoring station A vehicle monitoring system is configured to control and monitor these unmanned vehicles.
- a transmitter / receiver for example, a VHF system
- a VHF system that performs long-distance wireless communication between a monitoring station and a plurality of vehicles
- the position data of the own vehicle measured by each vehicle has been provided.
- Various types of data are transmitted to the monitoring station at very short intervals (for example, every second), so that the monitoring station attempts to monitor each vehicle while grasping the exact position of each vehicle. ing.
- the monitoring station that has received the position data and the like transmitted from the vehicle sends data to the effect that the data has been received to the vehicle, so that each vehicle can confirm the failure of the transmitting / receiving device mounted on its own vehicle. Had to do it.
- this communication method enables long-distance (10 kn! To 20 km) communication, and covers communication over the entire wide-area work site.
- the slow communication speed (9600 bps) the current position of many vehicles cannot always be known. That is, a large amount of data is transmitted from a large number of vehicles to the monitoring station, and the amount of communication information is increased. Since this is handled by a communication method with a low communication speed, the communication line becomes congested, and the load on the communication line increases, so that vehicle management and monitoring become virtually impossible.
- auxiliary equipment such as radio communication stations must be newly installed at various parts of the work site to compensate for the shortage of radio wave reach . This increases the cost of initial investment and maintenance, and makes practical use difficult.
- the monitoring station in response to transmissions from a large number of vehicles, the monitoring station sends data indicating that the data has been received back to the large number of vehicles, so that each vehicle has a failure in the transmission / reception device mounted on its own vehicle.
- this method was implemented using the communication method described in 1) above, the number of vehicles received from the monitoring station was always large due to the slow communication speed. It was not possible to send back data to the effect that the vehicle had failed, and it was not possible to quickly and reliably confirm that the vehicle had failed.
- the present invention has been made in view of the above circumstances, and enables communication over a wide-area work site without increasing the cost associated with arranging auxiliary equipment, and furthermore, the burden on the monitoring station of controlling vehicles from one another.
- the problem to be solved is that it can be performed sufficiently without compromising safety, and that when a failure occurs in the transmitting / receiving device, it can be confirmed quickly and reliably, thereby enabling prompt and appropriate abnormality processing. Is what you do. Disclosure of the invention
- the first invention of the present invention comprises a plurality of vehicles provided with vehicle position measuring means for measuring the position of the vehicle, and a monitoring station for transmitting instruction data for instructing the plurality of vehicles to travel.
- Vehicle monitoring device for measuring the position of the vehicle, and a monitoring station for transmitting instruction data for instructing the plurality of vehicles to travel.
- a first communication method capable of wirelessly communicating the distance between the monitoring station and the plurality of vehicles; a first communication method for transmitting and receiving at least the instruction data between the monitoring stations and the plurality of vehicles;
- the transmitting / receiving means is provided in each of the monitoring station and the plurality of vehicles, and the distance between the plurality of vehicles can be wirelessly communicated, and data can be transmitted / received faster than the first communication method.
- a second transmission / reception unit for transmitting / receiving the position data measured by the vehicle position measurement unit between the plurality of vehicles by the second communication method, for each of the plurality of vehicles;
- the first transmission / reception means for example, the VHF or UHF method
- the monitoring station only transmits at least the instruction data via the first transmission / reception means, and the position data is transmitted / received between the plurality of vehicles via the second transmission / reception means (for example, SS radio). Since the positional relationship between vehicles is monitored, the frequency of communication between the monitoring station and multiple vehicles can be reduced, reducing the load on the monitoring station and the load on the communication line, while colliding due to high-speed communication between vehicles. Avoidance control is performed between vehicles, and safety can be ensured.
- data can be transmitted to the vehicle by two types of transmission / reception means, even if an abnormality such as a failure occurs in one of the transmission / reception means, information to that effect can be promptly and reliably transmitted via the other transmission / reception means. It is possible to notify the vehicle and perform predetermined abnormal processing such as stopping the vehicle quickly and appropriately.
- a plurality of vehicles provided with vehicle position measuring means for measuring a vehicle position of the own vehicle, position data transmitted from each of the plurality of vehicles is received, and the received position is A monitoring station that transmits instruction data for instructing the plurality of vehicles to travel while monitoring a mutual positional relationship between the plurality of vehicles based on the data.
- the monitoring station transmits and receives the position data and the instruction data between the plurality of vehicles.
- a first transmitting / receiving means provided in each of the monitoring station and the plurality of vehicles,
- Second transmitting / receiving means for transmitting / receiving the vehicle is provided for each of the plurality of vehicles,
- the first transmitting / receiving means provided for each of the plurality of vehicles By transmitting the position data to the monitoring station every time the interval elapses, the monitoring station monitors the positions of the plurality of vehicles,
- the position data of the plurality of vehicles can be monitored at the monitoring station by transmitting the position data to the monitoring station every time a predetermined time elapses by the first transmitting / receiving means provided for each of the plurality of vehicles. Therefore, the monitoring station can grasp the approximate positional relationship between the vehicles with a small load, and can reliably transmit an appropriate command to each vehicle.
- the position data is transmitted between the plurality of vehicles by the second transmitting / receiving means provided for each of the plurality of vehicles, so that it is determined that each of the plurality of vehicles has approached another vehicle. Therefore, each vehicle can quickly and accurately grasp the positional relationship between the vehicles, and can quickly and accurately perform control such as collision avoidance between the vehicles at the time of running at an intersection or passing each other.
- FIG. 1 is a diagram showing an external appearance of an entire unmanned dump truck monitoring system which is an embodiment of a vehicle monitoring device according to the present invention.
- FIG. 2 is a block diagram illustrating a configuration of a communication system according to the embodiment.
- FIG. 3 is a diagram showing a state in which the planned traveling path on which the unmanned dump truck according to the embodiment is to travel is divided into points.
- FIG. 4 is a flowchart showing the procedure of the failure determination and abnormality processing of the present embodiment.
- FIG. 5 is a flowchart showing the procedure of failure determination and abnormality processing according to the present embodiment. You.
- FIG. 6 is a flowchart illustrating the procedure of the failure determination and the abnormality processing according to the present embodiment.
- FIG. 7 is a flowchart illustrating the procedure of the failure determination and the abnormality processing according to the present embodiment.
- Figure 8 is a diagram used to explain dead reckoning. BEST MODE FOR CARRYING OUT THE INVENTION
- Fig. 1 shows an unmanned dump truck monitoring system that manages and monitors a large number of unmanned dump trucks 10, 11, 12, 13, ... at a wide-area work site 30, such as a mine, assumed in this embodiment. 1 shows the appearance.
- FIG. 2 is a block diagram showing only the wireless communication system of the unmanned dump truck monitoring system.
- this unmanned dump truck monitoring system mainly consists of a plurality of unmanned dump trucks (hereinafter referred to as vehicles) equipped with a vehicle position measuring device, which measures the vehicle position ( ⁇ , ⁇ ) of the driver. 1 0, 1 1, 1 2, 1 3... and the position data (X, Y) transmitted from each of the plurality of vehicles 1 0... are received, and based on the received position data, a plurality of vehicles 1
- the monitoring station 20 transmits instruction data for instructing running, stopping, and the like to the plurality of vehicles 10 while monitoring the mutual positional relationship of 0.
- the vehicle is assumed to be an unmanned dump truck, but may be a manned vehicle, and may be applied to a wheel loader other than a dump truck, a hydraulic shovel, and the like. It can also be applied to systems with mixed vehicles and manned vehicles, and systems with mixed dump trucks, wheel loaders, hydraulic shovels, etc.
- Wireless communication is performed by the communication devices 23 and 5.
- the distance between the monitoring station 20 and the plurality of vehicles 10, that is, the communication system capable of wireless communication over the entire wide-area work site 30, for example, the monitoring station / vehicle communication device 23 using the VHF system, 5 are arranged on the monitoring station 20 side and the vehicle 10 side, respectively.
- the position data and the instruction data are transmitted and received between the monitoring station 20 and the plurality of vehicles 10.
- the monitoring station on the monitoring station 20 side The inter-vehicle communication device 23 includes a transmitting unit 21 and a receiving unit 22.
- the monitoring station on the vehicle 10 side The inter-vehicle communication device 5 includes the transmitting unit 1
- the radio communication A is performed via the antenna 20a of the monitoring station 20 and the antenna 10a of the vehicle 10 as shown in FIG.
- the wireless communication B is performed via the antenna 20 a of the monitoring station 20 and the antenna 11 a of the vehicle 11, and the antenna 20 a of the monitoring station 20 and the antenna of the vehicle 12 are used.
- Wireless communication C is performed via 12a
- wireless communication D is performed via antenna 20a of monitoring station 20 and antenna 13a of vehicle 13 respectively.
- wireless communication is also performed between a plurality of vehicles by the inter-vehicle communication device 6.
- a communication method capable of wirelessly communicating the distance between the plurality of vehicles and transmitting and receiving data at a higher speed than the monitoring station / inter-vehicle communication device 23, 5; for example, a vehicle using SS wireless communication
- An intercommunication device 6 is provided for each of the vehicles 10, 11, 12, 13,..., And the position data is transmitted and received between the plurality of vehicles.
- the vehicle-to-vehicle communication device 6 of the vehicle 10 includes a transmitting unit 3 and a receiving unit 4. As shown in FIG. 1, the antenna 10 b of the vehicle 10 and the antenna 11 b of the vehicle 11 are connected to each other.
- a tire rotation sensor 30 for example, a dial pulse encoder, which is a vehicle traveling distance detection unit, is attached to the tire of each vehicle 10... To detect the number of rotations of the tire.
- a gyro 31 (for example, an optical fiber gyro), which is a vehicle azimuth detecting unit, is provided on the vehicle body, and detects an angular velocity ⁇ of the vehicle body posture angle.
- the vehicle position ( ⁇ , ⁇ ) (the position on the two-dimensional coordinate system ⁇ — ⁇ ) to be described later is detected based on the respective outputs of the tire rotation sensor 30 and the jay mouth 31 as described below. Since the position includes accumulated errors due to tire slip, etc., for example, the above-mentioned accumulated errors are intermittently determined based on the relative positional relationship between the vehicle and the reflective pole intermittently arranged along the planned traveling path of the vehicle. You can correct it.
- the vehicle position may be measured by a global positioning system (GPS).
- GPS global positioning system
- Each vehicle 10 Is equipped with an arithmetic processing unit 32 mainly composed of a CPU and a memory, and performs processing based on dead reckoning navigation, as described later, and transmits control signals to each electromagnetic proportional motor for driving the vehicle. Output to valve etc.
- the arithmetic processing device 32 When the detection signal of the tire rotation sensor 30 which is a vehicle traveling distance detection unit and the detection signal of the gyro 31 which is a vehicle heading detection unit are input to the arithmetic processing unit 32, the following processing is sequentially executed. You.
- the tire rotation speed N is obtained based on the detection signal of the tire rotation sensor 30.
- the vehicle travel distance S is calculated from the product of the tire rotation speed N and the known tire load radius r.
- the vehicle orientation change ⁇ is calculated by integrating the angular velocity ⁇ of the vehicle body's attitude angle based on the detection signal of the gyro 31, and the azimuth change ⁇ is added to the known initial orientation to obtain the initial vehicle orientation.
- the current vehicle direction ⁇ ⁇ ⁇ ⁇ with respect to is calculated.
- the arithmetic processing unit 32 compares the trajectory 41 of the vehicle 10 calculated in this way with the planned travel path 40 which is the target route, and performs so-called dead reckoning so that the vehicle 10 passes on the planned travel path 40.
- the vehicle 10 is controlled. That is, the arithmetic processing unit 32 sequentially calculates the target vehicle positions P, 1, ⁇ '2, ⁇ ' 3,..., The target vehicle azimuth 0,
- the required electric signal is output to the steering hydraulic proportional solenoid valve to control the steering angle.
- the arithmetic processing unit 32 is required for the electronic control governor, the transmission solenoid valve, and the brake pressure solenoid proportional valve so that the sequential target vehicle position and target vehicle direction on the scheduled traveling path 40 can be obtained. Output the electric signal of the engine to control the engine speed, transmission speed stage, and brake pressure. Thus, the vehicle 10 is guided along the planned traveling path 40.
- the planned travel route 40 includes many travel routes 40-1, 40-2, 40-3.
- the traveling paths 40-1, 40-2, 40-3,... May have points that cross each other, or they may pass each other on the same traveling path. Therefore, first, the teaching of the planned traveling path 40 is performed prior to the actual work.
- the operator drives one vehicle, for example, the vehicle 10 and actually travels on all the planned traveling paths 40-1, 40-2, 40-3,. ⁇ '
- the monitoring station 20 that has received the travel path data sends, to the monitoring station / inter-vehicle communication device 23, the travel path data for the planned travel path required for each of the vehicles 10, 11, 12, 13,. Send to vehicle.
- the planned traveling path of the vehicle 10 is the traveling path 40-1
- traveling path data relating to the traveling path 40-1 is transmitted to the vehicle 10. Note that all travel route data may be transmitted to each vehicle.
- division position data (X, Y) of each division point Ql, Q2, Q3, etc. obtained by dividing the planned traveling path 40 into each point is acquired. (See Figure 3).
- Each of these division points Ql, Q2, 03... Is transmitted to the monitoring station 20 by the monitoring station and the inter-vehicle communication device 5 every time each vehicle passes through the division point. X, Y) to the monitoring station 20. Therefore, the following are considered as criteria for determining these division points Ql, Q2, Q3 ...
- the monitoring station 20 keeps track of the position of each vehicle without any load on the communication line.
- the interval (time) is set as much as possible.
- the distance between adjacent division points (Qi to Qi + l) should be set so as not to be smaller than the effective detection distance of this obstacle sensor.
- the division point data thus obtained is transmitted to the monitoring station 20 by the monitoring station / vehicle communication device 5 together with the traveling road data.
- the monitoring station 20 that has received the division point data transmits the division point data for the planned traveling route required for each vehicle 10, 11, 12, 13, ... by the monitoring station and the inter-vehicle communication device 23. Transmit to each vehicle. For example, if the planned traveling path of the vehicle 10 is the traveling path 401, the division point data relating to the traveling path 40-1 is transmitted to the vehicle 10. Note that the division point data of all the running paths may be transmitted to each vehicle. Thus, the teaching is completed, and the teaching data (runway data, division point data) is stored in a predetermined memory of each vehicle.
- each vehicle determines the division point as a point to transmit the current position data P (X, Y) of its own vehicle to the monitoring station 20.
- a corresponding transmission time interval may be set in advance.
- the above points 1), 2) and 3) (at least 1) are also taken into account when determining the transmission time interval.
- the monitoring station 20 sends the instruction data indicating the final destination (destination) to each vehicle 10... From the transmitting section 21 of the monitoring station / inter-vehicle communication device 23. Send In the case of performing position measurement using GPS, the monitoring station 20 transmits differential data of GPS to each vehicle.
- the arithmetic processing unit 32 executes the scheduled traveling route by the dead reckoning navigation described above based on the teaching traveling route data stored in the memory. Guide your vehicle along 40 and perform a series of tasks such as loading, transporting, and discharging cargo.
- each vehicle 10 constantly compares the current position measurement data (X, Y) with the teaching division point data stored in the memory, and has each of the division points Ql, Q2, Q3 reached? Whether or not it is always determined. Therefore, when the vehicle reaches the division point, the current position data (X, Y) is transmitted to the monitoring station 20 from the transmitting unit 1 of the monitoring station / inter-vehicle communication device 5 at that time.
- each of the vehicles 10 has approached at least the distance between the division points Q i to Q i + l (hereinafter, referred to as a segment).
- the monitoring station 20 can always, but generally, understand the positional relationship among a plurality of vehicles without any load on the communication line.
- appropriate driving and stopping instruction data is transmitted from the monitoring unit / transmitter 21 of the inter-vehicle communication device 23 to the relevant vehicle. can do.
- vehicle 10 is traveling in the segment between division points Q2 and Q3
- vehicle 11 is traveling in the segment between division points Q103 and Q5
- deceleration or stop instruction data is transmitted to the vehicle 10.
- the current position data is transmitted from each vehicle 10 to the monitoring station 20.
- the direction data ⁇ ⁇ ⁇ , the speed data, and the reliability of position measurement (error ), And data indicating the amount of deviation of the vehicle from the planned travel path 40, etc. to the monitoring station 20 in order to further enhance the accuracy of the control and monitoring performed by the monitoring station 20.
- the vehicle-to-vehicle communication device 6 When the vehicles 10 are traveling (during work), the vehicle-to-vehicle communication device 6 provided for each vehicle transmits and receives position data between the vehicles. However, if line congestion is expected when all vehicles transmit and receive at the same time, the priority can be determined as follows.
- Each vehicle constantly transmits its own position data to other vehicles via the inter-vehicle communication device 6, whereby each vehicle confirms the existence of the vehicle closest to its own vehicle. Thereafter, these closest vehicles frequently exchange position data via the inter-vehicle communication device 6 with priority.
- the monitoring station 20 confirms the existence of the closest vehicles based on the position data transmitted from each vehicle. Then, the information to that effect is transmitted to these closest vehicles via the monitoring station / inter-vehicle communication devices 23 and 5. Thereafter, the closest vehicles to which this information has been transmitted frequently exchange position data via the inter-vehicle communication device 6 with priority. In this way, between vehicles that are allowed to communicate with each other with priority, control is performed to prevent interference between the vehicles based on the received position data of the other vehicle ⁇ That is, the vehicles collide at the intersection If you are about to hit or crash, you can decide which vehicle should slow down and go ahead.
- the monitoring station 20 can only judge that each of the vehicles 10 has approached at least the distance between the division points Q i to Q i + l (hereinafter, referred to as a segment). However, it can be determined that different vehicles are traveling in the same segment. However, according to this inter-vehicle communication, in each of a plurality of vehicles, the other vehicle is moved to a distance smaller than the segment distance. The closeness can be accurately determined.
- the current position data is transmitted and received between the vehicles 10... By inter-vehicle communication.
- the direction data e and the speed data are transmitted.
- -Data indicating the reliability (error) of the position measurement, data indicating the amount of deviation of the vehicle from the planned traveling path 40, data indicating the vehicle weight, and data indicating the distance to the difference point.
- the accuracy of priority when entering an intersection and the accuracy of collision avoidance may be increased.
- Data indicating the effective detection distance of the object detection sensor may be transmitted and received to increase the accuracy of deceleration speed when passing each other and the accuracy of collision avoidance.
- data can be transmitted to the vehicle by the two communication devices. Therefore, even if an abnormality such as a failure occurs in one of the communication devices, information to that effect is transmitted via the other communication device. Can be promptly and reliably notified to the vehicle, and predetermined abnormal processing such as stopping the vehicle can be performed promptly and appropriately.
- FIG. 4 is a flowchart showing the procedure of fault determination and abnormality processing when data is no longer transmitted from the monitoring station 20 to the vehicle.
- the monitoring station 20 transmits predetermined data for each vehicle 10..., For example, data indicating the mutual positional relationship of all the vehicles at a constant cycle. Sent from one.
- each vehicle 10 Determines whether or not the predetermined data has been received by the receiving unit 2 of its own monitoring station / inter-vehicle communication device 5 every time the predetermined period elapses.
- the monitoring station 20 side It is determined that a failure has occurred in one of the transmission unit 21 of the inter-vehicle communication device 23 and the monitoring unit of the vehicle 10 side and the reception unit 2 of the inter-vehicle communication device 5. It is determined that sufficient information for avoiding a collision is not obtained, and the vehicle 10 is stopped to secure safety (step 102).
- the stopped vehicle 10 performs transmission / reception with other surrounding vehicles 11, 1 2,... By the non-failed inter-vehicle communication device 6 to monitor other vehicles.
- the reception state is confirmed with the viewing station 20 (step 103).
- Each of the other vehicles 11, 12,... Determines whether or not the predetermined data has been received by the receiving unit 2 of its own monitoring station / inter-vehicle communication device 5 every time the predetermined period elapses.
- Step 104 As a result, when it is determined that the predetermined data to be transmitted from the monitoring station 20 has not been received in other vehicles, the monitoring station on the monitoring station 20 side is determined. It is determined that a failure has occurred in the transmission unit 21 of the inter-vehicle communication device 23 (the monitoring station on the vehicle 10 side and the reception unit 2 of the inter-vehicle communication device 5 is normal) (step 105). The fault occurrence data indicating that the station is in the “transmitter failure” is sent to the monitoring station 20.
- this failure occurrence data or the normal confirmation data indicating that the transmitter is normal is not It is transmitted periodically (for example, together with the position data) from the vehicle to the monitoring station 20 (step 106).
- the monitoring of the own vehicle 10 is performed.
- the failure occurrence data indicating that the “reception unit failure of the vehicle 10” is transmitted to the monitoring station 20 (step 11 1).
- FIG. 5 is a flowchart showing the procedure of fault determination and abnormality processing when data is no longer transmitted from the vehicle to the monitoring station 20.
- the monitoring station 20 sequentially determines whether or not the position data P has been received at every fixed time when the vehicle passes the division point Q.
- Step 201 when the periodic transmission of the position data P from the vehicle is interrupted (step 201), it is determined whether or not the interruption of the transmission is for all vehicles 10. (Step 202).
- the monitoring station 20 transmits, to the vehicles around the vehicle 10, for example, the vehicle 11, instruction data indicating that “the transmission unit of the vehicle 10 has failed, and the vehicle 10 should be stopped” ( Step 205).
- the surrounding vehicle 11 that has received this transmits the instruction data to the failed vehicle 10 via the inter-vehicle communication device 6 (step 206).
- Step 2 07 the instruction data is received by the receiving unit 4 of the own vehicle-to-vehicle communication device 6 in which no failure has occurred, and the monitoring station 20 keeps the instruction data of the vehicle 10.
- the current position cannot be ascertained, so there is not enough information to avoid collisions between the vehicles.
- Step 2 07 it is determined that a failure has occurred in the transmission unit 1 of the monitoring station / inter-vehicle communication device 5 on the specific vehicle 10 side, and after confirming the fact, The monitor 20 transmits to the vehicle 10 failure occurrence data indicating that the "transmitting unit failure of the vehicle 10". It is assumed that the failure occurrence data or the normal confirmation data indicating that the transmission section is normal is transmitted from the monitoring station 20 to the vehicle periodically (step 208). Then, its own vehicle 10 is stopped (step 207).
- step 202 if it is determined in step 202 that the position data has not been received for all vehicles 10..., The monitoring station on the monitoring station 20 side and the inter-vehicle communication device 23 receive the position data. It is determined that a failure has occurred in the unit 22 (the monitoring unit on the vehicle side and the transmitting unit 1 of the inter-vehicle communication device 5 is normal) (step 2 1 1), and after confirming that (step 2 1 2) Then, failure occurrence data indicating that the “reception unit failure of the monitoring station 20” is transmitted to all vehicles (step 2 13). In each vehicle that has received this failure occurrence data, the monitoring station 20 cannot know the current positions of all the vehicles as it is, and therefore, sufficient information to avoid collisions between the vehicles can be obtained. If it is determined that there is no vehicle, stop the vehicle to secure safety (Step 214).
- FIG. 6 is a flowchart showing the procedure of failure determination and abnormality processing when data is no longer transmitted between vehicles.
- the monitoring station 20 transmits data indicating the mutual positional relationship of all the vehicles to each vehicle 10... From the transmission unit 21 of the monitoring station ing.
- each vehicle 10 Determines that another vehicle exists within a communicable distance with the inter-vehicle communication device 6 based on the positional relationship data (step 301). , 302).
- the vehicle 10 communicates with the other vehicle 11.
- the position data is transmitted and received via the inter-communication device 6, and the vehicle 10 confirms the reception state (steps 303, 304).
- the own vehicle 10 cannot receive position data from another vehicle 11 (determination NO in step 304)
- abnormal processing such as stopping own vehicle 10 is executed (step 310). If the vehicle 10 can receive the position data from the other vehicle 11: (determination YES in step 304), the vehicle-to-vehicle communication device 6 of the vehicle 10 is normal. Confirm that it is (Step 3 05).
- FIG. 7 is a flowchart showing a procedure of failure determination and abnormality processing when data is no longer transmitted between vehicles.
- Step 4 0 For each of the plurality of vehicles, for example, the vehicle 10, is the position data transmitted from the other vehicles 11, 12,... Every time a predetermined time elapses via the inter-vehicle communication device 6? Has been determined. This predetermined time is set to the maximum time at which position data will be sent from another vehicle if another vehicle exists in an area communicable by the inter-vehicle communication device 6. (Step 4 0 1).
- the monitoring station 20 communicates with the monitoring station 20 via the monitoring station / vehicle communication device 5. Then, information that this is not received and an inquiry about whether or not there is another vehicle communicable through the inter-vehicle communication device 6 around the own vehicle 10 are inquired. Send it (step 4 04).
- the monitoring station 20 determines whether or not another vehicle exists within a communicable distance of the vehicle 10 that transmitted this information via the inter-vehicle communication device 6, and as a result, there is another vehicle. Is determined, it is determined that the receiving unit 4 of the inter-vehicle communication device 6 of the vehicle 10 that has transmitted the information has failed (step 406).
- the monitoring station 20 sends command data for stopping the vehicle 10 in which the failure has occurred for safety (step 4107), and the vehicle 10 receiving the command stops the vehicle. Then, the fact is notified to the monitoring station 20 (step 408).
- the monitoring station 20 determines that there is no other vehicle within a communicable distance of the vehicle 10 via the inter-vehicle communication device 6.
- the vehicle-to-vehicle communication device 6 of the vehicle 10 determines that the vehicle is normal (step 405).
- step 401 the other vehicles 11 When receiving the position data from 1 2..., The position of the own vehicle 10 is transmitted to another vehicle, for example, the vehicle 11, which has transmitted the position data, via the inter-vehicle communication device 6. Request to send data (step 402).
- step 4 03 when the position data of the own vehicle 10 is transmitted from another vehicle 11 via the inter-vehicle communication device 6, the function of the inter-vehicle communication device 6 is determined to be normal and confirmed. Yes (step 4 03).
- step 402 if the position data of the own vehicle 10 is not transmitted from the other vehicle 11 via the inter-vehicle communication device 6, the inter-vehicle communication device 6 It is determined that a failure has occurred in the transmitting unit 3 (step 409), the vehicle 10 is stopped for safety (step 410), and the monitoring station 20 is notified of the stop. (Step 4 1 1).
- position data and the like are transmitted from each vehicle to the monitoring station 20 at regular intervals, so that the monitoring station can grasp the approximate positional relationship among a plurality of vehicles.
- this may be omitted, and the function of the monitoring station 20 may be simply instructed to each vehicle by a destination (running instruction), and the mutual relationship between the vehicles may be left to the communication between the vehicles. It is possible.
- the present invention can be applied not only to vehicles traveling outdoors but also to vehicles traveling indoors.
- it can be applied to an unmanned transport system in a factory.
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Remote Sensing (AREA)
- Radar, Positioning & Navigation (AREA)
- General Physics & Mathematics (AREA)
- General Engineering & Computer Science (AREA)
- Structural Engineering (AREA)
- Civil Engineering (AREA)
- Mining & Mineral Resources (AREA)
- Aviation & Aerospace Engineering (AREA)
- Automation & Control Theory (AREA)
- Traffic Control Systems (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
Description
明細書 車両の監視装置 技術分野
本発明は、 自己の車両位置を計測する車両位置計測手段を具えた複数の車両と、 これら複数の車両に対して走行を指示する指示データを送信する監視局とからな る車両の監視装置に関する。
背景技術
砕石現場、 鉱山などの広域の作業現場で土砂運搬等の作業を行う複数の無人ダ ンプトラック等の無人車両を運行管理するには、 地上局として監視局を設営して、 この監視局により、 これら無人車両を統括して管理、 監視するように、 車両監視 システムが構成されている。
従来より、 この車両監視システムでは、 監視局と複数の車両との間の長距離の 無線通信を行う送受信装置 (たとえば V H F方式) を設けて、 各車両で計測した 自己の車両の位置データ等の各種データを、 きわめて短い周期 (例えば、 1秒ご と) で、 監視局に送信するようにしており、 これにより監視局において各車両の 正確な位置を把握しつつ各車両を監視する試みがなされている。
また、 車両から送信された位置データ等を受信した監視局は、 受信した旨のデ ータを当該車両に送ることで、 各車両は自車 ίこ搭載された送受信装置の故障の確 認を行うようにしていた。
しかし、 近年、 現場によっては、 車両が走行する距離がきわめて長く (約 1 0 k m程度) 、 多数の走行コースが存在し、 さらに多数の (5 0〜1 0 0台) の車 両を監視する必要があり、 これに伴い、 扱う情報量は飛躍的に増加してきている。 これに対処するには、 広範囲 (長距離) で、 しかも高速に無線通信ができる方 式の送受信装置を設ける必要がある。
ここに、 こうした車両の監視に適合する、 現状の技術で考えられる実用的な通
信方式は、 大きくは、 つぎの 2種類である。
1) VHF、 UHF
2) S S (スペク トラム拡散方式) 無線
しかし、 上記 1) の VHF、 UHF方式を、 前述した車両監視システムに適用 すると、 この通信方式は長距離 (10 kn!〜 20 km) の通信が可能で、 広域作 業現場全域の通信をカバ一することができるものの、 通信速度が遅いため (96 00 b p s) 、 多数の車両の現在位置を、 常時把握することができないという問 題が招来する。 すなわち、 多数の車両から多量のデータが監視局に通信されるこ とになり、 通信情報量が大となる。 そして、 これを通信速度の遅い通信方式で対 処するため通信回線が混雑し、 通信回線への負荷が多くなつてしまい、 事実上、 車両の管理、 監視は不可能となってしまう。
また、 上記 2) の S S無線を、 車両監視システムに適用すると、 確かに高速の 通信が可能であるため (256 Kb p s) 、 きわめて大きい情報量を高速に通信 することができるものの、 電波の到達距離が短いため (100m〜l km) 、 近 年、 より広域となりつつある広域作業現場全域の通信をカバ一することは不可能 である。
また、 S S無線で広域作業現場全域の通信をカバーするには、 電波到達距離の 不足を補うために、 作業現場の各所に無線通信局などの補助的な設備を新たに設 営しなければならない。 これは、 初期投資、 メンテナンスなどのコストがかさむ ことになり、 実用化は事実上困難となる。
そこで、 従来は、 上記 1) の通信方式を採用しつつも、 監視局が行うべき車両 の管制を補うために、 各車両に障害物センサを取付け、 このセンサにより他の車 両の存在を確認して衝突を回避するという方法が採られていた。 しカゝし、 こうし たセンサのみに頼って衝突を回避するシステムは、 安全上問題があり、 本来望ま しくない。 多数の車両が交差点を通過したり、 すれ違いをする場合に、 完全に衝 突を回避できるとはいえないからである。
'また、 上記 1) 、 2) のいずれの通信方式を採用したとしても、 監視局がすべ ての車両を管制する方法をとつているので、 監視局にかかる負荷が大きくなり過
ぎるという問題は、 依然として残ることになる。
さらに、 前述したように、 監視局が、 多数の車両からの送信に対して、 受信し た旨のデータを多数の車両に送り返すことにより、 各車両が自車に搭載された送 受信装置の故障の確認を行う方法をとつていたが、 この方法を上記 1 ) の通信方 式により実施した場合には、 その通信速度の遅さに起因して、 監視局から常に多 数の車両の受信した旨のデータを送り返すことはできず、 自車が故障であること の確認を迅速かつ確実にできないことになつていた。
このように従来は大量のデータのやりとりが必要であるにもかかわらず、 シス テムの通信系の問題により、 監視局に管理できる車両の台数には限界があった。 本発明は、 こうした実状に鑑みてなされたものであり、 広域作業現場全域の通 信を補助設備の配設に伴うコスト増大を招くことなく行え、 しかも車両相互の管 制を監視局にかかる負担が少なく、 安全性を損なうことなく十分に行え、 さらに 送受信装置に故障が生じた場合の確認を迅速かつ確実に行え、 それによつて迅速 かつ適切な異常処理を行えるようにすることを解決課題とするものである。 発明の開示
そこで、 本発明の第 1発明では、 自己の車両位置を計測する車両位置計測手段 を具えた複数の車両と、 これら複数の車両に対して走行を指示する指示データを 送信する監視局とを具えた車両の監視装置において、
前記監視局と前記複数の車両との距離を無線通信可能の第 1の通信方式によつ て、 これら監視局、 複数の車両間で少なくとも前記指示データを、 送受信する第
1の送受信手段を、 前記監視局および前記複数の車両それぞれに設けるとともに、 前記複数の車両相互間の距離を無線通信可能であって、 前記第 1の通信方式よ りも高速にデータを送受信可能の第 2の通信方式によって、 これら複数の車両相 互間で、 前記車両位置計測手段で計測された位置データを送受信する第 2の送受 信手段を、 前記複数の車両それぞれに設け、
'前記複数の車両それぞれに設けられた前記第 2の送受信手段により、· 複数の車 両相互間で前記位置データを送信させることにより、 複数の車両それぞれにおい
て、 他の車両が接近したことを判断することにより、 前記複数の車両相互の位置 関係を監視するようにしている。
このため、 第 1の送受信手段 (たとえば V H F、 UH F方式) によって監視局、 複数の車両間の長距離の通信が、 補助設備の配設に伴うコスト增大を招くことな く行われる。 しかも、 第 1の送受信手段を介して監視局は少なくとも指示データ を送信するだけであり、 複数の車両相互間で第 2の送受信手段 (たとえば S S無 線) を介して位置データが送受信され複数の車両相互の位置関係が監視されるの で、 監視局と複数の車両間の通信の頻度を減少でき、 監視局の負荷、 通信回線の 負荷が減少する一方、 高速な車両間での通信により衝突回避の制御が車両同士で 行われ、 安全を確保することができる。
さらに、 2種類の送受信手段により車両にデータを送信することができるので、 一方の送受信手段に故障等の異常が発生したとしても、 他方の送受信手段を介し てその旨の情報を迅速かつ確実に車両に知らしめて車両停止等、 所定の異常処理 を迅速かつ適切行わせることができる。
また、 本発明の第 2発明では、 自己の車両位置を計測する車両位置計測手段を 具えた複数の車両と、 これら複数の車両それぞれから送信される位置データを受 信し、 この受信された位置データに基づき、 前記複数の車両の相互位置関係を監 視しつつこれら複数の車両に対して走行を指示する指示データを送信する監視局 とを具えた車両の監視装置において、
前記監視局と前記複数の車両との距離を無線通信可能の第 1の通信方式によつ て、 これら監視局、 複数の車両間で前記位置デ'ータおよび前記指示データを、 送 受信する第 1の送受信手段を、 前記監視局および前記複数の車両それぞれに設け るとともに、
前記複数の車両相互間の距離を無線通信可能であって、 前記第 1の通信方式よ りも高速にデータを送受信可能の第 2の通信方式によって、 これら複数の車両相 互間で前記位置データを送受信する第 2の送受信手段を、 前記複数の車両それぞ れに設け、
前記複数の車両それぞれに設けられた前記第 1の送受信手段により、 所定の時
間が経過する毎に前記位置データを前記監視局に送信させることにより、 前記監 視局において、 前記複数の車両の位置を監視し、
前記複数の車両それぞれに設けられた前記第 2の送受信手段により、 複数の車 両相互間で前記位置データを送信させることにより、 複数の車両それぞれにおい て、 他の車両が接近したことを判断することにより、 前記複数の車両相互の位置 関係を監視するようにしている。
この第 2の発明では、 第 1の発明の作用、 効果に加えて更に以下のような作用、 効果を奏する。
すなわち、 複数の車両それぞれに設けられた第 1の送受信手段により、 所定の 時間が経過する毎に位置データが監視局に送信されることにより、 監視局におい て、 複数の車両の位置が監視できるので、 監視局は、 少ない負荷で、 車両相互の 概ねの位置関係を把握することができ、 各車両に対して適切な指令を確実に送信 することができる。
しかも、 複数の車両それぞれに設けられた第 2の送受信手段により、 複数の車 両相互間で位置データが送信されることにより、 複数の車両それぞれにおいて、 他の車両が接近したことが判断されるので、 各車両は、 車両相互の位置関係を迅 速かつ正確に把握することができ、 交差点走行時、 すれ違い時などに迅速かつ正 確に車両同士の衝突回避等の制御を行うことができる。 図面の簡単な説明
図 1は本発明に係る車両の監視装置の実施^態である無人ダンプトラック監視 システム全体の外観を示す図である。
図 2は実施形態の通信系の構成を示すプロック図である。
図 3は実施形態の無人ダンプトラックが走行すべき予定走行路が各点に分割さ れた様子を示す図である。
図 4は本実施形態の故障判定および異常処理の手順を示すフロ一チヤ一トであ る。
図 5は本実施形態の故障判定および異常処理の手順を示すフローチヤ一トであ
る。
図 6は本実施形態の故障判定および異常処理の手順を示すフローチヤ一卜で一あ る。
図 7は本実施形態の故障判定および異常処理の手順を示すフローチャートであ る。
図 8は推測航法を説明するために用いた図である。 発明を実施するための最良の形態
以下、 図面を参照して本発明に係る車両の監視装置の実施の形態について説明 する。
図 1は、 本実施形態で想定している鉱山などの広域作業現場 3 0において、 多 数の無人ダンプトラック 1 0、 1 1、 1 2、 1 3…を管理、 監視する無人ダンプ トラック監視システムの外観を示している。
また、 図 2は、 この無人ダンプトラック監視システムの無線通信系のみを取り 出して示すブロック図である。
図 1に示すように、 この無人ダンプトラック監視システムは、 大きくは、 自己の車両位置 (χ、 γ) を計測する後述する車両位置計測装置を具えた複数の 無人ダンプトラック (以下、 車両という) 1 0、 1 1、 1 2、 1 3…と、 これら 複数の車両 1 0…それぞれから送信される位置データ (X、 Y) を受信し、 この 受信された位置データに基づき、 複数の車両 1 0…の相互の位置関係を監視しつ つこれら複数の車両 1 0 ···に対して走行、 停止等を指示する指示データを送信す る監視局 2 0とから構成されている。
なお、 本実施形態では、 車両として無人ダンプトラックを想定しているが、 有 人車両であってもよく、 またダンプトラック以外のホイールローダ、 油圧ショべ ル等にも適用可能であり、 これら無人車両、 有人車両が混在しているシステム、 ダンプトラック、 ホイールローダ、 油圧ショベル等が混在しているシステムにも 適用可能である。
図 2に示すように、 監視局 2 0と複数の車両 1 0…との間は、 監視局 ·車両間
通信装置 2 3、 5によって無線通信される。
すなわち、 これら監視局 2 0と複数の車両 1 0 · · ·との距離、 つまり広域作業 ¾ 場 3 0全域を無線通信可能の通信方式、 例えば V H F方式による監視局 ·車両間 通信装置 2 3、 5が監視局 2 0側、 車両 1 0…側にそれぞれ配設され、 これら監 視局 2 0、 複数の車両 1 0…間で上記位置データおよび指示データが、 送受信さ れる。
監視局 2 0側の監視局 ·車両間通信装置 2 3は、 送信部 2 1、 受信部 2 2から なり、 また、 車両 1 0側の監視局 ·車両間通信装置 5は、 送信部 1、 受信部 2か らなり、 図 1に示すように、 監視局 2 0のアンテナ 2 0 a、 車両 1 0のアンテナ 1 0 aを介して無線通信 Aが行われる。 他の車両についても同様にして、 監視局 2 0のアンテナ 2 0 a、 車両 1 1のアンテナ 1 1 aを介して無線通信 Bが、 監視 局 2 0のアンテナ 2 0 a、 車両 1 2のアンテナ 1 2 aを介して無線通信 Cが、 監 視局 2 0のアンテナ 2 0 a、 車両 1 3のアンテナ 1 3 aを介して無線通信 Dがそ れぞれ行われる。
一方、 複数の車両相互間においても、 車両相互間通信装置 6によって無線通信 される。
すなわち、 これら複数の車両相互間の距離を無線通信可能であって、 上記監視 局 ·車両間通信装置 2 3、 5よりも高速にデ一タを送受信可能の通信方式、 例え ば S S無線による車両相互間通信装置 6が各車両 1 0、 1 1、 1 2、 1 3…にそ れぞれ配設され、 これら複数の車両相互間で上記位置データが送受信される。 車両 1 0…の車両相互間通信装置 6は、 送言部 3、 受信部 4からなり、 図 1に 示すように、 車両 1 0のアンテナ 1 0 b、 車両 1 1のアンテナ 1 1 bを介して無 線通信 E力 車両 1 1のアンテナ 1 1 b、 車両.1 2のアンテナ 1 2 bを介して無 線通信 Fが、 車両 1 0のアンテナ 1 0 b、 車両 1 2のアンテナ 1 2 bを介して無 線通信 Gが、 車両 1 0のアンテナ 1 0 b、 車両 1 3のアンテナ 1 3 bを介して無 線通信 Hが、 車両 1 2のアンテナ 1 2 b、 車両 1 3のアンテナ 1 3 bを介して無 線通信 Iがそれぞれ行われる。 なお、 電波到達距離よりも長くなる長距離の車両 間 (例えば車両 1 1、 1 3間) では、 無線通信が不可能となることがある。
さて各車両 1 0…のタイヤには、 車両走行距離検出部であるタイヤ回転センサ 3 0 (例えばダイヤルパルスエンコーダ) が付設されており、 タイヤの回転数 を検出する。 また、 車体には、 車両方位検出部であるジャイロ 3 1 (例えば光フ アイバジャイロ) が配設されており、 車体姿勢角の角速度 ωを検出する。
上記タイヤ回転センサ 3 0およびジャィ口 3 1の各出力に基づいて後述するよ う車両位置 (Χ、 Υ ) ( 2次元座標系 Χ— Υ上の位置) が検出されることになる 力 この車両位置はタイヤのスリップ等による累積誤差を含んでいるので、 例え ば、 車両の予定走行路に沿って間欠的に配設した反射ポールと車両との相対位置 関係から、 上記累積誤差を間欠的に補正してもよレ、。
なお、 G P S (グローバル ·ポジショニング ·システム) により車両位置を計 測するようにしてもよい。
各車両 1 0…には、 C P U、 メモリを中心に構成されている演算処理装置 3 2 が搭載されており、 後述するよう推測航法に基づく処理を行い、 制御信号を車両 駆動用の各電磁比例弁等に出力する。
以下、 この演算処理装置 3 2で実行される演算処理内容について説明する。 演算処理装置 3 2に、 車両走行距離検出部であるタイヤ回転センサ 3 0の検出 信号および車両方位検出部であるジャイロ 3 1の検出信号が入力されると、 以下 のような処理が順次実行される。
•車両走行距離 Sの演算
タイヤ回転センサ 3 0の検出信号に基づきタイヤ回転数 Nを求める。
つぎに、 このタイヤ回転数 Nと既知のタイヤ負荷半径 rとの積より車両走行距 離 Sを算出する。
•車両方位 Θの演算
ジャイロ 3 1の検出信号に基づき車体の姿勢角の角速度 ωを積算することによ り、 車両方位変化 Δ Θを算出し、 既知の初期方位に対して方位変化 Δ Θを加えて、 初期車両方位に対する現在の車両方位 Θを算出する。
'車両位置 (Χ、 Υ ) の演算
上記車両走行距離 Sと車両方位 Θの正弦 s i n、 余弦 c o sとの積 S · s i n
Θ S · c o s Θを積算することにより X— Y座標系上における車両座標位置 ( X、 Y) を求める。
すなわち、 図 8に示すように、 逐次の車両位置 PI (Xl、 YD = (SI · c o s 01、 SI · s i n Θ 1) 、 P2 (X2、 Y2) = (X 1 + S 2 · c o s 02、 Yl+S 2 · s i n Θ 2) , …が算出され、 各車両、 例えば車両 10の演算上の軌跡 41力 S 求められる。
演算処理装置 32は、 こうして演算された車両 10の軌跡 41と、 目標経路で ある予定走行路 40とを比較して、 車両 10が予定走行路 40上を迪るようにい わゆる推測航法により車両 10を制御する。 すなわち、 演算処理装置 32は、 予 定走行路 40上の逐次の目標車両位置 P , 1、 Ρ '2、 Ρ '3···、 目標車両方位 0 ,
1、 Θ '2, 0 '3···が得られるように、 ステアリング油圧電磁比例弁に対して所要 の電気信号を出力し、 ステアリングの操舵角を制御する。 また、 演算処理装置 3 2は、 予定走行路 40上の逐次の目標車両位置、 目標車両方位が得られるように、 電子制御ガバナ、 トランスミツション電磁弁、 ブレーキ圧電磁比例弁に対して所 要の電気信号を出力し、 エンジンの回転数、 トランスミッションの速度段、 ブレ —キ圧を制御する。 こうして車両 10は、 予定走行路 40上に沿って誘導走行さ れる。
ここで、 本実施形態では、 複数の車両 1 0…毎に走行すべき経路が基本的に異 なることから、 予定走行路 40としては多数の走行路 40-1、 40-2、 40-3··· を想定している。 そして、 これら走行路 40-1、 40-2、 40-3…は、 互いに交 差する点を有していたり、 同一の走行路上を 両同士がすれ違う場合もある。 そこで、 まず、 実際の作業に先立ち、 こうした予定走行路 40のティ一チング が行われる。
•予定走行路 40のティーチング走行
オペレータは、 1台の車両、 例えば車両 1 0を運転して全予定走行路 40-1、 40-2、 40-3…を実際に走行し、 これにより予定走行路上の各地点 Ρ ' 1、 Ρ '
2、 ' Ρ '3…の位置データ (Χ、 Υ) 、 方位データ Θ '、 各地点の通過速度等のデ ータが取得され (以下、 走行路データという) 、 この走行路データが、 上記監視
局 ·車両間通信装置 5によって監視局 20に送信される。
この走行路データを受信した監視局 20は、 監視局 ·車両間通信装置 23に つて、 各車両 10、 1 1、 12、 13…毎に必要な予定走行路についての走行路 データを、 これら各車両に送信する。 例えば、 車両 10の予定走行路が走行路 4 0 - 1であれば、 この走行路 40-1に関する走行路データが、 当該車両 10に対し て送信される。 なお、 各車両に、 全ての走行路デ一タを送信してもよい。
さらに、 上記ティーチング中に、 推測航法のための目標点とは別に、 予定走行 路 40を、 各地点に分割した各分割点 Ql、 Q2、 Q3…の分割位置データ (X、 Y) が取得される (図 3参照) 。
これら各分割点 Ql、 Q2、 03···は、 各車両がその分割点を通過する毎に監視局 20に監視局 ·車両間通信装置 5を介して、 自己の車両の現在位置データ P (X、 Y) を監視局 20に対して送信すべき点である。 よって、 これら分割点 Ql、 Q2、 Q3…を定める基準としては、 以下のことが考慮される。
1) 車両の台数、 監視局 .車両間通信装置 23、 5の通信方式 (例えば VHF) の通信速度を考慮して、 通信回線に負荷がかからず監視局 20が各車両の位置を 常時把握できる程度の間隔 (時間) に設定される。
さらには、 以下の点を考慮することができる。
2) 車両の重量、 速度等を考慮して、 隣り合う分割点間 (Qi〜Qi+l) の距離が、 車両の停止距離よりも小さくならない程度に設定する。
3) 車両に障害物センサを設けた場合に、 隣り合う分割点間 (Qi〜Qi+l) の距 離が、 この障害物センサの有効検出距離よりも小さくならない程度に設定する。 こうして取得された分割点データは、 上記走行路データとともに、 監視局 ·車 両間通信装置 5によって監視局 20に送信される。
この分割点データを受信した監視局 20は、 監視局 ·車両間通信装置 23によ つて、 各車両 10、 1 1、 12、 13…毎に必要な予定走行路についての分割点 データを、 これら各車両に送信する。 例えば、 車両 10の予定走行路が走行路 4 0 1であれば、 この走行路 40-1に関する分割点データが、 当該車両 10に対し て送信される。 なお、 各車両に、 全ての走行路の分割点データを送信してもよい。
こうしてティ一チングは終了し、 教示データ (走行路データ、 分割点データ) は各車両の所定のメモリに記憶される。
なお、 上記実施形態では、 各車両が自己の車両の現在位置データ P (X、 Y) を監視局 2 0に送信すべき点として分割点を定めるようにしているが、 この分割 点間距離に相当する送信時間の間隔を予め設定してもよい。 この送信時間の間隔 を定める際にも、 上記 1 ) 、 2 ) 、 3 ) の点 (少なくとも 1 ) の点) が考慮され る。
•各車両の走行開始 (プレイバック運転)
上述したティ一チングが終了すると、 監視局 2 0は、 監視局 ·車両間通信装置 2 3の送信部 2 1より、 各車両 1 0…に、 最終目標地点 (行き先) を示す指示デ ータを送信する。 また、 G P Sにより位置計測を行う場合であれば、 監視局 2 0 は、 G P Sのディファレンシャルデ一タを各車両に送信する。
これらデータを各車両の監視局 ·車両間通信装置 5の受信部 2で受信すると、 演算処理装置 3 2では、 メモリに記憶された教示走行路データに基づき、 前述し た推測航法により予定走行路 4 0に沿って自己の車両を誘導走行させ、 積荷の積 込み、 運搬、 排出といった一連の作業を行わせる。
•監視局による管制、 監視
この間、 各車両 1 0…は、 現在の位置計測データ (X、 Y) と、 メモリに記憶 された教示分割点データとを常時比較して、 各分割点 Q l、 Q2、 Q3に到達したか 否かを常時判断している。 そこで、 車両が分割点に到達すると、 その時点で監視 局 ·車両間通信装置 5の送信部 1から、 現在の位置データ (X、 Y) が監視局 2 0に送信される。
各車両 1 0…から送信された位置データを監視局 2 0の監視局 ·車両間通信装 置 2 3の受信部 2 2で受信すると、 監視局 2 0の演算処理装置 2 4では、 複数の 車両 1 0…それぞれが少なくとも分割点間 Q i〜Q i+l (以下、 セグメントという) 距離まで接近したことが判断される。
このようにして監視局 2 0では、 通信回線に負荷がかかることなく、.複数の車 両相互の位置関係を、 概ねではあるが常時把握することができ、 これにより、 交
差点で車両同士が衝突しそうになつたり、 追突しそうになつた場合に、 適切な走 行、 停止の指示データを、 監視局 ·車両間通信装置 2 3の送信部 2 1から当該享 両に送信することができる。
例えば、 図 3に示すような状況では、 車両 1 0が分割点 Q 2〜Q 3間のセグメン トを走行し、 車両 1 1が分割点 Q 103〜Q 5間のセグメントを走行しており、 両車 両間の距離差は十分あるので、 交差点で衝突する虞はなく、 そのまま走行しても よいが、 これが仮に、 車両 1 0が分割点 Q 3〜Q4間のセグメントを走行している 状況下では、 両車両間の距離差は十分とはいえなく、 交差点で衝突する虞がある ので、 車両 1 0に対して減速ないしは停止の指示データが送信されることになる。 なお、 上述した実施形態では、 各車両 1 0…から、 現在の位置データを監視局 2 0に送信しているが、 これ以外にも方位データ Θ、 速度データ、 位置計測の信 頼度 (誤差) を示すデータ、 予定走行路 4 0からの車両のずれ量を示すデータな どを監視局 2 0に送信して、 更に監視局 2 0で行われる管制、 監視の精度を高め るようにしてもよレ、。
•車両同士による管制、 監視
さて、 各車両 1 0…が走行中 (作業中) 、 個々の車両それぞれに設けられた車 両相互間通信装置 6により、 これら車両相互間で位置データが送受信される。 ただし、 すべての車両同士が一斉に送受信し合うと回線の混雑が予測される場 合には、 つぎのようにして優先度を定めることができる。
1 ) 各車両は、 車両相互間通信装置 6を介して自己の位置データを常時他の車両 に送信し、 これにより各車両は自己の車両に'最も近接している車両の存在を確認 する。 以後、 これら最も近接している車両同士が優先的に車両相互間通信装置 6 を介して頻繁に位置データを送受信し合う。
2 ) 監視局 2 0は、 各車両から送信された位置データに基づき、 最も近接してい る車両同士の存在を確認する。 そして、 監視局 ·車両間通信装置 2 3、 5を介し て、 この旨の情報をこれら最も近接している車両同士に送信する。 以後、 この情 報が送信された最も近接している車両同士が優先的に車両相互間通信装置 6を介 して頻繁に位置デ一タを送受信し合う。
こうして優先的に車両相互間通信が許可された車両同士では、 受信された相手 方の車両の位置データに基づき、 車両相互間の干渉を防止する制御が行われる^ すなわち、 交差点で車両同士が衝突しそうになつたり、 追突しそうになつた場 合に、 どちらの車両が減速してどちらが先に進むべきか、 優先度を決定すること ができる。
さらに、 監視局 2 0においては、 上述したように、 複数の車両 1 0…それぞれ が少なくとも分割点間 Q i〜Q i+l (以下、 セグメントという) 距離まで接近した ことしか判断することができないが (異なる車両が同一セグメント内を走行して いることまでは判断することができる) 、 この車両相互間通信によれば、 複数の 車両それぞれにおいて、 他の車両が上記セグメント距離よりも小さい距離まで接 近したことを正確に判断することができる。
このため、 監視局 2 0で指示することができない非常に車両が近接した場合の 制御、 例えば、 すれ違い時の干渉防止の制御をなし得る。 例えば、 図 3において、 車両 1 0、 1 1が同一のセグメント Q2〜Q3を対向して走行している場合には、 このセグメント Q2〜Q3内の正確な位置を両車両 1 0、 1 1が把握しているので、 すれ違い時に最小限の減速をもって精度よく相手車両を回避することが可能とな る。
なお、 上述した実施形態では、 各車両 1 0 ·· ·同士の車両相互間通信により、 現 在の位置データを互いに送受信しているが、 これ以外にも方位データ e、 速度デ
—タ、 位置計測の信頼度 (誤差) を示すデータ、 予定走行路 4 0からの車両のず れ量を示すデータ、 車両重量を示すデータ、 ¾差点までの距離を示すデータを送 受信して、 交差点進入の際の優先度の精度、 衝突回避の精度を高めるようにして もよい。 同様に、 位置データ以外に方位データ .0、 速度データ、 位置計測の信頼 度 (誤差) を示すデータ、 予定走行路 4 0からの車両のずれ量を示すデータ、 車 両重量を示すデータ、 障害物検出センサの有効検出距離を示すデータを送受信し て、 すれ違う際に減速する速度の精度、 衝突回避の精度を高めるようにしてもよ レ、。
•通信装置の故障時の対応
さて、 本実施形態では、 2系統の通信装置により車両にデータを送信すること ができるので、 一方の通信装置に故障等の異常が発生したとしても、 他方の通信 装置を介してその旨の情報を迅速かつ確実に車両に知らしめて車両停止等、 所定 の異常処理を迅速かつ適切行わせることができる。
図 4は、 監視局 2 0から車両に対してデータが送信されなくなった場合の、 故 障判定ぉよび異常処理の手順を示すフローチャートである。
すなわち、 監視局 2 0は、 一定の周期で各車両 1 0…に対して所定のデータ、 例えば全車両の相互の位置関係を示すデータを監視局 ·車両間通信装置 2 3の送 信部 2 1から送信している。 一方、 各車両 1 0…は、 上記一定の周期が経過する 毎に上記所定のデータが自己の監視局 ·車両間通信装置 5の受信部 2で受信され たか否かを判断している。 そして、 この結果、 監視局 2 0から送信されるべき上 記所定のデータが受信されなかったことが、 例えば車両 1 0において判断された 場合には (ステップ 1 0 1 ) 、 監視局 2 0側の監視局 ·車両間通信装置 2 3の送 信部 2 1、 車両 1 0側の監視局 ·車両間通信装置 5の受信部 2のいずれかに故障 が発生したと判断し、 このままでは車両相互の衝突を回避するための情報が十分 に得られないと判断して、 安全を確保すべく、 自己の車両 1 0を停止させるよう にする (ステップ 1 0 2 ) 。
さらに、 この停止した車両 1 0は、 周囲の他の車両 1 1、 1 2…との間で、 故 障を生じていない車両相互間通信装置 6による送受信を実行して、 他の車両の監 視局 2 0との間における受信状態の確認をとる (ステップ 1 0 3 ) 。
そして、 他の車両 1 1、 1 2…は、 上記一定の周期が経過する毎に上記所定の データが自己の監視局 ·車両間通信装置 5の受信部 2で受信されたか否かを判断 し (ステップ 1 0 4 ) 、 この結果、 他の車両においても監視局 2 0から送信され るべき上記所定のデータが受信されなかったことが判断された場合には、 監視局 2 0側の監視局 ·車両間通信装置 2 3の送信部 2 1に故障が発生 (車両 1 0側の 監視局 ·車両間通信装置 5の受信部 2は正常) したと判断し (ステップ 1 0 5 ) 、 「監視局の送信部故障」 である旨の故障発生データを監視局 2 0に送信する。 な お、 この故障発生データあるいは送信部が正常である旨の正常確認データは、 定
期的に (例えば上記位置データとともに) 車両から監視局 2 0に対して送信され るものとする (ステップ 1 0 6 ) 。 "; 一方、 ステップ 1 0 4で、 他の車両において監視局 2 0から送信されるべき上 記所定のデータが受信されたことが判断された場合には、 自己の車両 1 0側の監 視局 .車両間通信装置 5の受信部 2に故障が発生 (監視局 2 0側の監視局 ·車両 間通信装置 2 3の送信部 2 1は正常) したと判断し (ステップ 1 1 0 ) 、 「車両 1 0の受信部故障」 である旨の故障発生データを監視局 2 0に送信する (ステツ プ 1 1 1 ) 。
図 5は、 車両から監視局 2 0に対してデータが送信されなくなった場合の、 故 障判定ぉよび異常処理の手順を示すフローチャートである。
すなわち、 監視局 2 0では、 前述したように分割点 Qを車両が経過する一定時 間毎に、 位置データ Pが受信されているか否かを逐次判断している。
そして、 この判断の結果、 車両からの位置データ Pの定期的な送信が途絶えた 場合には (ステップ 2 0 1 ) 、 その送信の途絶えがすべての車両 1 0…について のものか否かが判断される (ステップ 2 0 2 ) 。
この結果、 特定の車両、 たとえば車両 1 0から送信されるべき位置データが受 信されず、 かつ他の車両 1 1、 1 2…から送信される位置データが受信されたこ とが判断された場合には、 この特定の車両 1 0側の監視局 ·車両間通信装置 5の 送信部 1に故障が発生したものと判断し、 その旨の確認をする (ステップ 2 0 3、 2 0 4 ) 。 そして、 監視局 2 0から車両 1 0の周囲の車両、 例えば車両 1 1に対 して 「車両 1 0の送信部は故障した、 車両 1 0は停止せよ」 との指示データを送 信する (ステップ 2 0 5 ) 。 これを受信した周囲の車两 1 1は、 車両相互間通信 装置 6を介して、 故障が発生した車両 1 0に上記指示データを送信する (ステツ プ 2 0 6 ) 。 そして、 車両 1 0では、 この指示データを、 故障の発生していない 自己の車両相互間通信装置 6の受信部 4で受信し、 「このままでは監視局 2 0に おいて自己の車両 1 0の現在位置を把握することができず、 このため車両相互の 衝突を回避するための情報が十分に得られない」 と判断して、 安全を確保すべく、 自己の車両 1 0を停止させるようにする (ステップ 2 0 7 ) 。
また、 ステップ 2 0 3、 2 0 4で、 特定の車両 1 0側の監視局 ·車両間通信装 置 5の送信部 1に故障が発生したものと判断し、 その旨の確認をした後、 監視 2 0は、 「車両 1 0の送信部故障」 である旨の故障発生データを車両 1 0に送信 する。 なお、 この故障発生データあるいは送信部が正常である旨の正常確認デー タは、 定期的に監視局 2 0から車両に対して送信されるものとする (ステップ 2 0 8 ) 。 そして、 自己の車両 1 0は停止される (ステップ 2 0 7 ) 。
—方、 ステップ 2 0 2で、 すべての車両 1 0…について、 位置データを受信し ていないことが判断された場合には、 監視局 2 0側の監視局 ·車両間通信装置 2 3の受信部 2 2に故障が発生 (車両側の監視局 ·車両間通信装置 5の送信部 1は 正常) したと判断し (ステップ 2 1 1 ) 、 その旨の確認をした後 (ステップ 2 1 2 ) 、 「監視局 2 0の受信部故障」 である旨の故障発生データを全車両に対して 送信する (ステップ 2 1 3 ) 。 この故障発生データを受信した各車両では、 この ままでは監視局 2 0において全車両の現在位置を把握することができず、 このた め車両相互の衝突を回避するための情報が十分に得られないと判断して、 安全を 確保すべく、 自己の車両を停止させるようにする (ステップ 2 1 4 ) 。
図 6は、 車両相互間でデータが送信されなくなった場合の、 故障判定および異 常処理の手順を示すフローチヤ一トである。
すなわち、 監視局 2 0は、 一定の周期で各車両 1 0 ···に対して全車両の相互の 位置関係を示すデータを監視局 ·車両間通信装置 2 3の送信部 2 1から送信して いる。 一方、 各車両 1 0…は、 上記位置関係データに基づき、 車両相互間通信装 置 6で通信可能な距離内に他の車両が存在しャいることを判断している (ステツ プ 3 0 1、 3 0 2 ) 。
この結果、 例えば車両 1 0において、 その通信エリア内に他の車両 1 1が存在 していることが判断された場合には、 車両 1 0は、 この他の車両 1 1との間で車 両間通信装置 6を介して位置データを送受信を行い、 車両 1 0において、 その受 信状態の確認をとる (ステップ 3 0 3、 3 0 4 ) 。 この結果、 自己の車両 1 0で 他の車両 1 1からの位置データを受信できない場合には (ステップ 3 0 4の判断 N O) 、 自己の車両 1 0の車両相互間通信装置 6の少なくとも受信部 4に故障が
発生したものと判断し、 自己の車両 1 0を停止させるなどの異常処理を実行する (ステップ 3 0 6 ) 。 また、 自己の車両 1 0で他の車両 1 1からの位置データを: 受信できた場合には (ステップ 3 0 4の判断 Y E S ) 、 自己の車両 1 0の車両相 互間通信装置 6は正常であることを確認する (ステップ 3 0 5 ) 。
図 7は、 車両相互間でデータが送信されなくなった場合の、 故障判定および異 常処理の手順を示すフローチヤ一トである。
すなわち、 複数の車両それぞれ、 例えば車両 1 0は、 車両相互間通信装置 6を 介して他の車両 1 1、 1 2 ···から所定の時間が経過する毎に位置データが送信さ れてきたか否かを判断している。 この所定の時間は、 車両相互間通信装置 6で通 信可能なエリア内に他の車両が存在したならば、 この他の車両から位置データが 送られてくるであろう最大の時間に設定されている (ステップ 4 0 1 ) 。
この結果、 上記所定時間が経過しても他の車両 1 1、 1 2…からの位置データ を受信していない場合には、 監視局 ·車両間通信装置 5を介して監視局 2 0に対 して、 この受信していない旨および 「自己の車両 1 0の周囲に車両相互間通信装 置 6を介して通信可能の他の車両が存在しているか否か」 を問い合わせる旨の情 報を送信する (ステップ 4 0 4 ) 。
監視局 2 0は、 この情報を送信した車両 1 0に関して車両相互間通信装置 6を 介して通信可能な距離に他の車両が存在しているか否かを判断し、 この結果、 他 の車両ありとの判断がされた場合には、 上記情報を送信した車両 1 0の車両相互 間通信装置 6の受信部 4が故障していると判断する (ステップ 4 0 6 ) 。
そして、 監視局 2 0は、 この故障の発生しでいる車両 1 0に対して安全のため 停止せよとの指令データを送信し (ステップ 4 0 7 ) 、 これを受けた車両 1 0は、 停止し、 その旨を監視局 2 0に通知する (ステップ 4 0 8 ) 。
一方、 ステップ 4 0 4の問い合わせの結果、 監視局 2 0において、 車両 1 0に 関して車両相互間通信装置 6を介して通信可能な距離に他の車両が存在していな いことが判断された場合には、 上記情報を送信した車両 1 0の車両相互間通信装 置 6は、 正常であるとの判断を下す (ステップ 4 0 5 ) 。
一方、 上記ステップ 4 0 1で、 上記所定時間が経過する前に、 他の車両 1 1、
1 2…からの位置データを受信した場合には、 この位置データを送信した他の車 両、 例えば車両 1 1に対して、 車両相互間通信装置 6を介して、 自己の車両 1 0 の位置データを送信するよう要求する (ステップ 4 0 2 ) 。
この結果、 他の車両 1 1から車両相互間通信装置 6を介して自己の車両 1 0の 位置データを送ってきた場合には、 車両相互間通信装置 6の機能は正常であると 判断、 確認する (ステップ 4 0 3 ) 。
しかし、 上記ステップ 4 0 2の要求の結果、 他の車両 1 1から車両相互間通信 装置 6を介して自己の車両 1 0の位置データを送ってこなかった場合には、 車両 相互間通信装置 6の送信部 3に故障が発生したと判断し (ステップ 4 0 9 ) 、 安 全のために自己の車両 1 0を停止させ (ステップ 4 1 0 ) 、 停止したことを監視 局 2 0に通知する (ステップ 4 1 1 ) 。
なお、 本実施形態では、 各車両から監視局 2 0に対して位置データ等を一定の 間隔で送信して、 これにより監視局において複数の車両相互の概略的な位置関係 を把握させるようにしているが、 これを省略して、 監視局 2 0の機能を、 各車両 に行き先を指示するだけ (走行指示) とし、 車両相互の位置関係の把握は、 車両 相互間通信に委ねるような実施も可能である。 産業上の利用可能性
本発明は、 屋外を走行する車両だけではなく、 屋内を走行する車両に対しても 適用することができる。 たとえば、 工場内の無人搬送システムに適用することが できる。
Claims
1 . 自己の車両位置を計測する車両位置計測手段を具えた複数の車両と、 これら複数の車両に対して走行を指示する指示データを送信する監視局とを具え た車両の監視装置において、
前記監視局と前記複数の車両との距離を無線通信可能の第 1の通信方式によつ て、 これら監視局、 複数の車両間で少なくとも前記指示データを、 送受信する第
1の送受信手段を、 前記監視局および前記複数の車両それぞれに設けるとともに、 前記複数の車両相互間の距離を無線通信可能であって、 前記第 1の通信方式よ りも高速にデータを送受信可能の第 2の通信方式によって、 これら複数の車両相 互間で、 前記車両位置計測手段で計測された位置データを送受信する第 2の送受 信手段を、 前記複数の車両それぞれに設け、
前記複数の車両それぞれに設けられた前記第 2の送受信手段により、 複数の車 両相互間で前記位置データを送信させることにより、 複数の車両それぞれにおい て、 他の車両が接近したことを判断することにより、 前記複数の車両相互の位置 関係を監視するようにした車両の監視装置。
2 . 自己の車両位置を計測する車両位置計測手段を具えた複数の車両と、 これら複数の車両それぞれから送信される位置データを受信し、 この受信された 位置データに基づき、 前記複数の車両の相互の位置関係を監視しつつこれら複数 の車両に対して走行を指示する指示データを送信する監視局とを具えた車両の監 視装置において、
前記監視局と前記複数の車両との距離を無線通信可能の第 1の通信方式によつ て、 これら監視局、 複数の車両間で前記位置データおよび前記指示データを、 送 受信する第 1の送受信手段を、 前記監視局および前記複数の車両それぞれに設け るとともに、
前記複数の車両相互間の距離を無線通信可能であって、 前記第 1の通信方式よ りも高速にデータを送受信可能の第 2の通信方式によって、 これら複数の車両相 互間で前記位置データを送受信する第 2の送受信手段を、 前記複数の車両それぞ
れに設け、
前記複数の車両それぞれに設けられた前記第 1の送受信手段により、 所定の時 間が経過する毎に前記位置データを前記監視局に送信させることにより、 前記監 視局において、 前記複数の車両の位置を監視し、
前記複数の車両それぞれに設けられた前記第 2の送受信手段により、 複数の車 両相互間で前記位置データを送信させることにより、 複数の車両それぞれにおい て、 他の車両が接近したことを判断することにより、 前記複数の車両相互の位置 関係を監視するようにした車両の監視装置。
3 . 前記車両が走行する予定走行路を分割し、 各分割地点に車両が到達する 毎に位置データを当該車両から前記監視局に送信させるようにした請求の範囲 2 記載の車両の監視装置。
4 . 前記監視局は、 前記所定の時間が経過する毎に前記位置データが受信さ れているか否かを判断し、 この判断の結果、 特定の車両から送信されるべき位置 データが受信されず、 かつ他の車両から送信される位置データが受信されたこと が判断された場合には、 この特定の車両の前記第 1の送受信手段の少なくとも送 信手段に異常があると判断し、 前記監視局から他の車両に前記第 1の送受信手段 を介してこの旨の情報を送信し、 さらに他の車両は前記第 2の送受信手段を介し て前記特定の車両に当該情報を送信し、 この異常である旨を受信した特定の車両 は、 所定の異常処理を行うようにした請求の範囲 2記載の車両の監視装置。
5 . 前記複数の車両のそれぞれは、 前記分割地点に到達する毎に前記監視局 に車両の速度データを送信するものであり、'前記監視局は、 前記速度データに基 づき、 当該車両がつぎの分割点を通過するまでに要する時間を予測し、 この予測 された時間に達した時点で、 当該車両から送信されるべき位置データが受信され なかった場合には、 当該車両の前記第 1の送受信手段の少なくとも送信手段に異 常があると判断するようにした請求の範囲 3記載の車両の監視装置。
6 . 前記複数の車両のそれぞれは、 前記監視局から前記第 1の送受信手段を 介して送信された各車両の位置情報に基づいて、 前記第 2の送受信手段で通信可 能な距離に他の車両が存在していることを判断し、 この判断がされ、 かつ当該他
の車両から前記第 2の送受信手段を介して位置データを受信していないときには、 自己の車両の前記第 2の送受信手段の少なくとも受信手段に異常があると判断し; 所定の異常処理を行うようにした請求の範囲 2記載の車両の監視装置。
7 . 前記複数の車両のそれぞれは、 前記第 2の送受信手段を介して他の車両 から所定時間を経過してもデータ入力がない場合には、 前記第 1の送受信手段を 介して前記監視局にこの旨の情報を送信し、 前記監視局は、 当該情報を送信した 車両に関して前記第 2の送受信手段で通信可能な距離に他の車両が存在している ことを判断し、 この判断がされた場合には、 前記情報を送信した車両の前記第 2 の送受信手段の少なくとも受信手段に異常があると判断するようにした請求の範 囲 1または 2記載の車両の監視装置。
8 . 前記監視局は、 所定の時間が経過する毎に前記複数の車両に所定のデ一 タを送信するものであり、 前記複数の車両は、 当該所定の時間が経過する毎に前 記所定のデータが受信されているか否かを判断し、 この判断の結果、 前記監視局 力 ら送信されるべき前記所定のデータが受信されないことが判断された場合には、 前記第 1の送受信手段に異常があると判断し、 所定の異常処理を行うようにした 請求の範囲 1または 2記載の車両の監視装置。
9 . 前記複数の車両のそれぞれは、 前記第 2の送受信手段を介して自己の位 置データを常時他の車両に送信しており、 これにより各車両は自己の車両に最も 近接している車両の存在を確認し、 前記第 2の送受信手段を介して、 これら最も 近接している車両相互間で前記位置データを送受信することにより、 これら最も 近接している車両相互間の干渉を防止する制御を行うようにした請求の範囲 1ま たは 2記載の車両の監視装置。
1 0 . 前記監視局は、 前記複数の車両から前記第 1の送受信手段を介して送 信された位置データに基づき、 最も近接している車両同士の存在を確認し、 前記 第 1の送受信手段を介して、 この旨の情報をこれら最も近接している車両同士に 送信し、 この情報が送信された最も近接している車両同士は、 前記第 2の送受信 手段を介して、 これら最も近接している車両相互間で前記位置データを送受信す ることにより、 これら最も近接している車両相互間の干渉を防止する制御を行う
ようにした請求の範囲 2記載の車両の監視装置。
Priority Applications (2)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| AU58790/98A AU5879098A (en) | 1997-02-12 | 1998-02-12 | Vehicle monitor |
| US09/355,746 US6226572B1 (en) | 1997-02-12 | 1998-02-12 | Vehicle monitor |
Applications Claiming Priority (2)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP02796097A JP3745484B2 (ja) | 1997-02-12 | 1997-02-12 | 車両の監視装置 |
| JP9/27960 | 1997-02-12 |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| WO1998036337A1 true WO1998036337A1 (en) | 1998-08-20 |
Family
ID=12235466
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| PCT/JP1998/000561 Ceased WO1998036337A1 (en) | 1997-02-12 | 1998-02-12 | Vehicle monitor |
Country Status (4)
| Country | Link |
|---|---|
| US (1) | US6226572B1 (ja) |
| JP (1) | JP3745484B2 (ja) |
| AU (1) | AU5879098A (ja) |
| WO (1) | WO1998036337A1 (ja) |
Cited By (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| WO2001071109A1 (en) | 2000-03-23 | 2001-09-27 | Hitachi Construction Machinery Co., Ltd. | Method and apparatus for transmitting machine operation data |
| WO2001073220A1 (en) | 2000-03-31 | 2001-10-04 | Hitachi Construction Machinery Co., Ltd. | Construction machine management system and construction machine |
| CN110805081A (zh) * | 2019-10-16 | 2020-02-18 | 金华深联网络科技有限公司 | 一种挖掘机人员安全防护系统 |
Families Citing this family (76)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US10573093B2 (en) | 1995-06-07 | 2020-02-25 | Automotive Technologies International, Inc. | Vehicle computer design and use techniques for receiving navigation software |
| US8260537B2 (en) * | 1997-10-22 | 2012-09-04 | Intelligent Technologies International, Inc. | Method for modifying an existing vehicle on a retrofit basis to integrate the vehicle into an information exchange system |
| SE509209C2 (sv) * | 1997-11-28 | 1998-12-14 | Spectra Precision Ab | Anordning och förfarande för att bestämma läget för bearbetande del |
| US6445308B1 (en) * | 1999-01-12 | 2002-09-03 | Toyota Jidosha Kabushiki Kaisha | Positional data utilizing inter-vehicle communication method and traveling control apparatus |
| ATE302988T1 (de) * | 1999-03-17 | 2005-09-15 | Komatsu Mfg Co Ltd | Vorrichtung zur darstellung von informationen an einer mobilen einheit |
| JP2000339029A (ja) * | 1999-05-31 | 2000-12-08 | Komatsu Ltd | 車両の干渉防止装置 |
| JP2000339028A (ja) | 1999-05-31 | 2000-12-08 | Komatsu Ltd | 移動局のデータ共有装置 |
| US6580976B1 (en) * | 1999-12-30 | 2003-06-17 | Ge Harris Railway Electronics, Llc | Methods and apparatus for very close following train movement |
| JP3854775B2 (ja) * | 2000-03-24 | 2006-12-06 | パイオニア株式会社 | 移動体システムおよび移動体管理システム |
| CN1183305C (zh) * | 2000-03-31 | 2005-01-05 | 日立建机株式会社 | 故障处理法输出系统 |
| US7171188B1 (en) | 2000-05-26 | 2007-01-30 | Hitachi Construction Machinery Co., Ltd. | Communication system for working machines |
| JP2002167810A (ja) * | 2000-09-25 | 2002-06-11 | Kobelco Contstruction Machinery Ltd | 建設機械の稼働情報読取方法、読取装置及び稼働情報管理システム並びにそれに用いる建設機械 |
| JP2002188183A (ja) * | 2000-10-12 | 2002-07-05 | Komatsu Ltd | 作機機械の管理装置 |
| US20020164993A1 (en) * | 2000-12-12 | 2002-11-07 | Elliot Nicolas F. | Method and system for locating and tracking a mobile device |
| US20040254729A1 (en) | 2003-01-31 | 2004-12-16 | Browne Alan L. | Pre-collision assessment of potential collision severity for road vehicles |
| US6571161B2 (en) * | 2001-01-22 | 2003-05-27 | General Motors Corporation | Pre-crash assessment of crash severity for road vehicles |
| US6917300B2 (en) * | 2001-11-30 | 2005-07-12 | Caterpillar Inc. | Method and apparatus for tracking objects at a site |
| US6654673B2 (en) | 2001-12-14 | 2003-11-25 | Caterpillar Inc | System and method for remotely monitoring the condition of machine |
| AU2003277123A1 (en) * | 2002-09-30 | 2004-04-23 | United States Of America As Represented By The Administrator Of The National Aeronotics And Space Administration | Tributary analysis monitoring system |
| DE10259168A1 (de) * | 2002-12-18 | 2004-07-08 | Daimlerchrysler Ag | Verfahren zum Steuern wenigstens eines autonom fahrenden Fahrzeugs |
| FI114827B (fi) * | 2003-07-03 | 2004-12-31 | Sandvik Tamrock Oy | Menetelmä ja järjestelmä kaivosajoneuvon sijainnin valvomiseksi |
| US7355528B2 (en) * | 2003-10-16 | 2008-04-08 | Hitachi, Ltd. | Traffic information providing system and car navigation system |
| US20060041845A1 (en) * | 2004-05-20 | 2006-02-23 | Caterpillar Inc. | Systems and methods for exchanging display data between machines |
| US7398137B2 (en) * | 2004-08-25 | 2008-07-08 | Caterpillar Inc. | System and method for remotely controlling machine operations using mapping information |
| US7168174B2 (en) * | 2005-03-14 | 2007-01-30 | Trimble Navigation Limited | Method and apparatus for machine element control |
| FI120191B (fi) * | 2005-10-03 | 2009-07-31 | Sandvik Tamrock Oy | Menetelmä kaivosajoneuvojen ajamiseksi kaivoksessa ja kuljetusjärjestelmä |
| US7693633B2 (en) * | 2005-11-28 | 2010-04-06 | Caterpillar Inc. | Machine operational data collection and reporting system |
| JP4812415B2 (ja) * | 2005-11-30 | 2011-11-09 | 富士通株式会社 | 地図情報更新システム、中央装置、地図情報更新方法、及びコンピュータプログラム |
| JP4369419B2 (ja) * | 2005-12-09 | 2009-11-18 | 株式会社小松製作所 | 無人車両の誘導走行制御装置 |
| US7747369B2 (en) * | 2005-12-15 | 2010-06-29 | Caterpillar Trimble Control Technologies, Llc | System and method for sharing terrain data among multiple machines |
| US9129233B2 (en) * | 2006-02-15 | 2015-09-08 | Catepillar Inc. | System and method for training a machine operator |
| US20080004763A1 (en) * | 2006-06-30 | 2008-01-03 | Caterpillar Inc. | Method and system for preventing excessive tire wear on machines |
| JP5140887B2 (ja) * | 2006-11-07 | 2013-02-13 | 株式会社小松製作所 | 無人車両の誘導走行制御方法および制御装置 |
| JP4432974B2 (ja) * | 2007-01-09 | 2010-03-17 | 村田機械株式会社 | 走行車システム |
| JP5114123B2 (ja) * | 2007-07-24 | 2013-01-09 | トヨタ自動車株式会社 | 車載装置制御システム |
| US8170756B2 (en) * | 2007-08-30 | 2012-05-01 | Caterpillar Inc. | Excavating system utilizing machine-to-machine communication |
| US7599756B2 (en) * | 2007-10-04 | 2009-10-06 | The Boeing Company | Production moving line system and method |
| US20090191034A1 (en) * | 2007-12-27 | 2009-07-30 | Ty-Crop Manufacturing Ltd. | Remote controllable material handling system |
| AU2008348963B2 (en) * | 2008-01-24 | 2013-10-31 | Suncor Energy Inc. | Method, system and media for wireless process control of mobile equipment |
| JP4544325B2 (ja) * | 2008-03-25 | 2010-09-15 | 株式会社デンソー | 車載装置 |
| US20090259399A1 (en) * | 2008-04-15 | 2009-10-15 | Caterpillar Inc. | Obstacle detection method and system |
| US8170787B2 (en) * | 2008-04-15 | 2012-05-01 | Caterpillar Inc. | Vehicle collision avoidance system |
| US8280621B2 (en) * | 2008-04-15 | 2012-10-02 | Caterpillar Inc. | Vehicle collision avoidance system |
| US20100127853A1 (en) * | 2008-11-24 | 2010-05-27 | Freeport-Mcmoran Copper & Gold Inc. | Method and apparatus for locating and tracking objects in a mining environment |
| WO2010122570A1 (en) * | 2009-04-21 | 2010-10-28 | Council Of Scientific & Industrial Research | Tracking and monitoring system for opencast mines |
| DE102010014902B4 (de) * | 2009-04-23 | 2019-02-07 | Bomag Gmbh | Mehrzweckverdichter und Verfahren zum Betreiben des Mehrzweckverdichters |
| US10836483B2 (en) | 2009-09-11 | 2020-11-17 | Aerovironment, Inc. | Ad hoc dynamic data link repeater |
| US9084276B2 (en) * | 2009-09-11 | 2015-07-14 | Aerovironment, Inc. | Dynamic transmission control for a wireless network |
| CA2790713C (en) | 2009-11-09 | 2014-09-30 | Komatsu Ltd. | Apparatus and method for controlling travel of vehicles |
| JP5135321B2 (ja) * | 2009-11-13 | 2013-02-06 | 株式会社日立製作所 | 自律走行装置 |
| US8878702B2 (en) * | 2010-10-18 | 2014-11-04 | Crucs Holdings, Llc | Transportation alert application for a mobile communication device |
| WO2014177755A1 (en) * | 2013-04-30 | 2014-11-06 | Tana Oy | Work machine control |
| CN103439714A (zh) * | 2013-09-07 | 2013-12-11 | 李拓彬 | 一种基于gps的车辆监控系统 |
| WO2015068249A1 (ja) * | 2013-11-08 | 2015-05-14 | 株式会社日立製作所 | 自律走行車両、及び自律走行システム |
| US9828011B2 (en) * | 2013-12-18 | 2017-11-28 | Thales Canada Inc | Communication system for guideway mounted vehicle and method of using the same |
| WO2017015310A2 (en) | 2015-07-20 | 2017-01-26 | Aerovironment, Inc. | Ad hoc dynamic data link repeater |
| WO2016093373A1 (ja) | 2016-02-01 | 2016-06-16 | 株式会社小松製作所 | 作業機械の制御システム、作業機械、及び作業機械の管理システム |
| JP6723886B2 (ja) * | 2016-09-23 | 2020-07-15 | 日立建機株式会社 | 第1車載装置、第2車載装置、および運行管理システム |
| AU2016101969B4 (en) * | 2016-10-04 | 2017-05-25 | Bhp Innovation Pty Ltd | A mining system |
| CN110998032A (zh) * | 2017-07-31 | 2020-04-10 | 住友重机械工业株式会社 | 挖土机 |
| JP7015133B2 (ja) * | 2017-10-04 | 2022-02-02 | 株式会社小松製作所 | 作業システム、作業機械および制御方法 |
| JP6962166B2 (ja) * | 2017-12-11 | 2021-11-05 | 井関農機株式会社 | 作業車両の遠隔操作システム |
| US10742338B2 (en) * | 2018-01-26 | 2020-08-11 | Clip Interactive, Llc | Seamless integration of radio broadcast audio with streaming audio |
| JP7197428B2 (ja) | 2019-05-08 | 2022-12-27 | 日立建機株式会社 | 車両制御システム |
| JP2020197949A (ja) | 2019-06-03 | 2020-12-10 | 株式会社小松製作所 | 作業現場の管理システム及び作業現場の管理方法 |
| US11860643B2 (en) * | 2019-07-02 | 2024-01-02 | Liebherr Mining Equipment Newport News Co. | System for controlling a plurality of autonomous vehicles on a mine site |
| US11650595B2 (en) * | 2019-07-30 | 2023-05-16 | Caterpillar Inc. | Worksite plan execution |
| JP7296823B2 (ja) * | 2019-08-23 | 2023-06-23 | 株式会社安藤・間 | 自動運転式建設機械制御システム、及び自動運転式建設機械制御方法 |
| US11520009B2 (en) * | 2020-02-05 | 2022-12-06 | Caterpillar Inc. | Method and system for detecting an obstacle |
| JP7379273B2 (ja) | 2020-06-01 | 2023-11-14 | 日立建機株式会社 | 車両制御システム |
| JP7414762B2 (ja) * | 2021-03-24 | 2024-01-16 | 日立建機株式会社 | 作業機械 |
| JP7198873B2 (ja) | 2021-06-09 | 2023-01-04 | 日立建機株式会社 | 車両制御システム |
| US20230244246A1 (en) * | 2022-01-31 | 2023-08-03 | Caterpillar Inc. | Systems, methods, and computer-program products for collaborative path planning of mobile machines in unstructured area |
| JP7763136B2 (ja) | 2022-03-28 | 2025-10-31 | 日立建機株式会社 | 車両制御システム及び車両 |
| JP2024021825A (ja) * | 2022-08-04 | 2024-02-16 | ヤンマーホールディングス株式会社 | 自動走行方法、自動走行システム、及び自動走行プログラム |
| US20250224739A1 (en) * | 2024-01-09 | 2025-07-10 | Caterpillar Inc. | Speed control for autonomous vehicle in high performance driving behavior region |
Citations (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS63150709A (ja) * | 1986-12-16 | 1988-06-23 | Shinko Electric Co Ltd | 自立型無人車システムにおける衝突回避方法 |
| JPS63150710A (ja) * | 1986-12-16 | 1988-06-23 | Shinko Electric Co Ltd | 自立型無人車システムにおける衝突回避方法 |
Family Cites Families (7)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CA1060113A (en) * | 1974-05-13 | 1979-08-07 | Howard S. White | Monitoring system for vehicles |
| EP0423332B1 (en) * | 1989-05-01 | 1995-03-08 | Kabushiki Kaisha Komatsu Seisakusho | Travelling control apparatus for vehicules |
| US5666101A (en) * | 1990-12-14 | 1997-09-09 | Cazzani; Umberto | High-efficiency apparatus for measuring operational parameters and times of vehicles running around a racetrack |
| US5579339A (en) * | 1994-04-04 | 1996-11-26 | Motorola, Inc. | Method for concurrent monitoring of multiple communications |
| US5731788A (en) * | 1995-01-11 | 1998-03-24 | Trimble Navigation | Global positioning and communications system and method for race and start line management |
| GB2298766B (en) * | 1995-03-10 | 1999-07-07 | Nec Corp | Mobile communication system |
| US5696706A (en) * | 1996-04-04 | 1997-12-09 | Morton; Curtis Eugene | Hand-held manually operable instruments determining and displaying lap speeds about a track and comparing different laps and racers |
-
1997
- 1997-02-12 JP JP02796097A patent/JP3745484B2/ja not_active Expired - Fee Related
-
1998
- 1998-02-12 WO PCT/JP1998/000561 patent/WO1998036337A1/ja not_active Ceased
- 1998-02-12 US US09/355,746 patent/US6226572B1/en not_active Expired - Lifetime
- 1998-02-12 AU AU58790/98A patent/AU5879098A/en not_active Abandoned
Patent Citations (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS63150709A (ja) * | 1986-12-16 | 1988-06-23 | Shinko Electric Co Ltd | 自立型無人車システムにおける衝突回避方法 |
| JPS63150710A (ja) * | 1986-12-16 | 1988-06-23 | Shinko Electric Co Ltd | 自立型無人車システムにおける衝突回避方法 |
Cited By (7)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| WO2001071109A1 (en) | 2000-03-23 | 2001-09-27 | Hitachi Construction Machinery Co., Ltd. | Method and apparatus for transmitting machine operation data |
| EP1273719A4 (en) * | 2000-03-23 | 2009-03-25 | Hitachi Construction Machinery | METHOD AND APPARATUS FOR TRANSMITTING MACHINE OPERATING DATA |
| WO2001073220A1 (en) | 2000-03-31 | 2001-10-04 | Hitachi Construction Machinery Co., Ltd. | Construction machine management system and construction machine |
| EP1273721A4 (en) * | 2000-03-31 | 2009-07-29 | Hitachi Construction Machinery | ADMINISTRATIVE SYSTEM OF A CONSTRUCTION MACHINE, AND CONSTRUCTION MACHINE |
| EP2261426A1 (en) * | 2000-03-31 | 2010-12-15 | Hitachi Construction Machinery Co., Ltd. | Construction machine management system, and Construction machine |
| CN110805081A (zh) * | 2019-10-16 | 2020-02-18 | 金华深联网络科技有限公司 | 一种挖掘机人员安全防护系统 |
| CN110805081B (zh) * | 2019-10-16 | 2022-08-16 | 烟台炳辉挖掘机有限公司 | 一种挖掘机人员安全防护系统 |
Also Published As
| Publication number | Publication date |
|---|---|
| AU5879098A (en) | 1998-09-08 |
| JPH10222227A (ja) | 1998-08-21 |
| US6226572B1 (en) | 2001-05-01 |
| JP3745484B2 (ja) | 2006-02-15 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP3745484B2 (ja) | 車両の監視装置 | |
| JP3424834B2 (ja) | 車両の監視装置 | |
| JP3458958B2 (ja) | 車両の干渉防止装置 | |
| US6681157B2 (en) | Vehicle interference prevention device | |
| US11203337B2 (en) | Vehicle with autonomous driving capability | |
| US10466709B2 (en) | Autonomous driving vehicle and autonomous driving system | |
| US6128559A (en) | Automatic vehicle following control system | |
| US12135557B2 (en) | Path generation system | |
| JP6025848B2 (ja) | 車両の管制制御システム | |
| JP4605805B2 (ja) | 車両の走行管制装置 | |
| JPH10311735A (ja) | Gps及びinu統合システムの統合性を監視するための方法 | |
| JP3594498B2 (ja) | 自動追従走行システム | |
| JP2001109519A (ja) | 車両の走行管制装置 | |
| WO1997026589A1 (fr) | Procede et appareil permettant d'interdire l'entree d'un camion a benne sans equipage a l'interieur d'une zone de travail | |
| US10126753B2 (en) | Work machine control system, work machine, work machine management system, and method for controlling work machine | |
| WO2014148978A1 (en) | Control system and method for control of a vehicle in connection with detection of an obstacle | |
| CN111897321B (zh) | 一种井下特种车辆的无人驾驶系统 | |
| JP2000315112A (ja) | 車両走行システムの安全装置 | |
| JP7433189B2 (ja) | 作業車監視システム | |
| JP2009134438A (ja) | 搬送用自走車の稼動管理システム及び稼動管理方法 | |
| US20200293062A1 (en) | Work machine management system | |
| JPH09128686A (ja) | 車両用表示装置 | |
| JP4992055B2 (ja) | 無人車両の誘導走行制御装置 | |
| JPH09126790A (ja) | 車両用表示装置 | |
| WO2025228518A1 (en) | System and method for controlling one or more vehicles |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| AK | Designated states |
Kind code of ref document: A1 Designated state(s): AU CA US |
|
| DFPE | Request for preliminary examination filed prior to expiration of 19th month from priority date (pct application filed before 20040101) | ||
| WWE | Wipo information: entry into national phase |
Ref document number: 09355746 Country of ref document: US |