WO2018030154A1 - Autonomous travel system - Google Patents

Autonomous travel system Download PDF

Info

Publication number
WO2018030154A1
WO2018030154A1 PCT/JP2017/027064 JP2017027064W WO2018030154A1 WO 2018030154 A1 WO2018030154 A1 WO 2018030154A1 JP 2017027064 W JP2017027064 W JP 2017027064W WO 2018030154 A1 WO2018030154 A1 WO 2018030154A1
Authority
WO
WIPO (PCT)
Prior art keywords
reference station
information
station
movement
reference point
Prior art date
Application number
PCT/JP2017/027064
Other languages
French (fr)
Japanese (ja)
Inventor
宮窪 孝富
山下 春造
Original Assignee
ヤンマー株式会社
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 ヤンマー株式会社 filed Critical ヤンマー株式会社
Publication of WO2018030154A1 publication Critical patent/WO2018030154A1/en

Links

Images

Classifications

    • AHUMAN NECESSITIES
    • A01AGRICULTURE; FORESTRY; ANIMAL HUSBANDRY; HUNTING; TRAPPING; FISHING
    • A01BSOIL WORKING IN AGRICULTURE OR FORESTRY; PARTS, DETAILS, OR ACCESSORIES OF AGRICULTURAL MACHINES OR IMPLEMENTS, IN GENERAL
    • A01B69/00Steering of agricultural machines or implements; Guiding agricultural machines or implements on a desired track
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions

