[go: up one dir, main page]

WO1988005938A1 - Navigateur pour vehicules - Google Patents

Navigateur pour vehicules Download PDF

Info

Publication number
WO1988005938A1
WO1988005938A1 PCT/JP1988/000112 JP8800112W WO8805938A1 WO 1988005938 A1 WO1988005938 A1 WO 1988005938A1 JP 8800112 W JP8800112 W JP 8800112W WO 8805938 A1 WO8805938 A1 WO 8805938A1
Authority
WO
WIPO (PCT)
Prior art keywords
vehicle
steering angle
data
vehicle speed
target
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
Application number
PCT/JP1988/000112
Other languages
English (en)
Japanese (ja)
Inventor
Toyoichi Ono
Akira Okamoto
Yasuhiko Ichimura
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Komatsu Ltd
Original Assignee
Komatsu Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Komatsu Ltd filed Critical Komatsu Ltd
Publication of WO1988005938A1 publication Critical patent/WO1988005938A1/fr
Anticipated expiration legal-status Critical
Ceased legal-status Critical Current

Links

Classifications

    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/0011—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots associated with a remote control arrangement
    • 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/028—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle using a RF signal
    • G05D1/0282—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle using a RF signal generated in a local control room

Definitions

  • the present invention relates to a driving system for a vehicle, such as a dump truck, that assists driving and unmanned traveling of a vehicle.
  • a vehicle such as a dump truck
  • Fig. 12 Sudwell Mining AVM System
  • a signal indicating the position information is transmitted from each of the signposts 101 installed at each major location.Each vehicle ⁇ 02 A vehicle-mounted device ⁇ 03 shows the position information
  • the position of each vehicle 102 is detected, and a data signal indicating the operating status of each vehicle 102 is transmitted to each detected position.
  • these data signals are received by the central control unit 105, and the position and operation status of each vehicle ⁇ 02 indicated by these data signals are grasped.
  • a signal indicating an operation command for optimizing the operation of each vehicle 102 is transmitted from the central device 105 to each vehicle-mounted device ⁇ 03.
  • the position of the vehicle belongs to any of the small areas divided by a finite number of symposts, and thus the detection accuracy is proportional to the number of the symposts. It will be better.
  • the position of the vehicle with respect to the traveling route must be detected.
  • two-dimensional information is obtained from the traveling speed and traveling azimuth of the vehicle.
  • the running distance and running direction of the vehicle are enslaved, for example, by integrating the detection outputs of a speed sensor and a gyro compass, so that accumulation of errors is inevitable.
  • Met errors in running speed due to tie-slip during vehicle running, and errors in azimuth due to offset drift of the jerk mouth compass, significantly degrade vehicle position detection. I was Therefore, the above error may be periodically eliminated by installing a signpost at a key point in the travel route, but this has the problem that the required equipment becomes large-scale. .
  • the present invention has a flexible traveling route and The vehicle can be guided accurately by detecting both positions with high accuracy, and it is possible to provide accurate operation support and improve safety without requiring large-scale equipment. Its purpose is to provide a vehicle traveling system. Disclosure of the invention
  • a master station and two slave stations arranged in a predetermined location at a work site, and radio waves for transmitting survey radio waves from the master station and the two slave stations, respectively.
  • Generating means receiving means provided in the vehicle, for receiving the respective survey radio waves transmitted from the radio wave generating means, and each surveying means received by the receiving means.
  • Vehicle position detecting means for detecting the position of the vehicle based on the reception time difference of the radio wave for use; and a target storing a predetermined traveling route of the vehicle and a vehicle speed command on the traveling route.
  • Road storage means and a position of the vehicle detected by the vehicle position detection means and a travel route of the vehicle read out from the target path storage means.
  • Calculation means for calculating the steering angle command and detection of the actual steering angle A steering angle sensor, a vehicle speed sensor for detecting an actual vehicle speed, a steering angle command calculated by the calculation means, and an actual detection by the steering angle sensor.
  • Steering angle control means for controlling the steering angle of the vehicle based on the steering angle of the vehicle, a vehicle speed command read from the target route storage means, and a vehicle speed sensor.
  • Vehicle speed control means for controlling the vehicle speed of the vehicle based on the actual vehicle speed.
  • the position of the vehicle is determined by the Since the detection is performed based on the reception time difference, not only can the detection be performed with high accuracy, but also the equipment required for this is small. The high-precision position of the vehicle is used to guide the vehicle accurately along the traveling path.
  • the apparatus further includes a central processing unit that calculates an intermediate target position on the traveling route based on the start position and the target position, and stores the start position, the target position, and the intermediate target position in the target route storage unit. Like that.
  • the central processing unit calculates an equation of a straight line connecting the starting position and the target position, and calculates an intermediate target position from the equation at appropriate intervals on the straight line. Therefore, if the departure position and the target position are determined, the intermediate target position of the traveling route can be obtained, whereby the traveling route can be easily set.
  • a master station and two slave stations arranged in a predetermined positional relationship at a work site, radio wave generating means for transmitting a survey radio wave from the master station and the two slave stations, respectively,
  • radio wave generating means for transmitting a survey radio wave from the master station and the two slave stations, respectively,
  • control display means for displaying vehicle data indicated by the vehicle data signal; and the vehicle for optimizing work of the vehicle.
  • Central control means for transmitting from the master station a control data signal indicating control data in accordance with control data based on the data; an on-vehicle station mounted on the vehicle; the master station and two slave stations When the surveying radio wave transmitted from the vehicle is received by the vehicle station, based on the reception time difference between these surveying radio waves, When the control data signal indicating the control data transmitted from the master station is received by the vehicle-mounted station while determining the position, the control data is determined based on the control data signal. And a vehicle data processing means for transmitting from the vehicle station a vehicle data signal indicating vehicle data including the operating status of the vehicle. In this case, since the position of the vehicle is detected with high accuracy by radio surveying, the equipment required for this is small. Since the control of the vehicle is performed based on the high-precision position of the vehicle and the vehicle data, accurate operation support of the vehicle can be performed and safety can be achieved.
  • the on-vehicle processing means has display means for displaying the control data and the vehicle data. For this reason, the vehicle can grasp the control data and vehicle data.
  • FIG. 1 is a block diagram schematically showing an embodiment of a vehicle traveling system according to the present invention
  • FIG. 2 is a diagram showing an example of a work site
  • FIG. 3 is a diagram shown in FIG. A block diagram showing the configuration of the master station in detail
  • FIG. 4 is a block diagram showing the configuration of the slave station shown in FIG. 1 in detail
  • FIG. 5 is a vehicle station shown in FIG. 1
  • FIG. 6 is a block diagram showing the configuration of the vehicle-mounted processing means and the vehicle-mounted display means in detail
  • FIG. 6 is a diagram showing a traveling route of the vehicle in the present embodiment
  • FIG. 8 is a table of the vehicle monitor on the onboard display means shown in Fig. 5.
  • FIG. 9 is a diagram used to explain a process of calculating a steering command in the vehicle guidance system shown in FIG. 7, and
  • FIG. 10 is a diagram illustrating a traveling route in the present embodiment.
  • FIG. 11 is a flow chart showing a calculation process of a driving route
  • FIG. 11 is a graph used to explain the principle of calculation of a traveling route in the present embodiment
  • FIG. 12 is a diagram for controlling a vehicle.
  • 1 is a schematic diagram showing a conventional system of FIG. BEST MODE FOR CARRYING OUT THE INVENTION
  • FIG. 1 is a block diagram schematically showing one embodiment of a vehicle traveling system according to the present invention.
  • a ground unit 1 and a loading unit 2 are provided, and the ground unit 1 is provided with a master station 3, a slave station 4 and a slave station 5 at appropriate positions on a work site as shown in FIG.
  • the central station 3 is provided with central control means 6 and control display means 7.
  • the on-vehicle device 2 is mounted on a work vehicle 8 running at a work site as shown in FIG. 2, and includes a vehicle shadow station 9, an on-vehicle processing unit 10, a vehicle display unit 11, and a vehicle. It is configured with guidance devices 1 and 2.
  • the vehicle equipment 2 is mounted on each of a plurality of vehicles 8.
  • the master station 3 side of the ground equipment ⁇ is configured as shown in FIG. 3, and a signal for radio wave surveying is normally output from the control operation unit 6- ⁇ of the central control means 6. It is added to the information modulator 3 — 1 of 3.
  • the information modulator 31 modulates the signal for lightning wave surveying into the ⁇ !
  • the tuning signal is applied to the spread modulator 3-2.
  • the spread modulation section 3-2 performs secondary modulation (spread modulation) on the primary modulated signal based on the preset code added by the code generation section 3-3, and converts the spread modulated signal.
  • Transmitter 3-4 transmits this spread-spectrum modulated signal from antenna 3-5 as a survey radio wave (shown in Fig. 1).
  • the slave stations 4 and 5 are configured as shown in FIG. 4, and the antennas 45- ⁇ are alternately switched at preset intervals via the duplexer 45-2. Connected to receiver 4 5 — 3 and transmitter 4 5 — 4. When antenna 4 5-1 and receiver 4 5-3 are connected via duplexer 4 5-2, receiver 4 5-3 receives at antenna 4 5-1.
  • the spread modulated signal corresponding to the obtained survey radio wave is added to the spread demodulation units 45-5.
  • the spread demodulation unit 45-5 performs first-order demodulation (spread demodulation) of the spread-modulated signal based on the preset code added from the code generation unit 45_6, and outputs a spread demodulated signal.
  • the modulated signal to be received is added to the synchronization control section 45-7.
  • the synchronization control section 45-7 detects the synchronization of the modulated signal to be modulated and outputs the primary modulated signal having the same period as the modulated signal.
  • the signal is added to the spread modulators 4 5-8 ′ without being interrupted.
  • the spread modulators 4 5-8 are based on the codes added from the code generators 4 5-6 and are used for the primary modulated signal. Is secondarily modulated, and the spread modulated signal is added to the transmitter 45-5.
  • the transmitter 45-5 transmits the spread modulated signal to the antenna 45-5 through the transmission / reception switch 45-2.
  • the slave station 4 transmits the survey radio wave m 2
  • the slave station 5 transmits the survey radio wave m 3. (Shown in Fig.
  • the on-vehicle station 9 in the on-vehicle device 2 is configured as shown in FIG. 5, and the survey radio waves mi, m 2 and m 3 are received by the antenna 9-1 of the on-vehicle station 9.
  • the master station receiver 912, slave station receivers 913 and slave station receivers 914 are connected to the respective spread spectrum corresponding to the received survey radio waves m «j, m 2 and ⁇ m 3.
  • the modulated signal is applied to the spread demodulation sections 915, 916 and 917, respectively.
  • the spread demodulation unit 915 performs primary demodulation (spread demodulation) on the spread modulated signal corresponding to the radio wave m based on the preset code added from the code generation unit 918, and outputs the spread demodulated output.
  • the modulated signal is applied to the phase difference detector 9-1 9 and the phase difference detector 910.
  • Spread demodulation unit 9 one 6 the spread modulated signals corresponding to the radio wave m 2 to 1 Tsugifuku adjusted based on the code being applied from the code generator 9 one 8, the phase difference detection section 9 to be primary modulation signal Add to nine.
  • Spread demodulation unit 9 - 7 code generation section the spread modulated signals corresponding to the radio wave m 3 and primary demodulating based on the code being applied from the 9-8, phase S detector 9 to be primary modulation signal Add to one ten.
  • the phase difference detector ⁇ detects the phase difference ⁇ indicating the time difference and adds the signal representing the phase difference ⁇ ) to the vehicle position detector ⁇ 0-1 of the vehicle shade processing means 10.
  • the phase difference delta omega 2 showing the phase difference means that the reception time difference of the surveying Telecommunications ⁇ ⁇ ! and m 3 of these signals Detects a signal indicating a phase difference delta 2 of this vehicle position ⁇ detecting means 1 0 - is added to 1.
  • Vehicle position detecting means ⁇ 0 -! 1 Each phase difference and inputs a signal indicating a delta omega 9, the phase difference delta omega ⁇ This is found to calculate the position of the vehicle 8 on the basis of the delta omega 2.
  • Frequency modulation, phase difference modulation, and amplitude modulation are applied to the second-order modulation, and the second-order modulation is directly spread and frequency-hopping based on pseudo-random codes.
  • Spread spectrum modulation is applied.
  • Such a spread spectrum communication method using spread modulation has a wide spread bandwidth and a very low power density during communication, so that it is not susceptible to interference. Further, multiplex communication is possible, which is suitable for distance measurement.
  • the master station 3 and the slave stations 4 and 5 are installed at positions in known two-dimensional coordinates in advance.
  • the ⁇ main station at the position of (0, 0)
  • the ⁇ 4 (a _j, b 1) in the position of, and respectively Installation on the position of the slave station 5 (a 2, b 2)
  • the position of the loading station 9 is (X, Y)
  • between the master station 3 and the on-vehicle station 9 and the distance L 2 between the car stimulating station 9 and the slave station 4 is good beauty difference delta Iota_ 2 and the distance L 3 between the vehicle station 9 one slave 5 and the distance L ⁇ ] can and this representing in Tsu by the following formula (1) and (2).
  • phase difference and ⁇ 2 correspond to AL ⁇ j and L 2 in the above formulas (“and (2), respectively.
  • the vehicle position detecting means 10 ⁇ ⁇ of the vehicle-mounted processing means 1 ⁇ obtains the current position (X, ⁇ ) of the vehicle 8 in one part time as described above, and a signal indicating this position is obtained in the center.
  • CPU processing device 1 0—Add to 2.
  • the vehicle display means 1 is configured as shown in Fig. 5, and is operated by operating the input unit 1 1-1.
  • the traveling path as shown in FIG. 6 can be manually operated, and these constant paths are stored in the vehicle shade processing means 1 Q ⁇ storage means 1 Q — 3.
  • the running ⁇ Alpha. Is all SANYO formed by Tsu along the respective positions Alpha to? Eta, coordinates of these positions A ⁇ ] ⁇ A n (X A1, Y A1) ⁇ (X An , Y An ) is input from the input unit 111 and stored in the storage means 10-3.
  • the positions B #, B ... forming the traveling path B are also stored in the storage means 10-3.
  • the vehicle guidance device 12 is configured as shown in FIG. 7, and outputs a signal indicating the vehicle speed outputted from the vehicle speed sensor ⁇ 2-1 and a signal outputted from the rotation sensor 12-2.
  • Vehicle control selection means 2-4 The signal indicating the steering angle output from 3 is applied to the vehicle control selection means 2-4.
  • Vehicle control selection means Vehicle control selection means
  • 1 2 — 4 inputs these signals at an inter-part time, and every time they are input, the vehicle speed, engine speed, and steering angle are used as data for the stimulus processing means.
  • the CPU 10-2 stores the data indicating the vehicle speed, the number of revolutions of the engine, and the steering in the storage means ⁇ 0-3, and updates the data storage at the interval time. .
  • vehicle data including the position of the vehicle 8, the traveling routes A and B, the vehicle speed, the number of revolutions of the engine, and the steering angle are stored in the storage means 1Q-3.
  • the traveling route A is operated.
  • the vehicle monitor 112 is placed on the driving route A as shown in FIG. 8 (a) based on the contents of the storage means 10-3.
  • the vehicle speed, the number of revolutions of the engine, and the steering angle are also displayed.
  • the vicinity where vehicle 8 is located on traveling route A may be partially enlarged and displayed.
  • the GPU 10-2 reads the vehicle data consisting of the traveling route A, the position of the vehicle 8, the vehicle speed, etc. displayed on the vehicle monitor 1 1-2 from the storage means 10-3, and reads this vehicle data. Is added to the information modulating section 9-11 of the on-board station 9.
  • the information modulation section 911 Upon input of the vehicle data signal, the information modulation section 911 performs primary modulation on the vehicle data signal, and adds the primary modulated signal to the spread modulation section 911. Further, the code generation section 9-13 adds a specific code indicating the vehicle 8 to the spread modulation section 9-12. Based on this code, the spread modulation section 9-1 12 applies the second-order modulated signal to the second-order modulation, and applies the spread-modulated signal to the transmitter 9-1 14. Transmitters 9-14 transmit the spread modulated signal from antennas 9-15. As a result, from the plurality of vehicles 8, spread-spectrum modulated signals based on each code specified for each vehicle 8 are transmitted as radio waves dd,, indicating vehicle data (shown in FIG. 1). .
  • the ground equipment 1 receives these radio waves d ⁇ j to d by the antenna 3-6 (shown in Fig. 3) of the main station 3, and the receiving collar 3-7 receives the spread signals corresponding to these radio waves.
  • the modulation signal is applied to the spread demodulation unit 3-8.
  • the vehicle data selection unit 6-2 of the central control unit 6 controls the code generation unit 3-9, and the respective signals specified for each vehicle 8 are controlled. One of the codes is selected and the selected code is From 3-9, it is added to the spread demodulation unit 3-8.
  • spread demodulation unit 3 - 8 is ⁇ following demodulates the spread modulated signals corresponding to one of the Chi sales of each of the radio signal d 1 ⁇ d k based on the selected code, this demodulated output That is, the primary modulated signal is added to the information modulation section 3-10.
  • the information demodulation unit 3-10 performs second-order demodulation of the primary modulated signal, and outputs one of the vehicle data signals of each vehicle 8 to the demodulation output, that is, the vehicle data selection unit 6. — Add to 2. Therefore, the vehicle data selection unit 6-2 generates each code specified for each vehicle 8 from the code generation unit 3-9, so that each vehicle 8 The vehicle data signal of each vehicle 8 can be input, and vehicle data of each vehicle 8 is collected.
  • the vehicle data selection unit 6-2 receives the collected vehicle data signal for each vehicle 8 on site, and in addition to the state storage unit 6-3, the vehicle data signal for each vehicle 8 is collected.
  • the input unit 7-1 of the control display means 7 is, for example, a console for inputting a work site map, and this work site map is stored in the site hangup storage unit 6-3.
  • the control monitor 7-2 reads the work site map and the vehicle data for each vehicle 8 from the site status storage unit 613, and the travel route and position of each vehicle 8 on the work site map. Display vehicle speed, etc.
  • control operation unit 6 — of the central control means 6 stores the work site map and the vehicle data for each vehicle 8 from the site status storage unit 6 — 3 at a preset time. Read out. Then, the traffic control calculation unit 6-1 is used to optimize the work of each vehicle 8 based on the work site map and each vehicle data. Control data, for example, the position of each vehicle 8 on the work site map, the optimal operation route selection command for each vehicle 8, change information on the site map, etc., and the control data signal indicating this control data Sunlight modulation part 3 — Add to 1. However, at this time, the control operation unit 6— does not output the signal for radio surveying described above, but outputs only this control data signal.
  • the information modulating section 3 modulates the control data signal in the fourth order and adds the primary modulated signal to the spreading modulating section 3 — 2.
  • the e- spreading modulating section 3 — 2 is based on the code from the code generating section 3 — 3. Then, the primary modulated signal is secondarily modulated, and the spread modulated signal is transmitted from antenna 3-5 in addition to transmitter 3-4.
  • the spread-spectrum modulated signal is received by the main station receiver 9-2 via the antenna 911, and the spread-spectrum modulated signal is spread. Add it to the demodulation section 9-15.
  • the spread demodulation section 915 performs second-order demodulation on the spread-modulated signal based on the code from the code generation section 918, and outputs the demodulated output, that is, the primary-modulated signal, on the information demodulation section 9-1; Add to 6.
  • the information demodulation sections 9-116 perform second-order demodulation of the primary modulated signal, and apply the demodulated output, that is, the control data signal to the GPU 0-2 of the in-vehicle processing means # 0.
  • the GPU 10-2 stores the control data indicated by the control data signal in the storage means 0-3. Therefore, the storage means 10-3 stores the vehicle data of the vehicle 8 described above together with the control data. Then, by operating the input unit 111 of the on-vehicle display means 11, the display of the control data is instructed. Both monitors ⁇ 1 and 2 display the position of each vehicle 8 on the work site map and the command for selecting the optimal operation route of each vehicle 8 based on the control data stored in the storage means 10-3.
  • the surveying radio wave is transmitted from the master station and the two slave stations, and the position of the vehicle is detected based on the reception time difference of these radio waves at the on-board station, and the master station is also detected. Control data and vehicle data are exchanged between the on-board stations. For this reason, the required equipment must not be large-scale, and accurate operation support of vehicles will be provided and safety will be improved.
  • the data shown in the following table (1) is stored in the storage means 10-3 of the on-vehicle processing means 1 ⁇ by operating the input unit 111 of the on-vehicle display means 11.
  • each coordinate position (X A1 , ⁇ A1 ) to (( ⁇ , ⁇ ⁇ ) indicating the travel path A, and each coordinate position (X M , YB1 ), ( XBn , YBn ),... are stored in the storage means 10-3.
  • the recording unit 1 0 When the user operates the input unit 1 1 1 1 1 to instruct, for example, guidance traveling on the traveling route A, the recording unit 1 0—
  • the first vehicle control calculation means 12-5 is used to calculate each coordinate position ( XA1 , YA1 ) on the traveling route A indicated by the data.
  • the travel route ⁇ is set to each coordinate position ( XA1 ,
  • the target line segment is assumed to be AA
  • the current position of vehicle 8 is assumed to be (Xv, YuK) '
  • the first vehicle control operation means "] 2-5 obtains the steering angle command ⁇ of the vehicle 8 as described above, and the signal indicating the steering angle command ⁇ and the storage means ⁇ 0 — ( '. X a ⁇ ⁇ ⁇ , (X a ra)' Ru good in three these data Upsilon> signals indicative of the respective vehicle speed command corresponding to the vehicle control selection means ⁇ 2 -.
  • Add to 4 vehicle control selection Means 1 2-4 add a signal indicating the steering angle command ⁇ to the steering control means ⁇ 2-6, as well as the actual vehicle speed command and the actual speed detected by the vehicle speed sensor 12-1.
  • a signal indicating a governor position command is sent to the governor control means 12-7, a signal indicating a speed step command is given to the transmission control means 12-8, and a retarder A signal indicating a re-start brake pressure command is sent to control means 1 2-9, and a brake command is sent to brake control means 1 2-0. Add a signal indicative of their respective.
  • the governor drive motor 12-5 is driven as described above, and the position of the governor 12-7 connected to this motor "I25" via the clutch 12-16 is adjusted.
  • the position control means 1 2-8 responds to the rotation speed of the engine 12-18 detected by the rotation sensor 12-2.
  • the electromagnetic switching valve 12-21 is switched so that the transmission 12-9 is set to the commanded speed stage.
  • the signal indicating the retard brake pressure command is input, the actual value detected by the air pressure sensor
  • the air pressure of the air servo valve 12-23 is controlled so that the air pressure follows the retard brake pressure command, and the retarder 12-24 is driven.
  • Means ⁇ 2-0 upon input of the signal indicating the brake command, drives brakes 12-25 to stop rain 8, and as a result, vehicle 8 responds to the above vehicle speed commands. If it is stored in the storage means 10-3 in advance that it is necessary to activate the work equipment mounted on the vehicle 8 at a predetermined position on the traveling route ⁇ , the vehicle control is performed.
  • Selection means 1 2-4 Applies a signal indicating a work command at the above-mentioned predetermined position to the work machine control means 12-26. As a result, the work machine control means 12-26 drives the vessel cylinder 12-27 to cause the work machine to perform work.
  • the obstacle recognition means 1 2 — 3 1 captures an image of the traveling direction of the vehicle 8, and outputs a signal indicating the captured screen to the obstacle position detection means 1 2 — 3 2
  • the obstacle position detection means 1 2-3 2 detects the position of the obstacle based on the imaged image when there is an obstacle, and outputs a signal indicating the position to the danger prediction means.
  • Danger prediction means 1 2 — 3 3 adds a signal indicating danger to vehicle control selection means 1 2 — 4 when this position is in the direction of travel.
  • the vehicle control selecting means 1 2-4 performs steering control for bypassing the obstacle, or performs stop control.
  • the vehicle speed command and the fact that the vehicle is to be guided by a guidance line are stored in advance in the storage means ⁇ 0-3.
  • vehicle 8 is
  • the four pick-ups provided on the vehicle 8 by the magnetic field from the guide ⁇ laid in the route ⁇ A 2 When signals corresponding to the magnetic field strength are generated in the pucoyl 1 2 — 37 a, 1 2 — 37 b 1 2-37 c and 37 d, these signals are generated.
  • the second vehicle control operating means 1 2 via the pick-up amplifier 2-3 8 Added to 1-9.
  • the second vehicle control calculation means 12-39 receives the difference between the signal outputs of the pickup coils 12-37a and 12-37b, and the like. Based on the difference between the signal outputs of the pickup coil 1 2-37 c and 12-37 d, the course deviation amount and attitude angle of the vehicle 8 with respect to the guide line are detected.
  • the steering angle command is obtained based on the course deviation amount and the attitude angle, and the respective vehicle speed commands corresponding to the respective coordinate positions are read from the storage means 10-3.
  • the respective signals indicating the steering angle command and the respective vehicle speed commands are applied to the vehicle control selecting means 12-4.
  • the vehicle control selecting means # 2-4 performs the steering control based on the steering angle command and performs the vehicle speed control based on the respective vehicle speed commands.
  • the vehicle is guided along a predetermined traveling route based on the position of the vehicle detected based on the principle of electric survey, so that the traveling route has flexibility.
  • the position of the vehicle can be detected with high accuracy, and the vehicle can be guided accurately. For example, this is effective when guiding a vehicle on a mulberry field with poor visibility.
  • the platform on which the driver operates the vehicle rain 8 adjusts the vehicle speed by operating the accelerator pedal 12-4 ⁇ ⁇ and operates the handle 12-42. With this operation, the manual switch 1 2-4 3 is operated to switch the electromagnetic switching valve ⁇ 2 ⁇ 2.
  • travel route A shown in Fig. 6 is converted to travel route G.
  • the case of change will be described with reference to the flowchart of FIG.
  • the departure position A of the travel route C and the target position P n are determined by the CPU 1 of the stimulation processing means 10.
  • a command for the traveling route is given to GPU 10-2.
  • the GPU 10-2 receives this command (Step 2 01)
  • the vehicle 8 moves to the departure position A based on the position of the vehicle 8 detected by the vehicle position detecting means 10-1.
  • ⁇ ] Is determined (step 202).
  • the CPU 10-2 waits without performing an operation for changing the traveling route.
  • the CPU 10-2 determines that the vehicle 8 has returned to the departure position [ ⁇ ] in step 220, the CPU 10-2 calculates a linear equation based on the departure position A and the target position Pn. Then, the intermediate target position is calculated in steps (1) and (2), and the starting position A, the intermediate target position, and the target position Pn are sequentially stored in the storage means 10-3 (step 203). , 20 4, 2 0 5 ⁇ Then, when the CPU 10-2 finishes storing the start position ⁇ ⁇ ), the intermediate target position, and the target position P n , this calculation ends. (Step 206).
  • FIG. 1 is a graph showing the principle of calculation of a traveling route, and the coordinate position ( X ⁇ 1 , ⁇ 1 ) is the starting position ⁇ of the vehicle 8 and is known. There Well, the goal position ⁇ ⁇ is the coordinate position (Assuming that X Pn is set, the equation of the straight line connecting the position P is
  • the departure position and the target position of the traveling route are input by operating the input means 111. It only needs to be done.
  • various curves can be obtained simply by selecting one of the curve methods g 3 ⁇ 4 and specifying the starting position and the target position.
  • the central control means 6 shown in FIG. 1 can be used to select an equation and specify a start position and a target position. And the designated starting position and target position are transmitted from the main station 3 to the on-board station 9 so that the driving route can be set.
  • the travel route stored in the storage means 10-3 of the on-vehicle processing means 10 is displayed on the vehicle monitor 11-2 of the on-vehicle display means 11 and the travel route is displayed. It is of course possible to guide the vehicle 8 along the route.
  • the position of the vehicle is detected based on the principle of radio wave surveying, and the vehicle is guided and guided along the traveling path set in advance based on the detected position of the vehicle.
  • the target route is flexible, and the position of the vehicle can be detected with high accuracy to guide the vehicle accurately.
  • control data and vehicle data are exchanged between the master station and the on-board stations, accurate data can be obtained even if the required equipment is not large-scale. Operational support can be provided to improve safety.
  • the traveling path between the departure position and the target position is automatically performed, so that the equipment of the traveling path must be changed.

Landscapes

  • Engineering & Computer Science (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Navigation (AREA)

Abstract

Une station mobile (9) montée sur un véhicule reçoit des ondes électromagnétiques de mesure (m1, m2, m3) envoyées par une station principale (3) et par deux stations secondaires (4, 5) installées sur le site de travail. Un dispositif mobile de traitement (10) détecte la position du véhicule sur la base de l'intervalle entre la réception des différentes ondes électromagnétiques (m1, m2, m3) de mesure. Une unité de conduite (12) du véhicule guide le véhicule le long d'un trajet prédéterminé en fonction de la position détectée du véhicule. Les données de commande et les données concernant le véhicule sont échangées entre la station principale (3) et la station mobile (9) et sont affichées par un dispositif mobile d'affichage (11) et par un dispositif d'affichage de commande (7). Ces données sont utilisées pour aider à conduire le véhicule. Le dispositif mobile de traitement (10) comprend en outre une fonction de calcul automatique du trajet sur la base des points de départ et d'arrivée.
PCT/JP1988/000112 1987-02-06 1988-02-05 Navigateur pour vehicules Ceased WO1988005938A1 (fr)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP62024448A JPS63193208A (ja) 1987-02-06 1987-02-06 車両の走行コ−ス自動演算装置
JP62/24448 1987-02-06

Publications (1)

Publication Number Publication Date
WO1988005938A1 true WO1988005938A1 (fr) 1988-08-11

Family

ID=12138434

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP1988/000112 Ceased WO1988005938A1 (fr) 1987-02-06 1988-02-05 Navigateur pour vehicules

Country Status (3)

Country Link
JP (1) JPS63193208A (fr)
AU (1) AU1244288A (fr)
WO (1) WO1988005938A1 (fr)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
FR2653232A1 (fr) * 1989-10-12 1991-04-19 Univ Alsace Procede et dispositif pour controler le deplacement d'un mobile en mouvement par rapport a un autre mobile.
GB2274521B (en) * 1993-01-11 1997-01-08 Hitachi Ltd Production control system
WO2003012470A3 (fr) * 2001-08-02 2003-12-04 Siemens Ag Systemes de manutention pourvus de dispositifs de localisation radio haute frequence

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP0423332B1 (fr) * 1989-05-01 1995-03-08 Kabushiki Kaisha Komatsu Seisakusho Appareil de teleguidage pour vehicules
JP2010134961A (ja) * 1998-02-13 2010-06-17 Komatsu Ltd 車両の誘導装置

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS58192113A (ja) * 1982-05-07 1983-11-09 Meidensha Electric Mfg Co Ltd 移動機器の運行制御方法
JPS5969814A (ja) * 1982-10-15 1984-04-20 Tokinori Kudo 船舶の自動操舵方法および自動操舵装置
JPS59119417A (ja) * 1982-12-27 1984-07-10 Mitsubishi Heavy Ind Ltd 自走台車制御装置

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS58192113A (ja) * 1982-05-07 1983-11-09 Meidensha Electric Mfg Co Ltd 移動機器の運行制御方法
JPS5969814A (ja) * 1982-10-15 1984-04-20 Tokinori Kudo 船舶の自動操舵方法および自動操舵装置
JPS59119417A (ja) * 1982-12-27 1984-07-10 Mitsubishi Heavy Ind Ltd 自走台車制御装置

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
FR2653232A1 (fr) * 1989-10-12 1991-04-19 Univ Alsace Procede et dispositif pour controler le deplacement d'un mobile en mouvement par rapport a un autre mobile.
GB2274521B (en) * 1993-01-11 1997-01-08 Hitachi Ltd Production control system
WO2003012470A3 (fr) * 2001-08-02 2003-12-04 Siemens Ag Systemes de manutention pourvus de dispositifs de localisation radio haute frequence
US6799099B2 (en) 2001-08-02 2004-09-28 Rapistan Systems Advertising Corp. Material handling systems with high frequency radio location devices

Also Published As

Publication number Publication date
AU1244288A (en) 1988-08-24
JPS63193208A (ja) 1988-08-10

Similar Documents

Publication Publication Date Title
EP0423332B1 (fr) Appareil de teleguidage pour vehicules
US6351708B1 (en) Vehicle navigation system and method
JP3933803B2 (ja) 走行環境情報収集装置および情報提供システム
EP2079066B1 (fr) Appareil électronique embarqué et système de communication automobile
EP2051223B1 (fr) Système de navigation dynamique pour véhicule
JP2010537210A (ja) 境界標識による車両位置の補正
JPH0886662A (ja) 車載の走行経路表示装置、道路情報送信装置、経路案内システムおよびナビゲーションシステムの表示方法
JP2000311299A (ja) 自動追従走行システムの隊列形成方法
JPH09180087A (ja) 交通情報提供システム
WO1988005938A1 (fr) Navigateur pour vehicules
JP2003515209A (ja) 自走車両
JP2006003272A (ja) ナビゲーション装置、及びナビゲーションシステム
KR101647626B1 (ko) 버스 운행 안내 시스템
JPH09210701A (ja) ナビゲーション装置
JP2001289657A (ja) 僅かなデータ量を使用するナビゲーション方式
JP5010951B2 (ja) 車載地図表示装置
JP2002340584A (ja) カーナビゲーション装置及びこれを用いた交通情報サービスシステム
JPH09245292A (ja) 車載ナビゲーション装置
JP7401192B2 (ja) 車両位置提示システム、これに利用する車載器、車両位置提示方法、および車両位置提示用プログラム
JP2000055677A (ja) 車両間通信方式
JPS63142500A (ja) 作業車両の運行管制システム
JPH0579847A (ja) Ａｖｍシステム
US20100148988A1 (en) Information provision system and in-vehicle apparatus
JPH01123305A (ja) 車両の走行制御装置
JP2002229497A (ja) 車輛内表示装置及びその表示方法

Legal Events

Date Code Title Description
AK Designated states

Kind code of ref document: A1

Designated state(s): AU DE SU US

REG Reference to national code

Ref country code: DE

Ref legal event code: 8642