Definitions

  • the present invention relates to an autonomous traveling system that autonomously travels a work vehicle along a target travel route while acquiring position information of the work vehicle.
  • the autonomous traveling system as described above includes a reference station installed at a reference point, and satellite positioning information is acquired from positioning satellites in both the work vehicle and the reference station.
  • the reference station transmits correction information including the position information of the reference point and the acquired satellite positioning information to the work vehicle.
  • the work vehicle does not obtain the current position information of the work vehicle only from the satellite positioning information acquired by itself, but corrects the satellite positioning information acquired by itself using the correction information transmitted from the reference station.
  • the current position information of the vehicle is obtained with high accuracy. Then, based on the obtained current position information of the work vehicle, the work vehicle is allowed to autonomously travel along the target travel route (see, for example, Patent Document 1).
  • the main problem of the present invention is to provide an autonomous traveling system capable of preventing inconveniences such as the work vehicle greatly deviating from the target traveling route by taking measures against movement of the reference station from the reference point.
  • the point is to provide.
  • a first characteristic configuration of the present invention includes a reference station that is installed at a predetermined reference point and transmits correction information based on position information of the reference point and satellite positioning information;
  • a mobile station that is mounted on a work vehicle and calculates position information of the work vehicle based on the correction information and satellite positioning information transmitted from the reference station;
  • An autonomous traveling system comprising: an autonomous traveling control unit that autonomously travels the working vehicle along a predetermined traveling route using position information of the working vehicle calculated by the mobile station, A movement detection unit for detecting movement of the reference station;
  • the autonomous traveling control unit is characterized in that when the movement of the reference station is detected by the movement detecting unit, the autonomous traveling of the work vehicle is stopped.
  • the autonomous traveling control unit stops the autonomous traveling of the work vehicle. Accordingly, when the reference station moves from the reference point, it is possible to take an appropriate measure of stopping the autonomous traveling of the work vehicle, and it is possible to prevent inconveniences such as the work vehicle greatly deviating from the target travel route.
  • the reference station has a transmission stop unit that stops transmission of the correction information when movement of the reference station is detected by the movement detection unit
  • the autonomous traveling control unit is characterized in that the autonomous traveling of the work vehicle is stopped based on the fact that the mobile station cannot acquire the correction information from the reference station.
  • the transmission stop unit stops the transmission of the correction information, and the autonomous traveling control unit cannot acquire the correction information, thereby stopping the autonomous traveling of the work vehicle. Accordingly, it is possible to take appropriate measures against the movement of the reference station only by adopting a simple configuration in which transmission of correction information is stopped by the transmission stop unit.
  • the transmission stop unit stops transmission of the correction information until a return operation is performed on the reference station, and is specified based on satellite positioning information after the return operation is performed.
  • the current position of the reference station and the position of the reference point are compared, and if the position error is within a predetermined threshold, transmission of the correction information is not stopped.
  • the transmission stop unit stops the transmission of the correction information until the return operation is performed with respect to the reference station. Therefore, the autonomous traveling of the work vehicle can be stopped until the return operation is performed. . Therefore, it is possible to reliably prevent inconveniences such as the work vehicle greatly deviating from the target travel route.
  • the transmission stop unit compares the current position of the reference station with the position of the reference point after the return operation is performed, and if the position error is within a predetermined threshold, the reference station is only moved slightly.
  • the correction information is transmitted from the reference station without stopping the transmission of the correction information. Therefore, the autonomous traveling of the work vehicle can be resumed after confirming that the current position information of the work vehicle can be appropriately acquired.
  • the reference station compares the current position of the reference station specified based on satellite positioning information with the position of the reference point after the return operation to the reference station is performed.
  • a reference point setting unit that sets the current position of the reference station as a new reference point when the error is outside a predetermined threshold;
  • the transmission stop unit does not stop the transmission of the correction information when the current position of the reference station is set as a new reference point by the reference point setting unit.
  • the reference point setting unit compares the current position of the reference station with the position of the reference point, and if the position error is outside a predetermined threshold, the reference station is Assuming that there is a large movement from the reference point, the current position of the reference station is set as a new reference point.
  • the transmission stop unit does not stop transmission of correction information, and the reference station transmits correction information including position information of the newly set reference point. Can do. Therefore, even when the reference station has moved greatly from the original reference point set in advance, the current position information of the work vehicle can be acquired appropriately, and the autonomous traveling of the work vehicle can be resumed appropriately. it can.
  • a fifth characteristic configuration of the present invention includes a wireless communication terminal capable of instructing the autonomous traveling control unit to autonomously travel the work vehicle via a wireless communication network,
  • the wireless communication terminal is characterized in that, when movement of the reference station is detected by the movement detection unit, a predetermined notification indicating that the reference station has been moved is performed.
  • the wireless communication terminal when the movement detection unit detects the movement of the reference station, the wireless communication terminal performs a predetermined notification that suggests the movement of the reference station, so that an operator or the like can easily recognize the movement of the reference station. For example, it is possible to appropriately and smoothly cope with the movement of the reference station such as a return operation for the reference station.
  • This autonomous traveling system is configured to generate a target traveling route and to autonomously travel the tractor 1 as a work vehicle along the generated target traveling route.
  • the tractor 1 includes a vehicle body portion 2 on which a work machine 50 can be mounted on the rear side, the front portion of the vehicle body portion 2 is supported by a pair of left and right front wheels 3, and the rear portion of the vehicle body portion 2 is a pair of left and right rear wheels 4. It is supported.
  • a bonnet 5 is disposed in the front part of the vehicle body 2, and an engine 6 as a drive source is accommodated in the bonnet 5.
  • a cabin 7 for a driver to board is provided on the rear side of the bonnet 5, and a steering handle 8 for a driver to steer and a driver's driving seat 9 are provided in the cabin 7. It has been.
  • the engine 6 can be composed of, for example, a diesel engine, but is not limited thereto, and may be composed of, for example, a gasoline engine. Further, an electric motor may be employed as a drive source in addition to the engine 6 or instead of the engine 6.
  • the tractor 1 will be described as an example of a work vehicle.
  • a walking machine in addition to a riding work vehicle such as a rice transplanter, a combiner, a civil engineering / construction work device, a snowplow, A type work vehicle is also included.
  • a three-point link mechanism including a pair of left and right lower links 10 and an upper link 11 is provided on the rear side of the vehicle body portion 2, and the working machine 50 can be mounted on the three-point link mechanism.
  • a lifting device having a hydraulic device such as a lifting cylinder is provided on the rear side of the vehicle body 2, and this lifting device lifts and lowers the work implement 50 by lifting and lowering the three-point link mechanism. ing.
  • FIG. 1 illustrates the case where a tilling device is mounted, but not only the tilling device but various working machines such as a plow and a fertilizer can be applied.
  • the tractor 1 includes a governor device 21 that can adjust the rotational speed of the engine 6, a transmission device 22 that shifts the rotational driving force from the engine 6 and transmits it to the drive wheels, the governor device 21, A control unit 23 and the like that can control the device 22 are provided.
  • the transmission 22 is configured by combining, for example, a main transmission composed of a hydraulic continuously variable transmission and an auxiliary transmission composed of a gear type multi-stage transmission.
  • the tractor 1 not only allows the driver to travel in the cabin 7, but also allows the tractor 1 to autonomously travel based on instructions from the wireless communication terminal 30 even if the driver does not board the cabin 7. It is configured as possible.
  • the tractor 1 includes a steering device 24, a positioning antenna 25, a wireless communication antenna 26, and the like, and autonomously acquires its current position information (position information of the vehicle body 2). It is configured to be able to run.
  • the steering device 24 is provided, for example, in the middle of the rotation shaft of the steering handle 8 and is configured to be able to adjust the rotation angle (steering angle) of the steering handle 8.
  • the control unit 23 controls the steering device 24
  • not only the straight traveling but also the turning angle of the steering handle 8 can be adjusted to a desired turning angle, and the turning turning with the desired turning radius can be performed.
  • the steering device 24 may adjust the steering angle of the front wheel 3 of the tractor 1 instead of adjusting the rotation angle of the steering handle 8, and in this case, the steering handle 8 rotates even if the vehicle turns. do not do.
  • the positioning antenna 25 is configured to receive a signal from a positioning satellite 63 that constitutes a satellite positioning system (GNSS), for example.
  • GNSS satellite positioning system
  • the positioning antenna 25 is disposed on the upper surface of the roof 13 of the cabin 7.
  • the wireless communication antenna 26 is configured to transmit and receive various signals via a wireless communication network constructed with the wireless communication terminal 30 and the like.
  • the radio communication antenna 26 is disposed on the upper surface of the roof 13 of the cabin 7. As shown in FIG. 2, the signal received by the wireless communication antenna 26 can be input to the control unit 23, and the signal from the control unit 23 is transmitted to the wireless communication terminal 30 by the wireless communication antenna 26. It can be transmitted to the device 31 and the like.
  • a reference station 60 installed at a predetermined reference point is provided, and satellite positioning information of the tractor 1 (mobile station) is corrected by correction information from the reference station 60.
  • a positioning method for obtaining the current position of the tractor 1 can be applied.
  • various positioning methods such as DGPS (differential GPS positioning) and RTK positioning (real-time kinematic positioning) can be applied.
  • the reference station positioning antenna 62 is provided.
  • a provided reference station 60 is provided.
  • the reference station 60 is arranged at a position (reference point) that does not interfere with the traveling of the tractor 1, for example, around the farm field.
  • the position information of the reference point that is the installation position of the reference station 60 is set in advance.
  • the reference station 60 includes a reference station wireless communication device 61 capable of transmitting and receiving various signals via a wireless communication network constructed by the wireless communication antenna 26 of the tractor 1 and the wireless communication device 31 of the wireless communication terminal 30.
  • Various types of information can be transmitted and received between 60 and the tractor 1 and between the reference station 60 and the wireless communication terminal 30.
  • the carrier phase (satellite positioning information) from the positioning satellite 63 is measured by both the reference station 60 installed at the reference point and the positioning antenna 25 of the tractor 1 on the mobile station side whose position information is to be obtained. is doing.
  • the reference station 60 generates correction information including the measured satellite positioning information and reference point position information every time the satellite positioning information is measured from the positioning satellite 63 or every time the set period elapses, and the reference station wireless communication device
  • the correction information is transmitted from 61 to the radio communication antenna 26 of the tractor 1.
  • the control unit 23 of the tractor 1 (corresponding to the mobile station) corrects the satellite positioning information measured by the positioning antenna 25 by using the correction information transmitted from the reference station 60, and the current position information of the tractor 1 is obtained. Looking for.
  • the control unit 23 obtains, for example, latitude information / longitude information as the current position information of the tractor 1.
  • a wireless communication terminal 30 capable of instructing the control unit 23 of the tractor 1 to autonomously travel the tractor 1 is provided.
  • the wireless communication terminal 30 is composed of, for example, a tablet personal computer having a touch panel, and can display various information on the touch panel. Various information can also be input by operating the touch panel.
  • the wireless communication terminal 30 includes a wireless communication device 31 and a travel route calculation unit 32 that generates a target travel route.
  • the control unit 23 provided in the tractor 1 is configured to transmit and receive various types of information to and from the wireless communication terminal 30 via a wireless communication network including the wireless communication antenna 26 and the wireless communication device 31.
  • the wireless communication terminal 30 is configured to be able to instruct autonomous traveling of the tractor 1 by transmitting various information for autonomously traveling the tractor 1 such as a target traveling route to the control unit 23 of the tractor 1.
  • the control unit 23 (corresponding to the autonomous travel control unit) of the tractor 1 uses the received signal of the positioning antenna 25 so that the tractor 1 autonomously travels along the target travel route generated by the travel route calculation unit 32. Based on the current position information of the tractor 1 to be acquired, the governor device 21, the transmission device 22, the steering device 24, and the like can be controlled.
  • control unit 23 as an autonomous traveling control unit can control the tractor 1 to stop based on a stop instruction from the wireless communication terminal 30. Furthermore, when a predetermined condition is satisfied, the wireless communication terminal The tractor 1 can be controlled to stop without being based on the stop instruction from 30. As predetermined conditions, when communication between the positioning antenna 25 and the positioning satellite 63 is cut off, when communication of the radio communication device 31 between the radio communication antenna 26 and the radio communication terminal 30 is cut off, the radio communication antenna 26 and the case where the communication between the reference station 60 and the reference station wireless communication device 61 is interrupted.
  • the reference station 60 includes a movement detection unit 64 that can detect the movement of the reference station 60, a transmission stop unit 65 that can stop transmission of correction information from the reference station 60, and the current position of the reference station 60.
  • a reference point setting unit 66 that can be set as a new reference point is provided.
  • the wireless communication terminal 30 includes a notification unit 33 that performs a predetermined notification that suggests that the reference station 60 has moved.
  • the reference station 60 is provided with, for example, a sensor used in a satellite positioning system, and the moving speed of the reference station 60 is detected by the sensor or the like. Therefore, the movement detection unit 64 detects the movement of the reference station 60 when the movement speed is greater than zero based on the movement speed of the reference station 60 detected by this sensor or the like.
  • the sensor is not limited to a sensor used in the satellite positioning system, and any sensor that can detect the movement of the reference station 60 can be used. For example, an angular velocity sensor, a gyro sensor, or the like can be applied.
  • the movement of the reference station 60 can be detected by using the movement speed of the reference station 60 as it is. Instead, since the displacement of the reference station 60 can be obtained by integrating the moving speed with time, the movement detecting unit 64 obtains the positional displacement of the reference station 60 from the moving speed of the reference station 60, and the obtained reference station. The movement of the reference station 60 can also be detected based on the 60 position displacement. Since the position of the reference station 60 is set in advance, the current position can be specified based on the initial position and the position displacement, and the reference station 60 can be moved by comparing the initial position and the current position. It can also be detected.
  • the movement detection unit 64 uses the position information of the reference station 60 acquired by independent positioning. Based on this, the movement of the reference station 60 can be detected. Furthermore, not only the single positioning but also, for example, the position information of the reference station 60 can be obtained by RTK positioning using the reference station 60 as a mobile station using a publicly installed electronic reference point or the like. The movement of the reference station 60 can be detected based on the position information of the reference station 60 acquired by RTK positioning.
  • the transmission stop unit 65 stops transmission of correction information from the reference station 60 to the tractor 1 (mobile station) (step # 1, Step # 2).
  • the control unit 23 cannot receive the correction information from the reference station 60 and cannot acquire the correction information, thereby stopping the autonomous traveling of the tractor 1 (step # 11, step # 12). Therefore, when the movement of the reference station 60 is detected by the movement detection unit 64, the autonomous traveling of the tractor 1 is stopped, and inconveniences such as the tractor 1 greatly deviating from the target traveling route occur. Can be prevented.
  • the control unit 23 of the tractor 1 transmits information indicating that the autonomous traveling of the tractor 1 has been stopped when the movement of the reference station 60 is detected by the movement detection unit 64 to the wireless communication terminal 30.
  • the notification unit 33 performs a predetermined notification indicating that the reference station 60 has been moved (step # 21).
  • the reference station 60 when the power of the reference station 60 is once interrupted and a return operation is performed in which power is supplied to the reference station 60 again, the reference station 60 is restarted and the current position of the reference station 60 is determined based on the satellite positioning information.
  • Information is acquired (step # 3).
  • the current position information of the reference station 60 can be acquired by, for example, independent positioning based on the satellite positioning information. Further, not only the single positioning but also the current position information of the reference station 60 can be obtained by RTK positioning using, for example, a publicly installed electronic reference point.
  • the return operation can be applied not only to the operation of temporarily cutting off the power of the reference station 60 and supplying the power to the reference station 60 again, but also to other operations.
  • an operation for operating the reset function such as operating a reset button, may be a return operation.
  • the transmission stop unit 65 compares the current position of the reference station 60 acquired based on the satellite positioning information and the position of the reference point, and if the position error is within a predetermined threshold, the transmission stop unit 65 does not stop transmitting correction information.
  • the correction information is transmitted from the reference station 60 to the tractor 1 (in the case of Yes in step # 4, step # 7). Thus, even if the movement of the reference station 60 is detected, if the reference station 60 has moved slightly, correction information including the position information of the original reference point determined in advance is transmitted from the reference station 60.
  • the threshold can be set as appropriate.
  • the control unit 23 of the tractor 1 calculates the current position information of the tractor 1 using the satellite positioning information measured by the positioning antenna 25 and the correction information transmitted from the reference station 60.
  • the obtained current position information of the tractor 1 may cause an error within an allowable range that does not cause inconvenience when autonomous traveling is performed with respect to the actual position of the tractor 1. Therefore, when the position error in step # 4 is within the permissible range, there is no inconvenience in performing autonomous travel, so the threshold value can be determined based on the permissible range.
  • the reference point setting unit 66 compares the current position of the reference station 60 acquired based on the satellite positioning information with the position of the reference point, and if the position error is outside a predetermined threshold, the reference point setting unit 66 newly sets the current position of the reference station 60. Is set as a valid reference point (step # 5).
  • reference point update information indicating that the current position of the reference station 60 is set as a new reference point is transmitted to the tractor 1 (step #). 6). Then, the reference station 60 transmits correction information including the position information of the new reference point and the satellite positioning information to the tractor 1 (step # 7).
  • the reference station 60 when the reference station 60 has moved greatly from the original reference point set in advance, the current position of the reference station 60 is set as a new reference point, the reference point update information is transmitted, and a new Correction information including position information of the reference point can be transmitted from the reference station 60.
  • the control unit 23 determines whether or not a predetermined initialization operation has been performed by the user after stopping the autonomous traveling of the tractor 1 in step # 12 (step # 13).
  • the predetermined initialization work is performed, for example, by initialization work of the lifting device (operating a switch for switching ON / OFF of driving of the lifting device).
  • the control unit 23 determines whether or not the autonomous running start condition is satisfied (step # 14).
  • the predetermined initialization work in step # 13 is one of the autonomous running start conditions.
  • the autonomous running start condition for example, the current position of the tractor 1 is an autonomous running restart position determined when the autonomous running is stopped.
  • the direction of the tractor 1 with respect to the planned travel route is an appropriate direction. If the autonomous running start condition is satisfied, the autonomous running standby state is established (step # 15), and the control unit 23 causes the tractor 1 to autonomously run when the wireless communication terminal 30 instructs autonomous running.
  • the control unit 23 of the tractor 1 acquires the reference point update information from the reference station 60
  • the control unit 23 transmits the reference point update information to the wireless communication terminal 30.
  • the wireless communication terminal 30 stops the predetermined notification indicating that the reference station 60 has moved, and the reference point of the reference station 60 has been updated (set to a new position). Is given (step # 22).
  • the transmission stop unit 65 stops the transmission of the correction information, thereby stopping the autonomous traveling of the tractor 1.
  • the reference station 60 displays error status information indicating that the movement detection unit 64 has detected the movement of the reference station 60 in the wireless communication network.
  • the control unit 23 of the tractor 1 can also stop the autonomous traveling of the tractor 1 by receiving the error status information.
  • the control unit 23 of the tractor 1 transmits error information indicating that the movement detection unit 64 has detected the movement of the reference station 60 from the tractor 1 to the wireless communication terminal 30 via the wireless communication network.
  • the control unit 23 of the tractor 1 transmits error information indicating that the movement detection unit 64 has detected the movement of the reference station 60 to an external management device or the like via a wireless communication network or other network line. You can also.
  • the error information can be transmitted to the wireless communication terminal 30 from the external management device.
  • the notification unit 33 can perform predetermined notification indicating that the reference station 60 has been moved.
  • the control unit 23 of the tractor 1 cannot receive the correction information from the reference station 60 and cannot acquire the correction information.
  • the autonomous traveling of the tractor 1 is stopped. For example, when the correction information from the reference station 60 is not received once, the autonomous traveling of the tractor 1 is stopped, or the correction information from the reference station 60 exceeds the set number of times.
  • the autonomous traveling of the tractor 1 can be stopped by continuously disabling reception.
  • control unit 23 of the tractor 1 cannot receive the correction information from the reference station 60, so that the autonomous traveling of the tractor 1 is not stopped immediately, but, for example, only from the positioning satellite information acquired by itself, the tractor 1 , The autonomous traveling of the tractor 1 is once continued along the target traveling route according to the determined current position, and then the autonomous traveling of the tractor 1 is finally stopped. .
  • the control unit 23 of the tractor 1 cannot receive the correction information from the reference station 60, the current position of the tractor 1 is obtained from only the positioning satellite information acquired by itself. The current position is shifted from the actual current position of the tractor 1. And since the state which cannot receive the correction information from the reference
  • the reference point setting unit 66 compares the current position of the reference station 60 acquired based on the satellite positioning information with the position of the reference point in step # 5, and the position error is a predetermined threshold value. If the current position of the reference station 60 is set as a new reference point when it is outside, the reference point update request information is set for wireless communication before the current position of the reference station 60 is set as a new reference point. It is good also as transmitting to the radio
  • the wireless communication terminal 30 that has acquired the reference point update request information, for example, on the touch panel, the conventional position coordinates of the reference point (position coordinates before the movement of the reference station 60 is detected) and the new position coordinates of the reference station 60. And a selection screen for selecting whether or not to allow the change is displayed.
  • the reference point update permission information is transmitted to the reference station wireless communication device 61 or directly to the reference station wireless communication device 61 via the wireless communication antenna 26, and the reference station 60 Sets the current position of the reference station 60 as a new reference point based on the reference point update permission information.
  • a reference point setting screen is displayed for allowing the operator to set the reference point, and when the reference point is set by the worker, etc.,
  • the reference point designation information is transmitted to the reference station wireless communication device 61 via the wireless communication antenna 26 or directly to the reference station wireless communication device 61.
  • the reference station 60 is designated by an operator or the like based on the reference point update permission information.
  • the set position is set as a new reference point.
  • the wireless communication terminal 30 capable of instructing the autonomous traveling of the tractor 1 is provided.
  • the wireless communication terminal 30 capable of instructing the autonomous traveling of the tractor 1 is provided.
  • the control unit 23 or an external control device or the like.
  • the present invention can be applied to an autonomous traveling system that autonomously travels a work vehicle along a target travel route while acquiring position information of the work vehicle.

Landscapes

  • Engineering & Computer Science (AREA)
  • Life Sciences & Earth Sciences (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Soil Sciences (AREA)
  • Environmental Sciences (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Mechanical Engineering (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Guiding Agricultural Machines (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

A measure against a movement of a reference station from a reference point is taken to prevent inconveniences, such as a significant deviation of an operation vehicle from a target travel route. An autonomous travel system is provided with: a reference station (60) which is installed at a predetermined reference point and which transmits correction information based on positional information of the reference point and satellite positioning information; a mobile station which is mounted on an operation vehicle (1) and which calculates positional information of the operation vehicle (1) on the basis of the correction information transmitted from the reference station (60) and the satellite positioning information; and an autonomous travel control unit for causing the operation vehicle to autonomously travel along a target travel route predetermined by using the positional information of the operation vehicle (1) calculated by the mobile station. The autonomous travel system includes a movement detection unit for detecting a movement of the reference station (60), and the autonomous travel control unit stops autonomous travel of the operation vehicle (1) when the movement detection unit detects the movement of the reference station (60).

Description

自律走行システムAutonomous traveling system
 本発明は、作業車両の位置情報を取得しながら、作業車両を目標走行経路に沿って自律走行させる自律走行システムに関する。 The present invention relates to an autonomous traveling system that autonomously travels a work vehicle along a target travel route while acquiring position information of the work vehicle.
 上記のような自律走行システムでは、基準点に設置された基準局を備え、作業車両及び基準局の双方において、測位衛星からの衛星測位情報を取得している。基準局では、基準点の位置情報と取得した衛星測位情報とを含む補正情報を作業車両に送信している。作業車両では、自己が取得した衛星測位情報だけから作業車両の現在位置情報を求めるのではなく、自己が取得した衛星測位情報を、基準局から送信される補正情報を用いて補正することで、作業車両の現在位置情報を精度よく取得している。そして、求めた作業車両の現在位置情報に基づいて、作業車両が目標走行経路に沿うように自律走行させるようにしている(例えば、特許文献1参照。)。 The autonomous traveling system as described above includes a reference station installed at a reference point, and satellite positioning information is acquired from positioning satellites in both the work vehicle and the reference station. The reference station transmits correction information including the position information of the reference point and the acquired satellite positioning information to the work vehicle. The work vehicle does not obtain the current position information of the work vehicle only from the satellite positioning information acquired by itself, but corrects the satellite positioning information acquired by itself using the correction information transmitted from the reference station. The current position information of the vehicle is obtained with high accuracy. Then, based on the obtained current position information of the work vehicle, the work vehicle is allowed to autonomously travel along the target travel route (see, for example, Patent Document 1).
特開平9-128045号公報JP-A-9-128045
 上記特許文献1に記載のシステムでは、例えば、地震やその他の要因によって、基準局が基準点から移動してしまうと、基準局から送信される補正情報が誤った情報となってしまう。よって、作業車両の現在位置情報を適切に取得できず、目標走行経路から作業車両が大きく外れてしまう等の不都合を生じる可能性がある。 In the system described in Patent Document 1, for example, if the reference station moves from the reference point due to an earthquake or other factors, the correction information transmitted from the reference station becomes incorrect information. Therefore, there is a possibility that the current position information of the work vehicle cannot be acquired appropriately, and that the work vehicle is greatly deviated from the target travel route.
 この実情に鑑み、本発明の主たる課題は、基準点からの基準局の移動に対する措置を講じることで、目標走行経路から作業車両が大きく外れてしまう等の不都合が生じるのを防止できる自律走行システムを提供する点にある。 In view of this situation, the main problem of the present invention is to provide an autonomous traveling system capable of preventing inconveniences such as the work vehicle greatly deviating from the target traveling route by taking measures against movement of the reference station from the reference point. The point is to provide.
 本発明の第1特徴構成は、予め定められた基準点に設置されて前記基準点の位置情報と衛星測位情報に基づいて補正情報を送信する基準局と、
 作業車両に搭載されて前記基準局から送信される前記補正情報と衛星測位情報に基づいて前記作業車両の位置情報を演算する移動局と、
 前記移動局により演算された前記作業車両の位置情報を用いて予め定められた目標走行経路に沿って前記作業車両を自律走行させる自律走行制御部と、を備えた自律走行システムであって、
 前記基準局の移動を検知する移動検知部を備え、
 前記自律走行制御部は、前記移動検知部により前記基準局の移動が検知された場合に、前記作業車両の自律走行を停止させることを特徴とする点にある。
A first characteristic configuration of the present invention includes a reference station that is installed at a predetermined reference point and transmits correction information based on position information of the reference point and satellite positioning information;
A mobile station that is mounted on a work vehicle and calculates position information of the work vehicle based on the correction information and satellite positioning information transmitted from the reference station;
An autonomous traveling system comprising: an autonomous traveling control unit that autonomously travels the working vehicle along a predetermined traveling route using position information of the working vehicle calculated by the mobile station,
A movement detection unit for detecting movement of the reference station;
The autonomous traveling control unit is characterized in that when the movement of the reference station is detected by the movement detecting unit, the autonomous traveling of the work vehicle is stopped.
 本構成によれば、移動検知部が基準局の移動を検知すると、自律走行制御部が作業車両の自律走行を停止させる。これにより、基準局が基準点から移動すると、作業車両の自律走行を停止させるという適切な措置を講じることができ、目標走行経路から作業車両が大きく外れてしまう等の不都合が生じるのを防止できる。 According to this configuration, when the movement detection unit detects the movement of the reference station, the autonomous traveling control unit stops the autonomous traveling of the work vehicle. Accordingly, when the reference station moves from the reference point, it is possible to take an appropriate measure of stopping the autonomous traveling of the work vehicle, and it is possible to prevent inconveniences such as the work vehicle greatly deviating from the target travel route.
 本発明の第2特徴構成は、前記基準局は、前記移動検知部により前記基準局の移動が検知された場合に前記補正情報の送信を停止させる送信停止部を有し、
 前記自律走行制御部は、前記移動局が前記基準局から前記補正情報を取得できないことに基づいて前記作業車両の自律走行を停止させることを特徴とする点にある。
According to a second characteristic configuration of the present invention, the reference station has a transmission stop unit that stops transmission of the correction information when movement of the reference station is detected by the movement detection unit,
The autonomous traveling control unit is characterized in that the autonomous traveling of the work vehicle is stopped based on the fact that the mobile station cannot acquire the correction information from the reference station.
 本構成によれば、移動検知部が基準局の移動を検知すると、送信停止部が補正情報の送信を停止し、自律走行制御部が補正情報を取得できないことにより作業車両の自律走行を停止させる。これにより、送信停止部により補正情報の送信を停止させるという簡易な構成を採用するだけで、基準局の移動に対する適切な措置を講じることができる。 According to this configuration, when the movement detection unit detects the movement of the reference station, the transmission stop unit stops the transmission of the correction information, and the autonomous traveling control unit cannot acquire the correction information, thereby stopping the autonomous traveling of the work vehicle. Accordingly, it is possible to take appropriate measures against the movement of the reference station only by adopting a simple configuration in which transmission of correction information is stopped by the transmission stop unit.
 本発明の第3特徴構成は、前記送信停止部は、前記基準局に対して復帰操作がされるまで前記補正情報の送信を停止させ、前記復帰操作がされた後、衛星測位情報に基づいて特定される前記基準局の現在位置と前記基準点の位置とを比較してその位置誤差が所定の閾値内であれば、前記補正情報の送信を停止しないことを特徴とする点にある。 According to a third characteristic configuration of the present invention, the transmission stop unit stops transmission of the correction information until a return operation is performed on the reference station, and is specified based on satellite positioning information after the return operation is performed. The current position of the reference station and the position of the reference point are compared, and if the position error is within a predetermined threshold, transmission of the correction information is not stopped.
 本構成によれば、送信停止部は、基準局に対して復帰操作がされるまで補正情報の送信を停止させるので、復帰操作がされるまでは作業車両の自律走行を停止させた状態に維持できる。よって、目標走行経路から作業車両が大きく外れてしまう等の不都合が生じるのを確実に防止できる。 According to this configuration, the transmission stop unit stops the transmission of the correction information until the return operation is performed with respect to the reference station. Therefore, the autonomous traveling of the work vehicle can be stopped until the return operation is performed. . Therefore, it is possible to reliably prevent inconveniences such as the work vehicle greatly deviating from the target travel route.
 そして、基準局の移動を検知しても、例えば、僅かに移動しただけであれば、そのまま基準局から補正情報を送信しても、作業車両の現在位置情報を適切に取得することができる。そこで、送信停止部は、復帰操作がされた後、基準局の現在位置と基準点の位置とを比較してその位置誤差が所定の閾値内であれば、基準局が僅かに移動しただけであるとして、補正情報の送信を停止せずに、基準局から補正情報が送信される。よって、作業車両の現在位置情報を適切に取得できることを確認した上で、作業車両の自律走行を再開することができる。 And even if the movement of the reference station is detected, for example, if the movement is only slight, the current position information of the work vehicle can be appropriately acquired even if the correction information is transmitted as it is from the reference station. Therefore, the transmission stop unit compares the current position of the reference station with the position of the reference point after the return operation is performed, and if the position error is within a predetermined threshold, the reference station is only moved slightly. The correction information is transmitted from the reference station without stopping the transmission of the correction information. Therefore, the autonomous traveling of the work vehicle can be resumed after confirming that the current position information of the work vehicle can be appropriately acquired.
 本発明の第4特徴構成は、前記基準局は、前記基準局に対する復帰操作がされた後、衛星測位情報に基づいて特定される前記基準局の現在位置と前記基準点の位置とを比較してその位置誤差が所定の閾値外である場合に、前記基準局の現在位置を新たな基準点として設定する基準点設定部を備え、
 前記送信停止部は、前記基準点設定部により前記基準局の現在位置が新たな基準点として設定されると、前記補正情報の送信を停止しないことを特徴とする点にある。
According to a fourth characteristic configuration of the present invention, the reference station compares the current position of the reference station specified based on satellite positioning information with the position of the reference point after the return operation to the reference station is performed. A reference point setting unit that sets the current position of the reference station as a new reference point when the error is outside a predetermined threshold;
The transmission stop unit does not stop the transmission of the correction information when the current position of the reference station is set as a new reference point by the reference point setting unit.
 例えば、基準局が予め定められた元々の基準点から大きく移動していると、その基準点の位置情報を含む補正情報を基準局から送信しても、作業車両の現在位置情報を適切に取得することができない。そこで、基準点設定部は、復帰操作がされた後、基準局の現在位置と基準点の位置とを比較してその位置誤差が所定の閾値外である場合に、基準局が予め定められた元々の基準点から大きく移動しているとして、基準局の現在位置を新たな基準点として設定する。送信停止部は、基準点設定部により新たな基準点が設定されると、補正情報の送信を停止せず、基準局では、新たに設定された基準点の位置情報を含む補正情報を送信することができる。よって、基準局が予め定められた元々の基準点から大きく移動していた場合でも、その後、作業車両の現在位置情報を適切に取得することができ、作業車両の自律走行を適切に再開することができる。 For example, if the reference station has moved greatly from a predetermined original reference point, the current position information of the work vehicle can be appropriately acquired even if correction information including the position information of the reference point is transmitted from the reference station. I can't. Therefore, after the return operation is performed, the reference point setting unit compares the current position of the reference station with the position of the reference point, and if the position error is outside a predetermined threshold, the reference station is Assuming that there is a large movement from the reference point, the current position of the reference station is set as a new reference point. When a new reference point is set by the reference point setting unit, the transmission stop unit does not stop transmission of correction information, and the reference station transmits correction information including position information of the newly set reference point. Can do. Therefore, even when the reference station has moved greatly from the original reference point set in advance, the current position information of the work vehicle can be acquired appropriately, and the autonomous traveling of the work vehicle can be resumed appropriately. it can.
 本発明の第5特徴構成は、無線通信ネットワークを介して前記自律走行制御部に前記作業車両の自律走行を指示可能な無線通信端末を備え、
 前記無線通信端末は、前記移動検知部により前記基準局の移動が検知された場合に、前記基準局が移動されたことを示唆する所定の報知を行うことを特徴とする点にある。
A fifth characteristic configuration of the present invention includes a wireless communication terminal capable of instructing the autonomous traveling control unit to autonomously travel the work vehicle via a wireless communication network,
The wireless communication terminal is characterized in that, when movement of the reference station is detected by the movement detection unit, a predetermined notification indicating that the reference station has been moved is performed.
 本構成によれば、無線通信端末は、移動検知部により基準局の移動が検知されると、その基準局の移動を示唆する所定の報知を行うので、作業者等が基準局の移動を容易に認識することができ、例えば、基準局に対する復帰操作等、基準局の移動に対する対処を適切に且つスムーズに行うことができる。 According to this configuration, when the movement detection unit detects the movement of the reference station, the wireless communication terminal performs a predetermined notification that suggests the movement of the reference station, so that an operator or the like can easily recognize the movement of the reference station. For example, it is possible to appropriately and smoothly cope with the movement of the reference station such as a return operation for the reference station.
トラクタの全体側面図Overall side view of tractor トラクタ、基準局、及び、無線通信端末の制御ブロック図Control block diagram of tractor, reference station, and wireless communication terminal 基準局の移動を検知した場合のトラクタ、基準局、及び、無線通信端末における動作を示すタイムチャートTime chart showing operations in tractor, reference station, and wireless communication terminal when movement of reference station is detected
 本発明に係る自律走行システムの実施形態を図面に基づいて説明する。
 この自律走行システムは、目標走行経路を生成し、その生成された目標走行経路に沿って作業車両としてのトラクタ1を自律走行可能に構成されている。
An embodiment of an autonomous traveling system according to the present invention will be described with reference to the drawings.
This autonomous traveling system is configured to generate a target traveling route and to autonomously travel the tractor 1 as a work vehicle along the generated target traveling route.
 まず、図1に基づいてトラクタ1について説明する。
 このトラクタ1は、後方側に作業機50を装着可能な車体部2を備え、車体部2の前部が左右一対の前輪3で支持され、車体部2の後部が左右一対の後輪4で支持されている。車体部2の前部にはボンネット5が配置され、そのボンネット5内に駆動源としてのエンジン6が収容されている。ボンネット5の後方側には、運転者が搭乗するためのキャビン7が備えられ、そのキャビン7内には、運転者が操向操作するためのステアリングハンドル8、運転者の運転座席9等が備えられている。
First, the tractor 1 will be described with reference to FIG.
The tractor 1 includes a vehicle body portion 2 on which a work machine 50 can be mounted on the rear side, the front portion of the vehicle body portion 2 is supported by a pair of left and right front wheels 3, and the rear portion of the vehicle body portion 2 is a pair of left and right rear wheels 4. It is supported. A bonnet 5 is disposed in the front part of the vehicle body 2, and an engine 6 as a drive source is accommodated in the bonnet 5. A cabin 7 for a driver to board is provided on the rear side of the bonnet 5, and a steering handle 8 for a driver to steer and a driver's driving seat 9 are provided in the cabin 7. It has been.
 エンジン6は、例えばディーゼルエンジンにより構成することができるが、これに限るものではなく、例えばガソリンエンジンにより構成してもよい。また、駆動源としてエンジン6に加えて、或いはエンジン6に代えて、電気モータを採用してもよい。 The engine 6 can be composed of, for example, a diesel engine, but is not limited thereto, and may be composed of, for example, a gasoline engine. Further, an electric motor may be employed as a drive source in addition to the engine 6 or instead of the engine 6.
 また、本実施形態では作業車両としてトラクタ1を例に説明するが、作業車両としては、トラクタの他、田植機、コンバイン、土木・建築作業装置、除雪車等、乗用型作業車両に加え、歩行型作業車両も含まれる。 In this embodiment, the tractor 1 will be described as an example of a work vehicle. As the work vehicle, in addition to a tractor, a walking machine in addition to a riding work vehicle such as a rice transplanter, a combiner, a civil engineering / construction work device, a snowplow, A type work vehicle is also included.
 車体部2の後方側には、左右一対のロアリンク10とアッパリンク11とからなる3点リンク機構が備えられ、その3点リンク機構に作業機50が装着可能に構成されている。車体部2の後方側には、図示は省略するが、昇降シリンダ等の油圧装置を有する昇降装置が備えられ、この昇降装置が、3点リンク機構を昇降させることで、作業機50を昇降させている。 A three-point link mechanism including a pair of left and right lower links 10 and an upper link 11 is provided on the rear side of the vehicle body portion 2, and the working machine 50 can be mounted on the three-point link mechanism. Although not shown, a lifting device having a hydraulic device such as a lifting cylinder is provided on the rear side of the vehicle body 2, and this lifting device lifts and lowers the work implement 50 by lifting and lowering the three-point link mechanism. ing.
 ここで、作業機50について、図1では、耕耘装置を装着した場合を例示しているが、耕耘装置に限らず、プラウ、施肥装置等、各種の作業機を適用することができる。 Here, with respect to the working machine 50, FIG. 1 illustrates the case where a tilling device is mounted, but not only the tilling device but various working machines such as a plow and a fertilizer can be applied.
 トラクタ1には、図2に示すように、エンジン6の回転速度を調整可能なガバナ装置21、エンジン6からの回転駆動力を変速して駆動輪に伝達する変速装置22、ガバナ装置21および変速装置22を制御可能な制御部23等が備えられている。変速装置22は、例えば、油圧式無段変速装置からなる主変速装置とギヤ式多段変速装置からなる副変速装置とを組み合わせて構成されている。 As shown in FIG. 2, the tractor 1 includes a governor device 21 that can adjust the rotational speed of the engine 6, a transmission device 22 that shifts the rotational driving force from the engine 6 and transmits it to the drive wheels, the governor device 21, A control unit 23 and the like that can control the device 22 are provided. The transmission 22 is configured by combining, for example, a main transmission composed of a hydraulic continuously variable transmission and an auxiliary transmission composed of a gear type multi-stage transmission.
 このトラクタ1は、運転者がキャビン7内に搭乗して走行できるだけでなく、キャビン7内に運転者が搭乗しなくても、無線通信端末30からの指示等に基づいて、トラクタ1を自律走行可能に構成している。 The tractor 1 not only allows the driver to travel in the cabin 7, but also allows the tractor 1 to autonomously travel based on instructions from the wireless communication terminal 30 even if the driver does not board the cabin 7. It is configured as possible.
 トラクタ1は、図2に示すように、操舵装置24、測位用アンテナ25、無線通信用アンテナ26等を備えており、自己の現在位置情報(車体部2の位置情報)を取得しながら、自律走行可能に構成されている。 As shown in FIG. 2, the tractor 1 includes a steering device 24, a positioning antenna 25, a wireless communication antenna 26, and the like, and autonomously acquires its current position information (position information of the vehicle body 2). It is configured to be able to run.
 操舵装置24は、例えば、ステアリングハンドル8の回転軸の途中部に備えられ、ステアリングハンドル8の回転角度(操舵角)を調整可能に構成されている。制御部23が操舵装置24を制御することで、直進走行だけでなく、ステアリングハンドル8の回転角度を所望の回転角度に調整して、所望の旋回半径での旋回走行も行える。なお、操舵装置24はステアリングハンドル8の回転角度を調整するものでなくトラクタ1の前輪3の操舵角を調整するものであってよく、この場合、旋回走行を行ったとしてもステアリングハンドル8は回転しない。 The steering device 24 is provided, for example, in the middle of the rotation shaft of the steering handle 8 and is configured to be able to adjust the rotation angle (steering angle) of the steering handle 8. When the control unit 23 controls the steering device 24, not only the straight traveling but also the turning angle of the steering handle 8 can be adjusted to a desired turning angle, and the turning turning with the desired turning radius can be performed. The steering device 24 may adjust the steering angle of the front wheel 3 of the tractor 1 instead of adjusting the rotation angle of the steering handle 8, and in this case, the steering handle 8 rotates even if the vehicle turns. do not do.
 測位用アンテナ25は、図1に示すように、例えば、衛星測位システム(GNSS)を構成する測位衛星63からの信号を受信するように構成されている。測位用アンテナ25は、キャビン7のルーフ13の上面に配置されている。 As shown in FIG. 1, the positioning antenna 25 is configured to receive a signal from a positioning satellite 63 that constitutes a satellite positioning system (GNSS), for example. The positioning antenna 25 is disposed on the upper surface of the roof 13 of the cabin 7.
 無線通信用アンテナ26は、無線通信端末30等との間で構築される無線通信ネットワークを介して各種の信号を送受信可能に構成されている。無線通信用アンテナ26は、キャビン7のルーフ13の上面に配置されている。無線通信用アンテナ26にて受信した信号は、図2に示すように、制御部23に入力可能であり、制御部23からの信号は、無線通信用アンテナ26にて無線通信端末30の無線通信装置31等に送信可能に構成されている。 The wireless communication antenna 26 is configured to transmit and receive various signals via a wireless communication network constructed with the wireless communication terminal 30 and the like. The radio communication antenna 26 is disposed on the upper surface of the roof 13 of the cabin 7. As shown in FIG. 2, the signal received by the wireless communication antenna 26 can be input to the control unit 23, and the signal from the control unit 23 is transmitted to the wireless communication terminal 30 by the wireless communication antenna 26. It can be transmitted to the device 31 and the like.
 ここで、衛星測位システムを用いた測位方法として、予め定められた基準点に設置された基準局60を備え、その基準局60からの補正情報によりトラクタ1(移動局)の衛星測位情報を補正して、トラクタ1の現在位置を求める測位方法を適用可能としている。例えば、DGPS(ディファレンシャルGPS測位)、RTK測位(リアルタイムキネマティック測位)等の各種の測位方法を適用することができる。 Here, as a positioning method using the satellite positioning system, a reference station 60 installed at a predetermined reference point is provided, and satellite positioning information of the tractor 1 (mobile station) is corrected by correction information from the reference station 60. A positioning method for obtaining the current position of the tractor 1 can be applied. For example, various positioning methods such as DGPS (differential GPS positioning) and RTK positioning (real-time kinematic positioning) can be applied.
 この実施形態では、例えば、RTK測位を適用しており、図1及び図2に示すように、移動局側となるトラクタ1に測位用アンテナ25を備えるのに加えて、基準局測位用アンテナ62を備えた基準局60が備えられている。基準局60は、例えば、圃場の周囲等、トラクタ1の走行の邪魔にならない位置(基準点)に配置されている。基準局60の設置位置となる基準点の位置情報は予め設定されている。基準局60には、トラクタ1の無線通信用アンテナ26や無線通信端末30の無線通信装置31により構築される無線通信ネットワークを介して各種の信号を送受信可能な基準局無線通信装置61が備えられ、基準局60とトラクタ1との間や基準局60と無線通信端末30との間で各種の情報が送受信可能に構成されている。 In this embodiment, for example, RTK positioning is applied, and as shown in FIGS. 1 and 2, in addition to providing the positioning antenna 25 on the tractor 1 on the mobile station side, the reference station positioning antenna 62 is provided. A provided reference station 60 is provided. The reference station 60 is arranged at a position (reference point) that does not interfere with the traveling of the tractor 1, for example, around the farm field. The position information of the reference point that is the installation position of the reference station 60 is set in advance. The reference station 60 includes a reference station wireless communication device 61 capable of transmitting and receiving various signals via a wireless communication network constructed by the wireless communication antenna 26 of the tractor 1 and the wireless communication device 31 of the wireless communication terminal 30. Various types of information can be transmitted and received between 60 and the tractor 1 and between the reference station 60 and the wireless communication terminal 30.
 RTK測位では、基準点に設置された基準局60と、位置情報を求める対象の移動局側となるトラクタ1の測位用アンテナ25との両方で測位衛星63からの搬送波位相(衛星測位情報)を測定している。基準局60では、測位衛星63から衛星測位情報を測定する毎に又は設定周期が経過する毎に、測定した衛星測位情報と基準点の位置情報等を含む補正情報を生成して、基準局無線通信装置61からトラクタ1の無線通信用アンテナ26に補正情報を送信している。トラクタ1(移動局に相当する)の制御部23は、測位用アンテナ25にて測定した衛星測位情報を、基準局60から送信される補正情報を用いて補正して、トラクタ1の現在位置情報を求めている。制御部23は、トラクタ1の現在位置情報として、例えば、緯度情報・経度情報を求めている。 In RTK positioning, the carrier phase (satellite positioning information) from the positioning satellite 63 is measured by both the reference station 60 installed at the reference point and the positioning antenna 25 of the tractor 1 on the mobile station side whose position information is to be obtained. is doing. The reference station 60 generates correction information including the measured satellite positioning information and reference point position information every time the satellite positioning information is measured from the positioning satellite 63 or every time the set period elapses, and the reference station wireless communication device The correction information is transmitted from 61 to the radio communication antenna 26 of the tractor 1. The control unit 23 of the tractor 1 (corresponding to the mobile station) corrects the satellite positioning information measured by the positioning antenna 25 by using the correction information transmitted from the reference station 60, and the current position information of the tractor 1 is obtained. Looking for. The control unit 23 obtains, for example, latitude information / longitude information as the current position information of the tractor 1.
 自律走行システムでは、トラクタ1及び基準局60に加えて、トラクタ1の制御部23にトラクタ1の自律走行を指示可能な無線通信端末30が備えられている。無線通信端末30は、例えば、タッチパネルを有するタブレット型のパーソナルコンピュータ等から構成され、各種情報をタッチパネルに表示可能であり、タッチパネルを操作することで、各種の情報も入力可能となっている。無線通信端末30には、無線通信装置31と、目標走行経路を生成する走行経路演算部32とが備えられている。 In the autonomous traveling system, in addition to the tractor 1 and the reference station 60, a wireless communication terminal 30 capable of instructing the control unit 23 of the tractor 1 to autonomously travel the tractor 1 is provided. The wireless communication terminal 30 is composed of, for example, a tablet personal computer having a touch panel, and can display various information on the touch panel. Various information can also be input by operating the touch panel. The wireless communication terminal 30 includes a wireless communication device 31 and a travel route calculation unit 32 that generates a target travel route.
 トラクタ1に備えられた制御部23は、無線通信用アンテナ26や無線通信装置31等による無線通信ネットワークを介して、無線通信端末30との間で各種の情報を送受信可能に構成されている。無線通信端末30は、目標走行経路等、トラクタ1を自律走行させるための各種の情報をトラクタ1の制御部23に送信することで、トラクタ1の自律走行を指示可能に構成されている。トラクタ1の制御部23(自律走行制御部に相当する)は、走行経路演算部32にて生成された目標走行経路に沿ってトラクタ1が自律走行するように、測位用アンテナ25の受信信号から取得するトラクタ1の現在位置情報に基づいてガバナ装置21、変速装置22及び操舵装置24等を制御可能に構成されている。 The control unit 23 provided in the tractor 1 is configured to transmit and receive various types of information to and from the wireless communication terminal 30 via a wireless communication network including the wireless communication antenna 26 and the wireless communication device 31. The wireless communication terminal 30 is configured to be able to instruct autonomous traveling of the tractor 1 by transmitting various information for autonomously traveling the tractor 1 such as a target traveling route to the control unit 23 of the tractor 1. The control unit 23 (corresponding to the autonomous travel control unit) of the tractor 1 uses the received signal of the positioning antenna 25 so that the tractor 1 autonomously travels along the target travel route generated by the travel route calculation unit 32. Based on the current position information of the tractor 1 to be acquired, the governor device 21, the transmission device 22, the steering device 24, and the like can be controlled.
 また、自律走行制御部としての制御部23は、無線通信端末30からの停止指示に基づいてトラクタ1を停止制御することが可能であり、更に、所定条件が成立した場合には、無線通信端末30からの停止指示に基づかずにトラクタ1を停止制御することが可能である。所定条件としては、測位用アンテナ25と測位衛星63との通信が遮断された場合、無線通信用アンテナ26と無線通信端末30との無線通信装置31の通信が遮断された場合、無線通信用アンテナ26と基準局60の基準局無線通信装置61との通信が遮断された場合が挙げられる。所定条件としては他に、無線通信用アンテナ26と基準局60の基準局無線通信装置61との通信は遮断されていないものの、基準局無線通信装置61から補正情報が送信(出力)されなくなった場合、言い換えれば無線通信用アンテナ26が補正情報を受信(入力)しなくなった場合が含まれる。また、所定条件としては他に、目標走行経路に対してトラクタ1の現在位置が逸脱している場合(目標走行経路におけるトラクタ1の進行方向に垂直な方向に対するトラクタ1の横偏差が所定の閾値以上である場合)が挙げられる。 Further, the control unit 23 as an autonomous traveling control unit can control the tractor 1 to stop based on a stop instruction from the wireless communication terminal 30. Furthermore, when a predetermined condition is satisfied, the wireless communication terminal The tractor 1 can be controlled to stop without being based on the stop instruction from 30. As predetermined conditions, when communication between the positioning antenna 25 and the positioning satellite 63 is cut off, when communication of the radio communication device 31 between the radio communication antenna 26 and the radio communication terminal 30 is cut off, the radio communication antenna 26 and the case where the communication between the reference station 60 and the reference station wireless communication device 61 is interrupted. In addition to the predetermined conditions, communication between the radio communication antenna 26 and the reference station radio communication device 61 of the reference station 60 is not interrupted, but correction information is not transmitted (output) from the reference station radio communication device 61, in other words. For example, a case where the wireless communication antenna 26 no longer receives (inputs) the correction information is included. In addition, as another predetermined condition, when the current position of the tractor 1 deviates from the target travel route (the lateral deviation of the tractor 1 with respect to the direction perpendicular to the traveling direction of the tractor 1 on the target travel route is a predetermined threshold value) (If it is above).
 上記構成を基礎として本実施形態の自律走行システムにおける特徴的事項について説明する。
 トラクタ1の制御部23が無線通信端末30からの指示によりトラクタ1の自律走行を行っている場合に、例えば、地震やその他の要因によって、基準局60が基準点から移動してしまうと、基準局60からトラクタ1(移動局)に送信される補正情報が誤った情報となる。よって、トラクタ1の現在位置情報を適切に取得できなくなり、目標走行経路からトラクタ1が大きく外れてしまう等の不都合が生じる可能性がある。そこで、基準局60が移動された場合の措置を講じており、以下、その措置について説明する。
Characteristic items in the autonomous traveling system of the present embodiment will be described based on the above configuration.
When the control unit 23 of the tractor 1 performs autonomous traveling of the tractor 1 according to an instruction from the wireless communication terminal 30, for example, if the reference station 60 moves from the reference point due to an earthquake or other factors, the reference station 60 The correction information transmitted from to the tractor 1 (mobile station) is incorrect information. Therefore, the current position information of the tractor 1 cannot be appropriately acquired, and there is a possibility that inconveniences such as the tractor 1 greatly deviating from the target travel route may occur. Therefore, measures are taken when the reference station 60 is moved, and the measures will be described below.
 図2に示すように、基準局60には、基準局60の移動を検知可能な移動検知部64と、基準局60からの補正情報の送信を停止可能な送信停止部65と、基準局60の現在位置を新たな基準点として設定可能な基準点設定部66とが備えられている。また、無線通信端末30には、基準局60が移動されたことを示唆する所定の報知を行う報知部33が備えられている。 As shown in FIG. 2, the reference station 60 includes a movement detection unit 64 that can detect the movement of the reference station 60, a transmission stop unit 65 that can stop transmission of correction information from the reference station 60, and the current position of the reference station 60. A reference point setting unit 66 that can be set as a new reference point is provided. In addition, the wireless communication terminal 30 includes a notification unit 33 that performs a predetermined notification that suggests that the reference station 60 has moved.
 基準局60には、例えば、衛星測位システムに用いられるセンサ等が備えられており、そのセンサ等により基準局60の移動速度を検知している。そこで、移動検知部64は、このセンサ等により検知する基準局60の移動速度に基づいて、その移動速度がゼロよりも大きいと、基準局60の移動を検知している。ちなみに、衛星測位システムに用いられるセンサ等に限らず、基準局60の移動を検知できるものであればよく、例えば、角速度センサやジャイロセンサ等を適用することも可能である。 The reference station 60 is provided with, for example, a sensor used in a satellite positioning system, and the moving speed of the reference station 60 is detected by the sensor or the like. Therefore, the movement detection unit 64 detects the movement of the reference station 60 when the movement speed is greater than zero based on the movement speed of the reference station 60 detected by this sensor or the like. Incidentally, the sensor is not limited to a sensor used in the satellite positioning system, and any sensor that can detect the movement of the reference station 60 can be used. For example, an angular velocity sensor, a gyro sensor, or the like can be applied.
 上述の如く、基準局60の移動速度を検知する場合には、基準局60の移動速度をそのまま用いることで、基準局60の移動を検知することができる。これに代えて、移動速度を時間で積分することにより基準局60の位置変位を求めることができるので、移動検知部64は、基準局60の移動速度から基準局60の位置変位を求め、その求めた基準局60の位置変位に基づいて、基準局60の移動を検知することもできる。なお、基準局60の位置は予め設定されているため、当該初期位置と位置変位に基づいて現在の位置を特定することができ、初期位置と現在の位置とを比較することで基準局60の移動を検知することもできる。 As described above, when the movement speed of the reference station 60 is detected, the movement of the reference station 60 can be detected by using the movement speed of the reference station 60 as it is. Instead, since the displacement of the reference station 60 can be obtained by integrating the moving speed with time, the movement detecting unit 64 obtains the positional displacement of the reference station 60 from the moving speed of the reference station 60, and the obtained reference station. The movement of the reference station 60 can also be detected based on the 60 position displacement. Since the position of the reference station 60 is set in advance, the current position can be specified based on the initial position and the position displacement, and the reference station 60 can be moved by comparing the initial position and the current position. It can also be detected.
 また、上述のセンサ等とは別に、衛星測位システムを用いた単独測位により基準局60の位置情報を取得することができるので、移動検知部64は、単独測位により取得された基準局60の位置情報に基づいて、基準局60の移動を検知することができる。更に、単独測位に限らず、例えば、公共設置されている電子基準点等を用いて基準局60を移動局として、RTK測位により基準局60の位置情報を取得することもできるので、移動検知部64は、RTK測位により取得された基準局60の位置情報に基づいて、基準局60の移動を検知することができる。 In addition, since the position information of the reference station 60 can be acquired by independent positioning using a satellite positioning system separately from the above-described sensors and the like, the movement detection unit 64 uses the position information of the reference station 60 acquired by independent positioning. Based on this, the movement of the reference station 60 can be detected. Furthermore, not only the single positioning but also, for example, the position information of the reference station 60 can be obtained by RTK positioning using the reference station 60 as a mobile station using a publicly installed electronic reference point or the like. The movement of the reference station 60 can be detected based on the position information of the reference station 60 acquired by RTK positioning.
 図3に基づいて、移動検知部64により基準局60の移動が検知された場合に、基準局60、トラクタ1、無線通信端末30の夫々における動作について説明する。 Based on FIG. 3, operations of the reference station 60, the tractor 1, and the wireless communication terminal 30 when the movement detection unit 64 detects the movement of the reference station 60 will be described.
 まず、基準局60では、移動検知部64により基準局60の移動が検知されると、送信停止部65が、基準局60からトラクタ1(移動局)への補正情報の送信を停止する(ステップ#1、ステップ#2)。これにより、トラクタ1では、制御部23が、基準局60からの補正情報を受信不可となり、補正情報を取得できないことにより、トラクタ1の自律走行を停止させる(ステップ#11、ステップ#12)。よって、移動検知部64により基準局60の移動が検知された場合には、トラクタ1の自律走行が停止されることになり、目標走行経路からトラクタ1が大きく外れてしまう等の不都合が生じるのを防止できる。 First, in the reference station 60, when the movement detector 64 detects the movement of the reference station 60, the transmission stop unit 65 stops transmission of correction information from the reference station 60 to the tractor 1 (mobile station) (step # 1, Step # 2). As a result, in the tractor 1, the control unit 23 cannot receive the correction information from the reference station 60 and cannot acquire the correction information, thereby stopping the autonomous traveling of the tractor 1 (step # 11, step # 12). Therefore, when the movement of the reference station 60 is detected by the movement detection unit 64, the autonomous traveling of the tractor 1 is stopped, and inconveniences such as the tractor 1 greatly deviating from the target traveling route occur. Can be prevented.
 トラクタ1の制御部23は、移動検知部64により基準局60の移動が検知されたことによりトラクタ1の自律走行を停止させたことを示す情報を無線通信端末30に送信する。無線通信端末30では、その情報を受信すると、報知部33により基準局60が移動されたことを示唆する所定の報知を行う(ステップ#21)。 The control unit 23 of the tractor 1 transmits information indicating that the autonomous traveling of the tractor 1 has been stopped when the movement of the reference station 60 is detected by the movement detection unit 64 to the wireless communication terminal 30. When the wireless communication terminal 30 receives the information, the notification unit 33 performs a predetermined notification indicating that the reference station 60 has been moved (step # 21).
 基準局60では、基準局60の電力が一旦遮断されて、再度基準局60に電力が供給されるという復帰操作が行われると、基準局60が再起動して、衛星測位情報に基づいて基準局60の現在位置情報を取得する(ステップ#3)。この基準局60の現在位置情報の取得は、例えば、衛星測位情報に基づいて単独測位により、基準局60の現在位置情報を取得することができる。また、単独測位に限らず、例えば、公共設置されている電子基準点等を用いて、RTK測位により基準局60の現在位置情報を取得することもできる。 In the reference station 60, when the power of the reference station 60 is once interrupted and a return operation is performed in which power is supplied to the reference station 60 again, the reference station 60 is restarted and the current position of the reference station 60 is determined based on the satellite positioning information. Information is acquired (step # 3). The current position information of the reference station 60 can be acquired by, for example, independent positioning based on the satellite positioning information. Further, not only the single positioning but also the current position information of the reference station 60 can be obtained by RTK positioning using, for example, a publicly installed electronic reference point.
 ここで、復帰操作は、基準局60の電力を一旦遮断して、再度基準局60に電力を供給するという操作だけでなく、その他の操作も適用することができる。例えば、基準局60にリセット機能が備えられている場合には、例えば、リセットボタンを操作する等、そのリセット機能を作動させるための操作を復帰操作とすることもできる。 Here, the return operation can be applied not only to the operation of temporarily cutting off the power of the reference station 60 and supplying the power to the reference station 60 again, but also to other operations. For example, when the reference station 60 is provided with a reset function, for example, an operation for operating the reset function, such as operating a reset button, may be a return operation.
 送信停止部65は、衛星測位情報に基づいて取得した基準局60の現在位置と基準点の位置とを比較してその位置誤差が所定の閾値内であれば、補正情報の送信を停止せずに、基準局60からトラクタ1に補正情報が送信される(ステップ#4のYesの場合、ステップ#7)。これにより、基準局60の移動を検知しても、基準局60が僅かに移動しただけの場合には、予め定められた元々の基準点の位置情報を含む補正情報が基準局60から送信される。 The transmission stop unit 65 compares the current position of the reference station 60 acquired based on the satellite positioning information and the position of the reference point, and if the position error is within a predetermined threshold, the transmission stop unit 65 does not stop transmitting correction information. The correction information is transmitted from the reference station 60 to the tractor 1 (in the case of Yes in step # 4, step # 7). Thus, even if the movement of the reference station 60 is detected, if the reference station 60 has moved slightly, correction information including the position information of the original reference point determined in advance is transmitted from the reference station 60.
 ちなみに、閾値については適宜設定することができる。上述したようにトラクタ1の制御部23は、測位用アンテナ25にて測定した衛星測位情報と、基準局60から送信される補正情報を用いてトラクタ1の現在位置情報を演算するが、演算して求めたトラクタ1の現在位置情報は、トラクタ1の実際の位置に対して自律走行を行うのに不都合が生じない許容範囲内の誤差が生じうる。従って、ステップ#4における位置誤差が当該許容範囲内である場合、自律走行を行うのに不都合が生じないため、閾値は当該許容範囲に基づいて定めることが可能である。 Incidentally, the threshold can be set as appropriate. As described above, the control unit 23 of the tractor 1 calculates the current position information of the tractor 1 using the satellite positioning information measured by the positioning antenna 25 and the correction information transmitted from the reference station 60. The obtained current position information of the tractor 1 may cause an error within an allowable range that does not cause inconvenience when autonomous traveling is performed with respect to the actual position of the tractor 1. Therefore, when the position error in step # 4 is within the permissible range, there is no inconvenience in performing autonomous travel, so the threshold value can be determined based on the permissible range.
 基準点設定部66は、衛星測位情報に基づいて取得した基準局60の現在位置と基準点の位置とを比較してその位置誤差が所定の閾値外である場合に、基準局60の現在位置を新たな基準点として設定する(ステップ#5)。基準局60では、基準点設定部66にて新たに基準点が設定されると、基準局60の現在位置を新たな基準点として設定したことを示す基準点更新情報をトラクタ1に送信する(ステップ#6)。そして、基準局60では、その新たな基準点の位置情報と衛星測位情報とを含む補正情報をトラクタ1に送信する(ステップ#7)。これにより、基準局60が予め定められた元々の基準点から大きく移動している場合には、基準局60の現在位置を新たな基準点として設定して、基準点更新情報を送信するとともに、新たな基準点の位置情報を含む補正情報を基準局60から送信することができる。 The reference point setting unit 66 compares the current position of the reference station 60 acquired based on the satellite positioning information with the position of the reference point, and if the position error is outside a predetermined threshold, the reference point setting unit 66 newly sets the current position of the reference station 60. Is set as a valid reference point (step # 5). In the reference station 60, when a new reference point is set by the reference point setting unit 66, reference point update information indicating that the current position of the reference station 60 is set as a new reference point is transmitted to the tractor 1 (step #). 6). Then, the reference station 60 transmits correction information including the position information of the new reference point and the satellite positioning information to the tractor 1 (step # 7). Thereby, when the reference station 60 has moved greatly from the original reference point set in advance, the current position of the reference station 60 is set as a new reference point, the reference point update information is transmitted, and a new Correction information including position information of the reference point can be transmitted from the reference station 60.
 トラクタ1では、制御部23が、ステップ#12においてトラクタ1の自律走行を停止した後、ユーザにより所定の初期化作業が行われたかを判定する(ステップ#13)。所定の初期化作業は、例えば昇降装置の初期化作業(昇降装置の駆動のON/OFFを切り換えるスイッチを操作すること)により行われる。ステップ#13において所定の初期化作業が行われると(ステップ#13のYESの場合)、制御部23は、自律走行開始条件が成立したか否かを判定する(ステップ#14)。ステップ#13における所定の初期化作業は自律走行開始条件の一つであり、自律走行開始条件としては、例えば、トラクタ1の現在位置が自律走行の停止時に定められる自律走行再開位置であることや、予定走行経路に対するトラクタ1の方位が適切な方位であることが含まれる。そして自律走行開始条件が成立していれば自律走行待機状態となり(ステップ#15)、制御部23は無線通信端末30から自律走行を指示されることによってトラクタ1を自律走行させる。 In the tractor 1, the control unit 23 determines whether or not a predetermined initialization operation has been performed by the user after stopping the autonomous traveling of the tractor 1 in step # 12 (step # 13). The predetermined initialization work is performed, for example, by initialization work of the lifting device (operating a switch for switching ON / OFF of driving of the lifting device). When a predetermined initialization operation is performed in step # 13 (in the case of YES in step # 13), the control unit 23 determines whether or not the autonomous running start condition is satisfied (step # 14). The predetermined initialization work in step # 13 is one of the autonomous running start conditions. As the autonomous running start condition, for example, the current position of the tractor 1 is an autonomous running restart position determined when the autonomous running is stopped. In addition, the direction of the tractor 1 with respect to the planned travel route is an appropriate direction. If the autonomous running start condition is satisfied, the autonomous running standby state is established (step # 15), and the control unit 23 causes the tractor 1 to autonomously run when the wireless communication terminal 30 instructs autonomous running.
 トラクタ1の制御部23は、基準局60から基準点更新情報を取得した場合、当該基準点更新情報を無線通信端末30に送信する。無線通信端末30では、その情報を受信すると、基準局60が移動されたことを示唆する所定の報知を停止して、基準局60の基準点が更新されたこと(新たな位置に設定されたこと)を示す所定の報知を行う(ステップ#22)。 When the control unit 23 of the tractor 1 acquires the reference point update information from the reference station 60, the control unit 23 transmits the reference point update information to the wireless communication terminal 30. When receiving the information, the wireless communication terminal 30 stops the predetermined notification indicating that the reference station 60 has moved, and the reference point of the reference station 60 has been updated (set to a new position). Is given (step # 22).
 〔別実施形態〕
(1)上記実施形態では、移動検知部64にて基準局60の移動を検知すると、送信停止部65が補正情報の送信を停止することで、トラクタ1の自律走行を停止している。これに代えて、例えば、移動検知部64にて基準局60の移動を検知すると、基準局60が、移動検知部64にて基準局60の移動を検知したことを示すエラーステータス情報を、無線通信ネットワークを介してトラクタ1(移動局側)に送信し、トラクタ1の制御部23が、そのエラーステータス情報を受信することで、トラクタ1の自律走行を停止させることもできる。
[Another embodiment]
(1) In the above embodiment, when the movement detection unit 64 detects the movement of the reference station 60, the transmission stop unit 65 stops the transmission of the correction information, thereby stopping the autonomous traveling of the tractor 1. Instead, for example, when the movement detection unit 64 detects the movement of the reference station 60, the reference station 60 displays error status information indicating that the movement detection unit 64 has detected the movement of the reference station 60 in the wireless communication network. The control unit 23 of the tractor 1 can also stop the autonomous traveling of the tractor 1 by receiving the error status information.
 この場合には、トラクタ1の制御部23が、移動検知部64にて基準局60の移動を検知したことを示すエラー情報を、無線通信ネットワークを介してトラクタ1から無線通信端末30に送信する。また、トラクタ1の制御部23は、移動検知部64にて基準局60の移動を検知したことを示すエラー情報を、無線通信ネットワークやその他のネットワーク回線を介して外部の管理装置等に送信することもできる。このときには、外部の管理装置からそのエラー情報を無線通信端末30に送信することができる。このように、基準局60からのエラーステータス情報に基づいてトラクタ1の自律走行を停止させる場合でも、無線通信端末30にエラー情報が送信されるので、上記実施形態と同様に、無線通信端末30では、報知部33により基準局60が移動されたことを示唆する所定の報知を行うことができる。 In this case, the control unit 23 of the tractor 1 transmits error information indicating that the movement detection unit 64 has detected the movement of the reference station 60 from the tractor 1 to the wireless communication terminal 30 via the wireless communication network. In addition, the control unit 23 of the tractor 1 transmits error information indicating that the movement detection unit 64 has detected the movement of the reference station 60 to an external management device or the like via a wireless communication network or other network line. You can also. At this time, the error information can be transmitted to the wireless communication terminal 30 from the external management device. As described above, even when the autonomous traveling of the tractor 1 is stopped based on the error status information from the reference station 60, the error information is transmitted to the wireless communication terminal 30, so that the wireless communication terminal 30 is similar to the above embodiment. The notification unit 33 can perform predetermined notification indicating that the reference station 60 has been moved.
(2)上記実施形態では、移動検知部64にて基準局60の移動を検知した場合に、トラクタ1の制御部23が、基準局60からの補正情報を受信不可となり、補正情報を取得できないことにより、トラクタ1の自律走行を停止させているが、例えば、基準局60からの補正情報が一度受信不可となることで、トラクタ1の自律走行を停止させたり、基準局60からの補正情報が設定回数以上継続して受信不可となることで、トラクタ1の自律走行を停止させることもできる。 (2) In the above embodiment, when the movement detector 64 detects the movement of the reference station 60, the control unit 23 of the tractor 1 cannot receive the correction information from the reference station 60 and cannot acquire the correction information. The autonomous traveling of the tractor 1 is stopped. For example, when the correction information from the reference station 60 is not received once, the autonomous traveling of the tractor 1 is stopped, or the correction information from the reference station 60 exceeds the set number of times. The autonomous traveling of the tractor 1 can be stopped by continuously disabling reception.
 また、トラクタ1の制御部23が、基準局60からの補正情報を受信不可となることで、直ぐにトラクタ1の自律走行を停止させるのではなく、例えば、自己が取得する測位衛星情報だけからトラクタ1の現在位置を求め、その求めた現在位置に応じて目標走行経路に沿ってトラクタ1の自律走行を一旦継続させておき、その後、最終的にトラクタ1の自律走行を停止させるようにしてもよい。 Further, the control unit 23 of the tractor 1 cannot receive the correction information from the reference station 60, so that the autonomous traveling of the tractor 1 is not stopped immediately, but, for example, only from the positioning satellite information acquired by itself, the tractor 1 , The autonomous traveling of the tractor 1 is once continued along the target traveling route according to the determined current position, and then the autonomous traveling of the tractor 1 is finally stopped. .
 この場合には、トラクタ1の制御部23は、基準局60からの補正情報を受信できないので、自己が取得する測位衛星情報だけからトラクタ1の現在位置を求めることになるが、求めたトラクタ1の現在位置は実際のトラクタ1の現在位置に対して位置ズレが生じている。そして、基準局60からの補正情報が受信できない状態が継続されるので、位置ズレ量が次第に大きくなり、トラクタ1の位置が目標走行経路上から設定距離以上離れてしまう。そこで、トラクタ1の制御部23は、トラクタ1の位置が目標走行経路上から設定距離以上離れていることで、最終的に、トラクタ1の自律走行を停止させることができる。 In this case, since the control unit 23 of the tractor 1 cannot receive the correction information from the reference station 60, the current position of the tractor 1 is obtained from only the positioning satellite information acquired by itself. The current position is shifted from the actual current position of the tractor 1. And since the state which cannot receive the correction information from the reference | standard station 60 is continued, the amount of position shifts becomes large gradually, and the position of the tractor 1 will leave | separate more than a set distance from the target driving | running route. Therefore, the control unit 23 of the tractor 1 can finally stop the autonomous traveling of the tractor 1 because the position of the tractor 1 is more than the set distance from the target traveling route.
(3)上記実施形態において、基準点設定部66は、ステップ#5において、衛星測位情報に基づいて取得した基準局60の現在位置と基準点の位置とを比較してその位置誤差が所定の閾値外である場合に、基準局60の現在位置を新たな基準点として設定することとしたが、基準局60の現在位置を新たな基準点として設定する前に、基準点更新要求情報を、無線通信用アンテナ26を介して無線通信装置31に送信する又は無線通信装置31に直接送信することとしてもよい。この場合、基準点更新要求情報を取得した無線通信端末30は例えばタッチパネルに、基準点の従来の位置座標(基準局60の移動が検知される前の位置座標)と、基準局60の新たな位置座標を表示し、その変更を許可するか否かを選択させる選択画面を表示する。作業者等が基準点の変更許可を選択した場合、基準点更新許可情報を、無線通信用アンテナ26を介して基準局無線通信装置61に送信し又は基準局無線通信装置61に直接送信し、基準局60は、当該基準点更新許可情報に基づいて基準局60の現在位置を新たな基準点として設定する。なお、作業者等が基準点の変更不許可を選択した場合、基準点の設定を作業者等に行わせる基準点設定画面を表示し、作業者等により基準点の設定が行われた場合、基準点指定情報を無線通信用アンテナ26を介して基準局無線通信装置61に送信し又は基準局無線通信装置61に直接送信し、基準局60は、当該基準点更新許可情報に基づいて作業者等が指定した位置を新たな基準点として設定する。 (3) In the above embodiment, the reference point setting unit 66 compares the current position of the reference station 60 acquired based on the satellite positioning information with the position of the reference point in step # 5, and the position error is a predetermined threshold value. If the current position of the reference station 60 is set as a new reference point when it is outside, the reference point update request information is set for wireless communication before the current position of the reference station 60 is set as a new reference point. It is good also as transmitting to the radio | wireless communication apparatus 31 via the antenna 26, or transmitting directly to the radio | wireless communication apparatus 31. FIG. In this case, the wireless communication terminal 30 that has acquired the reference point update request information, for example, on the touch panel, the conventional position coordinates of the reference point (position coordinates before the movement of the reference station 60 is detected) and the new position coordinates of the reference station 60. And a selection screen for selecting whether or not to allow the change is displayed. When the operator or the like has selected permission to change the reference point, the reference point update permission information is transmitted to the reference station wireless communication device 61 or directly to the reference station wireless communication device 61 via the wireless communication antenna 26, and the reference station 60 Sets the current position of the reference station 60 as a new reference point based on the reference point update permission information. In addition, when the operator etc. has selected not to permit the change of the reference point, a reference point setting screen is displayed for allowing the operator to set the reference point, and when the reference point is set by the worker, etc., The reference point designation information is transmitted to the reference station wireless communication device 61 via the wireless communication antenna 26 or directly to the reference station wireless communication device 61. The reference station 60 is designated by an operator or the like based on the reference point update permission information. The set position is set as a new reference point.
(4)上記実施形態では、トラクタ1の自律走行を指示可能な無線通信端末30を備えているが、例えば、走行経路演算部32等、無線通信端末30の少なくとも一部の機能をトラクタ1の制御部23に備えたり、外部の制御装置等に備えることも可能である。 (4) In the above embodiment, the wireless communication terminal 30 capable of instructing the autonomous traveling of the tractor 1 is provided. For example, at least a part of the functions of the wireless communication terminal 30 such as the traveling route calculation unit 32 is provided. It is also possible to provide the control unit 23 or an external control device or the like.
 本発明は、作業車両の位置情報を取得しながら、作業車両を目標走行経路に沿って自律走行させる自律走行システムに適用できる。 The present invention can be applied to an autonomous traveling system that autonomously travels a work vehicle along a target travel route while acquiring position information of the work vehicle.
1    トラクタ(作業車両)
23   制御部(自律走行制御部)
30   無線通信端末
60   基準局
64   移動検知部
65   送信停止部
66   基準点設定部

 
1 Tractor (work vehicle)
23 Control part (autonomous driving control part)
30 Wireless communication terminal 60 Reference station 64 Movement detection unit 65 Transmission stop unit 66 Reference point setting unit

Claims (5)

  1.  予め定められた基準点に設置されて前記基準点の位置情報と衛星測位情報に基づいて補正情報を送信する基準局と、
     作業車両に搭載されて前記基準局から送信される前記補正情報と衛星測位情報に基づいて前記作業車両の位置情報を演算する移動局と、
     前記移動局により演算された前記作業車両の位置情報を用いて予め定められた目標走行経路に沿って前記作業車両を自律走行させる自律走行制御部と、を備えた自律走行システムであって、
     前記基準局の移動を検知する移動検知部を備え、
     前記自律走行制御部は、前記移動検知部により前記基準局の移動が検知された場合に、前記作業車両の自律走行を停止させることを特徴とする自律走行システム。
    A reference station installed at a predetermined reference point and transmitting correction information based on the position information of the reference point and satellite positioning information;
    A mobile station that is mounted on a work vehicle and calculates position information of the work vehicle based on the correction information and satellite positioning information transmitted from the reference station;
    An autonomous traveling system comprising: an autonomous traveling control unit that autonomously travels the working vehicle along a predetermined traveling route using position information of the working vehicle calculated by the mobile station,
    A movement detection unit for detecting movement of the reference station;
    The autonomous traveling control unit stops autonomous traveling of the work vehicle when movement of the reference station is detected by the movement detecting unit.
  2.  前記基準局は、前記移動検知部により前記基準局の移動が検知された場合に前記補正情報の送信を停止させる送信停止部を有し、
     前記自律走行制御部は、前記移動局が前記基準局から前記補正情報を取得できないことに基づいて前記作業車両の自律走行を停止させることを特徴とする請求項1に記載の自律走行システム。
    The reference station has a transmission stop unit that stops transmission of the correction information when movement of the reference station is detected by the movement detection unit,
    The autonomous traveling system according to claim 1, wherein the autonomous traveling control unit stops autonomous traveling of the work vehicle based on the fact that the mobile station cannot acquire the correction information from the reference station.
  3.  前記送信停止部は、前記基準局に対して復帰操作がされるまで前記補正情報の送信を停止させ、前記復帰操作がされた後、衛星測位情報に基づいて特定される前記基準局の現在位置と前記基準点の位置とを比較してその位置誤差が所定の閾値内であれば、前記補正情報の送信を停止しないことを特徴とする請求項2に記載の自律走行システム。 The transmission stop unit stops transmission of the correction information until a return operation is performed on the reference station, and after the return operation, the current position of the reference station specified based on satellite positioning information and the The autonomous traveling system according to claim 2, wherein the correction information transmission is not stopped if the position error is within a predetermined threshold value by comparing with the position of the reference point.
  4.  前記基準局は、前記基準局に対する復帰操作がされた後、衛星測位情報に基づいて特定される前記基準局の現在位置と前記基準点の位置とを比較してその位置誤差が所定の閾値外である場合に、前記基準局の現在位置を新たな基準点として設定する基準点設定部を備え、
     前記送信停止部は、前記基準点設定部により前記基準局の現在位置が新たな基準点として設定されると、前記補正情報の送信を停止しないことを特徴とする請求項2又は3に記載の自律走行システム。
    The reference station compares the current position of the reference station specified based on satellite positioning information with the position of the reference point after a return operation to the reference station, and the position error is outside a predetermined threshold A reference point setting unit for setting the current position of the reference station as a new reference point,
    The autonomous transmission according to claim 2 or 3, wherein the transmission stop unit does not stop the transmission of the correction information when the current position of the reference station is set as a new reference point by the reference point setting unit. Traveling system.
  5.  無線通信ネットワークを介して前記自律走行制御部に前記作業車両の自律走行を指示可能な無線通信端末を備え、
     前記無線通信端末は、前記移動検知部により前記基準局の移動が検知された場合に、前記基準局が移動されたことを示唆する所定の報知を行うことを特徴とする請求項1~4の何れか1項に記載の自律走行システム。

     
    A wireless communication terminal capable of instructing autonomous traveling of the work vehicle to the autonomous traveling control unit via a wireless communication network,
    5. The wireless communication terminal according to claim 1, wherein when the movement detection unit detects movement of the reference station, the wireless communication terminal performs a predetermined notification indicating that the reference station has been moved. The autonomous traveling system according to item 1.

PCT/JP2017/027064 2016-08-09 2017-07-26 Autonomous travel system WO2018030154A1 (en)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2016156555A JP2018025924A (en) 2016-08-09 2016-08-09 Autonomous travelling system
JP2016-156555 2016-08-09

Publications (1)

Publication Number Publication Date
WO2018030154A1 true WO2018030154A1 (en) 2018-02-15

Family

ID=61162961

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2017/027064 WO2018030154A1 (en) 2016-08-09 2017-07-26 Autonomous travel system

Country Status (2)

Country Link
JP (1) JP2018025924A (en)
WO (1) WO2018030154A1 (en)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113038821A (en) * 2018-10-30 2021-06-25 东京计器株式会社 Error correction device
CN113156471A (en) * 2016-04-13 2021-07-23 苏州宝时得电动工具有限公司 Positioning system and positioning method
CN113359695A (en) * 2020-03-06 2021-09-07 苏州宝时得电动工具有限公司 Working method and automatic working system of self-moving equipment

Families Citing this family (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR20210099124A (en) * 2018-12-20 2021-08-11 에스지 디제이아이 테크놀러지 코., 엘티디 Positioning method and apparatus based on pose data
JP7084863B2 (en) 2018-12-26 2022-06-15 株式会社クボタ Automatic driving support device, work vehicle and automatic driving method of work vehicle
JP7395382B2 (en) * 2020-02-18 2023-12-11 東京計器株式会社 base station equipment
JP2021131270A (en) * 2020-02-18 2021-09-09 東京計器株式会社 Base station device

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2003219448A (en) * 2002-01-25 2003-07-31 Hitachi Ltd Position correction information distributing system
JP2004144622A (en) * 2002-10-24 2004-05-20 Kokusai Kogyo Co Ltd Monitoring system for sloped face
JP2015075380A (en) * 2013-10-08 2015-04-20 鹿島建設株式会社 Real-time kinematic system and position measurement method
WO2015119265A1 (en) * 2014-02-06 2015-08-13 ヤンマー株式会社 Travel control system
JP2015169503A (en) * 2014-03-06 2015-09-28 三菱電機株式会社 correction data distribution server

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2003219448A (en) * 2002-01-25 2003-07-31 Hitachi Ltd Position correction information distributing system
JP2004144622A (en) * 2002-10-24 2004-05-20 Kokusai Kogyo Co Ltd Monitoring system for sloped face
JP2015075380A (en) * 2013-10-08 2015-04-20 鹿島建設株式会社 Real-time kinematic system and position measurement method
WO2015119265A1 (en) * 2014-02-06 2015-08-13 ヤンマー株式会社 Travel control system
JP2015169503A (en) * 2014-03-06 2015-09-28 三菱電機株式会社 correction data distribution server

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113156471A (en) * 2016-04-13 2021-07-23 苏州宝时得电动工具有限公司 Positioning system and positioning method
CN113038821A (en) * 2018-10-30 2021-06-25 东京计器株式会社 Error correction device
CN113038821B (en) * 2018-10-30 2022-12-06 东京计器株式会社 Error correction device
CN113359695A (en) * 2020-03-06 2021-09-07 苏州宝时得电动工具有限公司 Working method and automatic working system of self-moving equipment

Also Published As

Publication number Publication date
JP2018025924A (en) 2018-02-15

Similar Documents

Publication Publication Date Title
WO2018030154A1 (en) Autonomous travel system
US10324461B2 (en) Remote control apparatus
JP2023168382A (en) Work vehicle support system and work vehicle support method
US10126754B2 (en) Method for setting travel path of work vehicle
US10095241B2 (en) Parallel travel work system
JP6440647B2 (en) Autonomous driving system
KR102283927B1 (en) Task vehicle control system
JP6422912B2 (en) POSITIONING DETECTION DEVICE AND WORKING MACHINE HAVING POSITIONING DETECTION DEVICE
WO2017204052A1 (en) Autonomous traveling system
JP2018113940A (en) Position measurement device for work vehicle
JP7083445B2 (en) Autonomous driving system
KR20230074599A (en) Route generation system
JP2015222503A (en) Autonomous travel working vehicle
EP3970462A1 (en) Autonomous travel system
JP6685868B2 (en) Autonomous driving system
WO2021106389A1 (en) Autonomous traveling control system
US10916145B2 (en) Work vehicle coordination system and work vehicle
JP7083001B2 (en) Autonomous driving system
US20220151134A1 (en) Automatic Travel System
JP2019109163A (en) Satellite positioning system for work vehicle
JP2019053470A (en) Work vehicle-purpose autonomous travelling system
JP6708724B2 (en) Autonomous driving system
US20240151001A1 (en) Work machine steering control system and work machine steering control method
JP2019041593A (en) Automatic traveling system of implement
JP6919012B2 (en) Autonomous driving system

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 17839227

Country of ref document: EP

Kind code of ref document: A1

NENP Non-entry into the national phase

Ref country code: DE

122 Ep: pct application non-entry in european phase

Ref document number: 17839227

Country of ref document: EP

Kind code of ref document: A1