WO2016002096A1 - 作業機械、作業機械の走行経路への進入可否判定のための装置、方法、プログラム、プログラムを記録した記録媒体、作業機械の走行制御装置 - Google Patents
作業機械、作業機械の走行経路への進入可否判定のための装置、方法、プログラム、プログラムを記録した記録媒体、作業機械の走行制御装置 Download PDFInfo
- Publication number
- WO2016002096A1 WO2016002096A1 PCT/JP2014/076278 JP2014076278W WO2016002096A1 WO 2016002096 A1 WO2016002096 A1 WO 2016002096A1 JP 2014076278 W JP2014076278 W JP 2014076278W WO 2016002096 A1 WO2016002096 A1 WO 2016002096A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- work
- entry
- work machine
- travel route
- predetermined
- Prior art date
Links
- 238000000034 method Methods 0.000 title claims description 50
- 238000002360 preparation method Methods 0.000 claims description 89
- 238000013459 approach Methods 0.000 claims description 59
- 238000003860 storage Methods 0.000 claims description 58
- 238000001514 detection method Methods 0.000 claims description 26
- 230000005764 inhibitory process Effects 0.000 claims description 10
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 description 38
- 238000005520 cutting process Methods 0.000 description 21
- 238000004891 communication Methods 0.000 description 19
- 230000002093 peripheral effect Effects 0.000 description 18
- 230000005540 biological transmission Effects 0.000 description 15
- 230000006870 function Effects 0.000 description 11
- 238000004590 computer program Methods 0.000 description 10
- 238000012937 correction Methods 0.000 description 10
- 230000003287 optical effect Effects 0.000 description 4
- 244000025254 Cannabis sativa Species 0.000 description 3
- 230000006399 behavior Effects 0.000 description 3
- 238000004422 calculation algorithm Methods 0.000 description 3
- 238000004140 cleaning Methods 0.000 description 3
- 230000005856 abnormality Effects 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 238000007689 inspection Methods 0.000 description 2
- 238000002372 labelling Methods 0.000 description 2
- 239000004973 liquid crystal related substance Substances 0.000 description 2
- 238000004519 manufacturing process Methods 0.000 description 2
- 239000004065 semiconductor Substances 0.000 description 2
- 238000004364 calculation method Methods 0.000 description 1
- 238000009313 farming Methods 0.000 description 1
- 238000012905 input function Methods 0.000 description 1
- 230000002452 interceptive effect Effects 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 238000013138 pruning Methods 0.000 description 1
- 239000011435 rock Substances 0.000 description 1
- 230000001360 synchronised effect Effects 0.000 description 1
- 230000001960 triggered effect Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0219—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory ensuring the processing of the whole working surface
-
- A—HUMAN NECESSITIES
- A01—AGRICULTURE; FORESTRY; ANIMAL HUSBANDRY; HUNTING; TRAPPING; FISHING
- A01B—SOIL WORKING IN AGRICULTURE OR FORESTRY; PARTS, DETAILS, OR ACCESSORIES OF AGRICULTURAL MACHINES OR IMPLEMENTS, IN GENERAL
- A01B69/00—Steering of agricultural machines or implements; Guiding agricultural machines or implements on a desired track
- A01B69/007—Steering or guiding of agricultural vehicles, e.g. steering of the tractor to keep the plough in the furrow
- A01B69/008—Steering or guiding of agricultural vehicles, e.g. steering of the tractor to keep the plough in the furrow automatic
-
- A—HUMAN NECESSITIES
- A01—AGRICULTURE; FORESTRY; ANIMAL HUSBANDRY; HUNTING; TRAPPING; FISHING
- A01D—HARVESTING; MOWING
- A01D34/00—Mowers; Mowing apparatus of harvesters
- A01D34/006—Control or measuring arrangements
- A01D34/008—Control or measuring arrangements for automated or remotely controlled operation
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/0088—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots characterized by the autonomous decision making process, e.g. artificial intelligence, predefined behaviours
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0268—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means
- G05D1/027—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means comprising intertial navigation means, e.g. azimuth detector
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0276—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
- G05D1/0278—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle using satellite positioning signals, e.g. GPS
-
- A—HUMAN NECESSITIES
- A01—AGRICULTURE; FORESTRY; ANIMAL HUSBANDRY; HUNTING; TRAPPING; FISHING
- A01D—HARVESTING; MOWING
- A01D2101/00—Lawn-mowers
Definitions
- the present invention for example, for judging whether or not to enter a running path of a work machine such as a golf course or a soccer field, a river bank, a park green space, a lawn mower or a cleaning vehicle used in a garden, or a work machine.
- the present invention relates to an apparatus, a method, a program, a recording medium on which the program is recorded, and a travel control device for a work machine.
- the work area is a self-propelled type that travels along a path formed by connecting ends of a plurality of parallel straight paths to each other via a reverse path.
- a working machine is known (see, for example, Patent Documents 1 and 2).
- the work machine is moved out of the work target area for inspection because of an abnormality in the work machine.
- an unscheduled obstacle is detected while traveling to perform work, an emergency stop must be performed to avoid the obstacle, etc., while the work machine is traveling along the travel route for work.
- the traveling of the work machine may be stopped for some reason and the traveling route may be left. In that case, it is necessary to return the work machine to the travel path so that the work is resumed at least from the final work completion position (hereinafter, also simply referred to as “work completion position”) at the time of leaving the travel path. Therefore, the user moves the work machine closer to the work completion position.
- the work completion position when leaving the route is a connection point between the route where the previous work should be performed and the route where the work is not performed
- the start point of the route where the subsequent work should be performed (the route where the work is not performed)
- the work may be resumed from the connection point of the route on which the subsequent work is to be performed), that is, from the first work incomplete position (hereinafter also simply referred to as “work incomplete position”) when leaving the travel route. Therefore, in such a case, the user may move the work machine near the work incomplete position.
- the work machine automatically travels along the travel route based on the current position and a predetermined travel route. That is, the work machine travels along a predetermined travel route while performing trajectory correction by control such as feedback control and feedforward control. Therefore, when the work machine starts traveling from a position near the work completion position or the work incomplete position (hereinafter, also referred to as “position for preparation for entry”), the current position and the travel route to be entered from now on. While correcting the deviation so as to correct the deviation, the vehicle enters the travel route and travels on the travel route. Therefore, it is impossible to control at which position on the travel route the work machine actually enters the travel route.
- the present invention provides an operation for preparing for entry so that, when the work machine leaves the travel route, the work machine can enter the travel route only forward in front of the work completion position or the work incomplete position.
- One of the purposes is to make the placement of the machine more reliable.
- a detection unit that detects a current position of a work machine that performs a predetermined work while traveling in a work target area along a predetermined travel route; and the case where the work machine leaves the travel route.
- the progress when the work machine travels along the travel route at the approach position at the approach position located on the opposite side of the travel direction of the work machine with respect to the work completion position or the work incomplete position on the travel route It is determined whether or not the work machine can enter only by moving forward from the current position for preparation for entering the work machine along an approach path that is made to enter in the same direction as the direction.
- a determination information generation unit that generates the determination information, and the determination information is transmitted to an entry availability notification device that is separate from the entry availability determination device.
- a detection unit that detects a current position of a work machine that performs a predetermined work while traveling in a work target area along a predetermined travel route; and the case where the work machine leaves the travel route.
- the progress when the work machine travels along the travel route at the approach position at the approach position located on the opposite side of the travel direction of the work machine with respect to the work completion position or the work incomplete position on the travel route It is determined whether or not the work machine can enter only by moving forward from the current position for preparation for entering the work machine along an approach path that is made to enter in the same direction as the direction.
- a determination information generation unit that generates the determination information, a notification signal / command generation unit that generates a signal and / or a command for instructing notification of entry and / or inaccessibility based on the determination information,
- the entry determination apparatus comprising.
- the determination information and / or the signal and / or command instructing the notification of whether the entry is possible and / or impossible to enter are output and / or transmitted to an entry availability notification device separate from the entry availability determination device. be able to.
- the work machine when a work machine that performs a predetermined work while traveling along a predetermined travel route in a work target area leaves the travel route, the work machine is positioned more than the work completion position on the travel route.
- An entry propriety judging device for judging whether or not the work machine can enter only by moving forward from a current position for preparation for entry of the work machine, and detecting means for detecting the current position and direction of the work machine;
- a point on the travel route recorded in the storage unit corresponding to the current position for the entry preparation detected by the detection means of the work machine and the storage unit in which the travel route is recorded A corresponding point determination unit that determines a corresponding point to be determined, and when the distance between the current position for the entry preparation and the corresponding point is greater than a predetermined first value, it is determined that no entry is possible
- the detection means further detects the direction of the work machine, and the determination information generation unit is configured such that a distance between the current position for the entry preparation and the corresponding point is greater than a predetermined first value, or When the absolute value of the angle of the direction of the work machine with respect to the direction of the tangent at the corresponding point on the travel route is larger than a predetermined second value, it is determined that entry is impossible, and whether the entry is possible Determination information can be generated.
- the predetermined second value can be a predetermined value of 30 ° or less.
- the entry permission / prohibition determination device further includes a work completion position recording unit that records the work completion position in the storage unit, and the determination information generation unit is configured such that the work machine enters the travel route from the desired corresponding point.
- the point of the working machine in the traveling direction of the working machine in the traveling direction of the traveling route on the travel route is a distance of a third value determined in consideration of the marginal distance to the distance to the point to be performed. When it is located on the side, it can be determined that entry is impossible.
- the work machine when a work machine that performs a predetermined work while traveling in a work target area along a predetermined travel route leaves the travel route, a work completion position on the travel route or a work incomplete state.
- the work machine is an entry availability determination device that determines whether or not it is impossible to enter only by moving forward from the current position for preparation for entry of the work machine, and detects the current position of the work machine A travel unit recorded in the storage unit corresponding to a current position for the entry preparation detected by the detection unit, the storage unit in which the travel route is recorded, and the detection unit of the work machine.
- a corresponding point determination unit that determines a corresponding point that is a point on the road, and determines that entry is impossible when the distance between the current position for the entry preparation and the corresponding point is greater than a predetermined first value.
- a determination information generation unit that generates determination information as to whether or not the vehicle can enter, wherein the predetermined first value is determined by the work machine from at least the steering performance of the work machine and the desired corresponding point.
- the present invention provides an entry permission / inhibition determination device that is predetermined in consideration of a distance to a point that enters the travel route.
- the detection means further detects the direction of the work machine, and the determination information generation unit is configured such that a distance between the current position for the entry preparation and the corresponding point is greater than a predetermined first value, or When the absolute value of the angle of the direction of the work machine with respect to the direction of the tangent at the corresponding point on the travel route is larger than a predetermined second value, it is determined that entry is impossible, and whether the entry is possible Determination information can be generated.
- the predetermined second value can be a predetermined value of 30 ° or less.
- a point that is a distance of a third value determined in consideration of an allowance distance in the distance to the point to be performed is a point that is separated in the traveling direction of the work machine in the travel route than the work completion position or the work incomplete position. When it is located on the traveling direction side of the work machine, it can be determined that entry is impossible.
- the corresponding point may be a nearest point that is a point on the travel route recorded in the storage unit that is closest to the current position for the entry preparation detected by the detection unit of the work machine.
- the corresponding point is closest to the current position for the entry preparation detected by the detection means of the work machine on the opposite side of the work machine in the traveling direction from the work completion position or the work incomplete position,
- the closest point on the work completion side which is a point on the travel route recorded in the storage unit.
- the entry permission / prohibition determination device may further include a notification signal / command generation unit for generating a signal and / or a command for instructing notification of entry possible and / or impossibility based on the determination information.
- the determination information may be transmitted to an entry availability notification device that is separate from the entry availability determination device.
- the determination information and / or the signal and / or command instructing the notification of whether the entry is possible and / or impossible to enter are output and / or transmitted to an entry availability notification device separate from the entry availability determination device. be able to.
- One aspect of the present invention is a travel for causing the work machine to travel the travel route based at least on the current position of the work machine traveling in the work target area and the travel route recorded in the storage unit.
- the present invention provides a work machine control device that includes a control means for controlling a travel drive mechanism provided in the work machine by outputting a control signal, and the entry propriety determination device.
- One aspect of the present invention provides a work machine that includes the work machine control device and a travel drive mechanism that drives its own travel based on the travel control signal output from the work machine control device. It is.
- One aspect of the present invention includes a step of detecting a current position of a work machine that performs a predetermined work while traveling in a work target area along a predetermined travel route, and when the work machine leaves the travel route.
- the work machine determines whether or not the work machine can enter only by moving forward from the current position for preparation of the work machine along the approach route that is made to enter in the same direction. Generating the determination information, and providing an approach availability determination method in which the determination information is transmitted to the entry availability notification device.
- One aspect of the present invention includes a step of detecting a current position of a work machine that performs a predetermined work while traveling in a work target area along a predetermined travel route, and when the work machine leaves the travel route.
- the work machine determines whether or not the work machine can enter only by moving forward from the current position for preparation of the work machine along the approach route that is made to enter in the same direction.
- a measuring method There is provided a measuring method.
- the determination information and / or the signal and / or command instructing the notification of the entry possible and / or the entry failure may be output and / or transmitted to the entry availability notification device.
- the work machine when a work machine that performs a predetermined work while traveling along a predetermined travel route in a work target area leaves the travel route, the work machine is positioned more than the work completion position on the travel route.
- the work machine is an approach availability determination method for determining whether or not the work machine can enter only by moving forward from a current position for entry preparation of the work machine, and detecting the current position and orientation of the work machine; Determining a corresponding point that is a point on the travel route recorded in the storage unit corresponding to the current position for the entry preparation detected by the detection means of the work machine; A step of determining that it is impossible to enter when the distance between the current position for preparation for entry and the corresponding point is greater than a predetermined first value, and generating determination information as to whether or not the entry is possible.
- the predetermined approach availability determination method for determining whether or not the work machine can enter only by moving forward from a current position for entry preparation of the work machine, and detecting the current position and orientation of the work machine; Determining a
- the step of detecting further detects the direction of the work machine, and the step of generating the determination information includes a step in which a distance between the current position for the entry preparation and the corresponding point is larger than a predetermined first value. Or if the absolute value of the angle of the direction of the work machine with respect to the direction of the tangent at the corresponding point on the travel route is larger than a predetermined second value, it is determined that no entry is possible and the entry is possible. Whether or not can be determined can be generated.
- the predetermined second value can be a predetermined value of 30 ° or less.
- the method for determining whether or not to enter may be a third step in which a step of recording the work completion position and a distance from the desired corresponding point to a point where the work machine enters the travel route is determined in consideration of a margin distance.
- a work completion position on the travel route or a work incomplete state when a work machine that performs a predetermined work while traveling in a work target area along a predetermined travel route leaves the travel route, a work completion position on the travel route or a work incomplete state.
- An approach route in which the work machine enters in the same direction as the travel direction when traveling on the travel route at the entry position at an entry position located on the opposite side of the travel direction of the work machine from the position A method of determining whether or not the work machine can enter only by moving forward from a current position for preparation for entering the work machine, and detects the current position of the work machine.
- the predetermined first value is determined in advance in consideration of at least the steering performance of the work machine and a distance from a desired corresponding point to a point where the work machine enters the travel route.
- the step of detecting further detects the direction of the work machine, and the step of generating the determination information includes a step in which a distance between the current position for the entry preparation and the corresponding point is larger than a predetermined first value. Or if the absolute value of the angle of the direction of the work machine with respect to the direction of the tangent at the corresponding point on the travel route is larger than a predetermined second value, it is determined that no entry is possible and the entry is possible. Whether or not can be determined can be generated.
- the predetermined second value can be a predetermined value of 30 ° or less.
- the method may further include a step of determining that entry is impossible when the point is located closer to the traveling direction of the work machine than the work completion position or the work incomplete position.
- the corresponding point may be a nearest point that is a point on the travel route that is closest to the current position for the entry preparation detected by the detection means of the work machine.
- the corresponding point is closest to the current position for the entry preparation detected by the detection means of the work machine on the opposite side of the work machine in the traveling direction from the work completion position or the work incomplete position,
- the closest point on the work completion side which is a point on the travel route recorded in the storage unit.
- the entry availability determination method may further include a step of generating a signal and / or a command instructing notification of entry possible and / or impossible entry based on the determination information.
- the determination information may be transmitted to an entry availability notification device that is separate from the entry availability determination device.
- the determination information and / or the signal and / or command instructing the notification of whether the entry is possible and / or impossible to enter are output and / or transmitted to an entry availability notification device separate from the entry availability determination device. be able to.
- One aspect of the present invention provides a program for causing a computer to execute the method for determining whether to enter or not.
- One aspect of the present invention provides a computer-readable recording medium in which the program is recorded.
- work completion position and “work incomplete position” mean the final work completion position and the first work incomplete position when the work machine leaves the travel route, respectively.
- the “corresponding point” means that the current position for entry preparation is a position where the work machine is located as a result of deviating from a predetermined travel route. If the vehicle travels without deviating, it means a corresponding point on the travel route when considering which point on the travel route corresponds.
- the preparation for entry is such that the work machine can be advanced only into the travel route before the work completion position or the work incomplete position.
- the work machine can be arranged more reliably.
- FIG. 1 is a side external view of a lawn mower to which the present invention is applied, and (b) is a top external view.
- FIG. 1 is explanatory drawing of the setting of the outer periphery of the work area
- generation process The figure for demonstrating the setting of a linear path
- generated. 6 is a flowchart of entry permission / prohibition determination processing. An example figure in the state where a lawnmower is arranged in a position for entry preparation.
- a typical lawn mower is designed to perform mowing work while moving forward.
- lawn mowers can regularly perform lawn mowing work so that the lawn of adjacent lines in the line shape is in the opposite direction. desired. It is desirable to perform lawn mowing work so that the boundary between the green and the rough is as smooth as possible.
- the parallel paths are connected to each other via an outer peripheral path for cutting the turf on the periphery such as green, which is a lawn mowing target area, and an inversion path for regularly cutting the lawn such as green.
- an example will be described in which a lawn mower travels along a straight path and the lawn mower works along each route.
- adjacent straight paths are formed by being connected via an inversion path and the lawn mower sequentially travels in the reverse direction on the adjacent straight paths will be described, for example, Japanese Patent No. 3454666. As shown in FIG.
- a travel route is a route (hereinafter also referred to as a “skip route”) formed by connecting a straight route to a straight route obtained by skipping several adjacent straight routes via an inversion route. It is good also as a part or all of. Moreover, it is good also as a substantially parallel curve path
- ⁇ Overview> 1 (a) and 1 (b) show an overall outline of devices necessary for lawn mowing work.
- an example of a lawn mower 1 that performs lawn mowing work on a golf course while measuring the current position using the RTK-GPS method (Real Time Kinematic GPS: interference positioning method) is shown.
- the base station 2 includes a GPS receiving device 21 and a transmitting / receiving device 22 corresponding to an RTK-GPS reference station, a GPS antenna 25, and a communication antenna 26.
- the base station 2 is installed at a point whose longitude, latitude, and height are known.
- the GPS receiver 21 generates correction information for correcting an error in the position information of the lawn mower 1. This correction information is appropriately transmitted to the lawn mower 1 through the transmission / reception device 22 and the communication antenna 26.
- the transmission timing of the correction information is, for example, a timing requested by the lawn mower 1 or a predetermined interval (for example, every 100 ms).
- the RTK-GPS method is used as a positioning method, but a differential GPS method (Differential GPS) may be used.
- the lawnmower 1 includes a control device 10, a vehicle speed sensor 11, an azimuth angular velocity sensor 12, a drive control unit 13, a GPS antenna 15, a communication antenna 16, an operation input unit 17, a display unit 18, and a voice output unit 19.
- the control device 10 is an example of the work machine control device according to the present invention, and includes a CPU, a communication function, a storage function (drive unit and / or input / output interface for an internal recording medium and an external recording medium), and a display function (display).
- the computer apparatus includes a predetermined computer program.
- the computer program includes a GPS device 101, a transmission / reception unit 102, a vehicle information reception unit 105, a drive command unit 106, a control information generation unit 107, a storage unit 108, a removable recording medium interface unit 109, and a main control unit 112.
- the operation completion / incomplete position recording unit 121, the corresponding point determination unit 122, the determination information generation unit 123, and the notification signal / command generation unit 124 are caused to function.
- the main control unit 112 comprehensively controls the operation of each unit.
- This computer apparatus includes an RTC (Real Time Clock) module that outputs time data and a synchronous clock for control operation.
- the control device 10 may include an azimuth angular velocity sensor. Details of the control device 10 will be described later.
- the vehicle speed sensor 11 detects the traveling speed when the lawn mower 1 moves forward or backward.
- the azimuth angular velocity sensor 12 detects the behavior (dynamics) of the lawn mower 1 such as tilt, turning, and wobbling based on the angular velocity around the three-dimensional axis (roll, pitch, yaw).
- Data to be measured by the azimuth velocity sensor 12 may be substituted with an accelerometer.
- the sensors 11 and 12 can be substituted by taking in the measurement results of various instruments included in the lawn mower 1.
- the drive control unit 13 controls a work drive mechanism that drives the raising and lowering and operation of the mowing blade of the lawn mower 1 based on a work control signal described later, or the lawn mower 1 based on a travel control signal described later. It controls the driving mechanism that drives left / right turn, forward, backward, etc.
- the drive control unit 13 may be provided separately from the control device 10 as illustrated, but may be realized as a function of the control device 10.
- the GPS antenna 15 functions as a position detection sensor that receives GPS data transmitted from a GPS satellite.
- the communication antenna 16 enables communication with the communication antenna 26 of the base station 2. This communication is used for transmission / reception of correction information for correcting the positional information error of the lawn mower 1, communication with an operator of the lawn mower 1, signals for remote operation of the lawn mower 1, and the like.
- the operation input unit 17 includes a keyboard and a mouse, but is not limited thereto.
- the display unit 18 includes a CRT, a liquid crystal display, a laminated display lamp, or the like, but is not limited thereto.
- the audio output unit 19 includes a speaker or the like, but is not limited to this.
- the travel route generating device 3 is a computer having a CPU, a communication function, a storage function (drive unit and / or input / output interface for an internal recording medium and an external recording medium), an input function (keyboard, mouse, etc.), and a display function (display). It comprises an apparatus and a predetermined computer program.
- the computer program includes a computer device, an area setting unit 301, a path generation unit 302, an operation setting unit 303, a control unit 30 including a main control unit 304, an operation input unit 31, a display unit 32, a storage unit 33, and a removable recording medium. It functions as the interface unit 34 and the transmission / reception unit 35.
- the main control unit 304 comprehensively controls the operation of each unit. Details of the travel route generation device 3 will be described later.
- FIGS. 2 (a) and 2 (b) The appearance of the lawn mower 1 is shown in FIGS. 2 (a) and 2 (b).
- 2A is an external view of the lawn mower 1 viewed from the side
- FIG. 2B is an external view of the lawn mower 1 viewed from the top.
- the control device 10, the vehicle speed sensor 11, the azimuth angular velocity sensor 12, the drive control unit 13, the travel drive mechanism, and the work drive mechanism described above are incorporated in the body of the lawn mower 1.
- the azimuth angular velocity sensor 12 is installed at a position where the behavior of the lawn mower 1 is correctly transmitted.
- the GPS antenna 15 is provided so as to be approximately at the center of the body of the lawn mower 1, that is, approximately at the center in each of the length direction and the width direction of the body. Further, the communication antenna 16 is attached so as to protrude from the rear surface of the body of the lawn mower 1 so as not to obstruct the reception of the GPS antenna 15.
- the lawn mower 1 includes a pair of mowing blades 18 and 19 for mowing the lawn.
- the front cutting blade 18 cuts grass on the left and right ends of the cutting width W [m] in the direction orthogonal to the traveling direction.
- the rear cutting blade 19 cuts the grass in the center of the cutting width W [m].
- the mowing width W [m] is a working width that allows the lawn mower 1 to mow the lawn by one run and work.
- the GPS receiver 101 of the control device 10 outputs GPS data received by the GPS antenna 15 to the control information generator 107.
- the transmission / reception unit 102 enables communication between the control information generation unit 107 and the base station 2 via the communication antenna 16 and corrects an error in the position information of the lawn mower 1 received by the communication antenna 16.
- the correction information is output to the control information generation unit 107.
- the control information generation unit 107 determines the current position of the lawn mower 1 based on the correction data for correcting the error between the GPS data received by the GPS antenna 15 and the position information of the lawn mower 1 received by the communication antenna 16.
- the position information to represent is generated.
- the transmission / reception unit 102 can be connected to an arbitrary network regardless of wired or wireless, LAN (Local Area Network), or public communication line.
- the vehicle information receiving unit 105 acquires detection information representing the traveling speed, direction, and behavior of the lawn mower 1 from tracking the position using the vehicle speed sensor 11 and the azimuth angular velocity sensor 12 and / or GPS data. If the acquired information is analog data, it is converted into digital data and output. At that time, data correction is performed to remove the offset component and the drift component from the output of the azimuth angular velocity sensor 12 as necessary.
- the output information of the vehicle information receiving unit 105 is recorded in the storage unit 108 in association with the current time data.
- the drive command unit 106 controls the travel drive mechanism or the work drive mechanism in order to perform travel control or work control of the lawn mower 1. Is output to the drive control unit 13. Based on this information, the drive control unit 13 controls the travel drive mechanism or the work drive mechanism of the lawn mower. Thereby, the lawn mowing work by the lawn mower 1 becomes possible.
- the storage unit 108 can record a travel route and operation data generated by the travel route generation device 3 described later, a predetermined computer program, and the like.
- the storage unit 108 includes an arbitrary number of storage components such as a hard disk and a semiconductor memory, but is not limited thereto.
- a removable recording medium 40 such as an optical disk such as a CD-ROM or DVD, a USB memory, or an SD memory card can be detachably mounted.
- the removable recording medium interface unit 109 can read data recorded on the mounted removable recording medium 40 and write data to the removable recording medium 40.
- the removable recording medium interface unit 109 is, for example, a dedicated reader / writer if the removable recording medium 40 is an optical disk such as a CD-ROM or DVD, a USB port or the like if it is a USB memory, or an SD memory card. Card slot or the like, but is not limited thereto.
- the travel route and the operation data generated by the travel route generation device 3 to be described later are recorded on the removable recording medium 40 attached to the storage unit 108 or the removable recording medium interface unit 109, and the control information generation unit 107
- a travel control signal and a work control signal are generated and output based on the travel route and operation data and the current position acquired from GPS data, various sensors 11, and the like. This enables work by automatic traveling.
- the entry permission / inhibition determination device 60 is an example of the entry permission / inhibition determination device of the present invention, and corresponds to a portion surrounded by a dotted line in the control device 10 of FIG. 1a. The description of the same configuration as that of the control device 10 described above is omitted.
- the work completion / unfinished position recording unit 121 stops the travel of the lawn mower 1 while the lawn mower 1 is traveling on the travel route for the lawn mowing work, and the last time when the travel route is left.
- the mowing work completion position and the first mowing work incomplete position are recorded in the storage unit 108.
- the corresponding point determination unit 122 determines the closest point that is the point on the travel route recorded in the storage unit 108 that is the closest to the detected current position for preparing the lawn mower 1 for entry.
- the determination information generation unit 123 prepares for the entry preparation with respect to the tangent at the nearest point on the travel route in which the distance between the current position and the nearest point for the preparation for entering the lawn mower 1 is greater than a predetermined first value. If the absolute value of the direction angle of the lawn mower 1 at the current position is larger than a predetermined second value, it is determined that the lawn mower 1 cannot enter the travel route and can enter. Whether or not is generated.
- the notification signal / command generation unit 124 generates a signal or command for instructing notification of entry and / or inaccessibility based on the determination information.
- a travel route for the lawn mower 1 to travel is generated by the travel route generator 3.
- the operation input unit 31 includes a keyboard, a mouse, and the like, but is not limited thereto.
- the display unit 32 includes a CRT, a liquid crystal display, or the like, but is not limited thereto.
- the storage unit 33 can record a travel route and operation data generated by a travel route generation device 3 to be described later, a predetermined computer program, and the like.
- storage part 33 is comprised from arbitrary numbers of memory components, such as a hard disk and a semiconductor memory, it is not limited to these.
- an optical disk such as a CD-ROM or DVD
- a removable recording medium 40 such as a USB memory or an SD memory card
- the removable recording medium interface unit 109 can read data recorded on the mounted removable recording medium 40 and write data to the removable recording medium 40.
- the removable recording medium interface unit 109 is, for example, a dedicated reader / writer if the removable recording medium 40 is an optical disk such as a CD-ROM or DVD, a USB port or the like if it is a USB memory, or an SD memory card. Card slot or the like, but is not limited thereto.
- the transmission / reception unit 35 can be connected to any network regardless of wired or wireless, LAN (Local Area Network) or public communication line.
- the transmission / reception unit 35 can transmit, for example, a travel route and operation data generated by the travel route generation device 3 described later to the control device 1 via the network.
- the control unit 30 includes an area setting unit 301, a route generation unit 302, and an operation setting unit 303.
- the area setting unit 301 includes an entry prohibition area in which the lawn mower 1 is prohibited from entering due to the outer periphery 50 of the work target area where the lawn mower 1 performs lawn mowing work and the presence of cliffs, bunker, rocks, trees, and the like.
- the outer periphery 51 is set.
- the area setting unit 301 displays the coordinates A1, A2,..., An, coordinates I11, I12, I13,..., Coordinates I21, I22, I23,.
- the surveying device is not limited to the one using GPS data or the like, and any device can be used. Further, the latitude and longitude of the outer periphery 50 of the work target area and the outer periphery 51 of the entry prohibition area may be directly input via the operation input unit 31. You may enable it to correct the outer periphery 50 of the set work object area
- the route generation unit 302 generates the outer periphery route C based on the outer periphery 50 of the work target region set by the region setting unit 301. Further, as will be described later, the route generation unit 302 generates a straight route based on the generated outer peripheral route C and, for example, from an arbitrarily set automatic travel start position to a work start position of a certain straight route.
- the travel route, the travel route from the position where work on all straight routes is completed to the work start position on the outer peripheral route, and the travel route from the work end position on the outer peripheral route to the arbitrarily set automatic travel end position A “route” is also generated. That is, the route that the lawn mower 1 should travel is recorded in the storage unit 33.
- the route generation unit 302 includes attribute information including turning characteristics such as the size of the lawn mower 1 input through the operation input unit 31, the cutting width of the cutting blade, the minimum turning radius, and the shape of a curve drawn during turning.
- the lawn mower 1 that has finished traveling on one straight path (first straight path) based on the interval between the straight paths to be performed and the positional relationship between the outer periphery 50 of the work target area and the outer periphery 51 of the entry prohibition area.
- the type of reversing path for turning to the next straight path is selected so that the lawnmower 1 traveling on at least the reversing path does not interfere with the outer periphery 51 of the entry prohibition area, Connected to the first and second straight paths and recorded in the storage unit 33 as a travel path.
- the operation setting unit 303 is associated with the travel route generated by the route generation unit 302, and the moving operation of the mowing blades 18 and 19 while the lawn mower 1 is stopped or the start of rotation of the mowing blades 18 and 19 is stopped.
- operation data including various settings relating to the lawn mowing work including stopping, the speed of the lawn mower 1 and the traveling direction (forward or reverse) during traveling on the reverse route is generated.
- step S1 the area setting unit 301 displays the coordinates A1, A2,..., An, coordinates I11, I12, I13,..., Coordinates I21, I22, I23 in FIG.
- the information of the recorded recording medium is read through the removable recording medium interface unit, and the work object is obtained by connecting the adjacent coordinates of the discrete position information about the outer periphery 50 of the work target area and the outer periphery 51 of the entry prohibition area.
- the information is recorded in the storage unit 33 as the outer periphery 50 of the area and the outer periphery 51 of the entry prohibition area.
- step S2 through the operation input unit 31, attribute information including turning characteristics such as the size of the mower 1, speed characteristics, the cutting width of the cutting blade, the minimum turning radius and the shape of a curve drawn during turning, and the like.
- the distance between the straight paths is input.
- a part or all of the input information may be stored in advance in the storage unit 33 and read out.
- the interval between adjacent straight paths is determined based on the cutting width of the cutting blade in consideration of the overlap amount of the cutting width in the adjacent straight path.
- the route generation unit 302 may perform automatic calculation based on the width.
- step S ⁇ b> 3 the outer peripheral path C is located approximately W / 2 [m] from the outer periphery 50 of the work target area in consideration of the cutting width W of the cutting blade 18. An outer peripheral path C is generated from the outer periphery 50.
- step S4 the route generation unit 302 generates a straight route based on the generated outer peripheral route C.
- the work start position Pls of the straight path and the end portion P1 of the straight path that faces the work start position Pls are specified via the operation input unit 31.
- a line having an intersection with the outer peripheral path C is selected from a group of straight lines generated by a distance between the work start position Pls and the end P1 and the adjacent straight path input in step S2. Then, the line segment connected to the intersection is defined as a straight path.
- an intersection (coordinate) that is the work start position Pls among the intersections of the outer peripheral path C and the straight path is P0.
- an intersection (coordinate) that faces the intersection (coordinate) P0 (Pls) across the outer peripheral path C is P1.
- an intersection (coordinate) that is adjacent to the intersection (coordinate) P1 in the counterclockwise direction is P2
- an intersection (coordinate) that faces the intersection (coordinate) P2 across the outer peripheral path C is P3.
- numbers are sequentially assigned from the intersection (coordinate) P4 to the intersection (coordinate) P19 (Ple).
- the work of assigning numbers in order from 0 to a plurality of intersections (coordinates) is called labeling, and the numbers are called labels.
- the order of labeling is the order of intersections (coordinates) with the outer peripheral path C through which the lawnmower 1 travels along a straight path.
- the lawnmower 1 travels along a straight path from the intersection (coordinate) P0 (Pls) to the intersection (coordinate) P1, and then changes direction from the intersection (coordinate) P2 to the intersection (coordinate) P3. Sequentially follow a straight path. The same applies to the intersection (coordinates) P4 and thereafter.
- the outer periphery 50 of the set work target area, the outer periphery 51 of the entry prohibition area, and the generated straight path are displayed on the display unit 32, and the user can input the position of the generated straight path by the input via the operation input unit 31. Corrections such as direction and spacing between adjacent straight paths can be made.
- the substantially parallel route is a straight route, but may be an arbitrary curved route.
- the inclination of the straight path is determined by designating the end P1 of the straight path facing the work start position Pls with respect to the work start position Pls of the straight path.
- the work start position Pls of the straight path is determined.
- the route generation unit 302 automatically determines the slope of the straight route (or the direction of the curved route in the case of a curved route) based on the rules preset by the user stored in the storage unit 30. Also good.
- a straight line passing through the work start position Pls of the specified straight path and a straight line group based on the straight line are rotated around the work start position Pls of the straight path, and the outer circumference path C
- the slope of the line segment having the maximum length in the group of line segments connected to the intersection with is taken as the slope of the straight line path.
- the work area is composed of one surface cut by a straight line in one direction, but in the case of a dock leg course at a golf course, the whole is not cut in the same direction, There are cases where the parts are divided into parts and the direction of pruning for each part is aligned in one direction. In such a case, the area of each part may be designated, for example, via the operation input unit 31, and the process from step S4 onward may be performed for each part.
- step S5 the path generation unit 302 uses the water drop type, right half water drop type, left half water drop type, and switchback type as shown in FIG.
- the inversion path is generated using a predetermined algorithm corresponding to each type of inversion path, and is recorded in the storage unit 33.
- each type of inversion path is generated one by one, but a plurality of inversion paths having different curvatures may be generated for each type of inversion path.
- the minimum turning radius is large, when the distance between adjacent straight paths is small, generation of one of the water drop type, the right half water drop type, and the left half water drop type is prohibited. It may be.
- the feature of the water drop type reversal path is that it has good drivability because there is no sharp curve on both the left and right sides, but when the outer periphery 50 of the work target area and the outer periphery 51 of the entry prohibition area are close to each other, Interference is likely to occur between the lawnmower 1 traveling on the reverse path and the outer periphery 51 of the entry prohibition area. Moreover, when the curvature of the reversal path is large, the grass is easily damaged.
- the feature of the right half water drop type inversion path is that it is easy to avoid interference with the outer periphery 51 of the entry prohibition area on the left side of the inversion path. Similarly, for the left half water droplet type inversion path, it is easy to avoid interference with the outer periphery 51 of the entry prohibition area on the right side of the inversion path.
- the switchback type inversion path has two switchback points (turn-back points), and the start point and the first switchback point, the first switchback point and the second switchback point.
- the point, the second switchback point, and the end point are each based on a clothoid curve which is a relaxation curve.
- the switchback type inversion path is characterized by the fact that the inversion path is based on a clothoid curve, which is a relaxation curve, so that it is difficult to damage the turf. On the other hand, inversion takes time.
- the direction of the reversing path is divided into an outer reversing path in which the lawn mower 1 enters the reversing path in the outer direction of the work target area, and an inner side in which the lawn mower 1 enters the reversing path in the inner direction of the work target area.
- An inversion path is provided. In the outer reversal path, the lawn mower 1 enters the reversing path forward, and in the inner reversing path, the lawn mower 1 enters the reversing path backward.
- step S6 a lawn mower that travels on an inversion path connected as an outer inversion path to the ends of a pair of adjacent linear paths in the order of a water drop type, a right half water drop type, a left half water drop type, and a switchback type. It is determined whether or not 1 interferes with the entry prohibition area, and when a type of reversal path that does not interfere with the entry prohibition area is found, in step S7, that type of reversal path is selected as a travel path and adjacent to it. It connects with the edge part of a pair of straight path.
- step S8 if the lawnmower 1 traveling on the reversing path interferes with the outer periphery 51 of the entry prohibition area regardless of which type of reversing path is connected as the outer reversing path, the water drop type and right half water drop are similarly formed. Whether or not the lawnmower 1 traveling on the reversing path connected as the inner reversing path to the ends of the pair of adjacent straight paths in the order of the mold, the left half water drop type, and the switchback type interferes with the entry prohibition area When a type of reversal route that does not interfere with the entry prohibited area is found, in step S9, the type of reversal route is selected as a travel route and connected to the ends of a pair of adjacent straight routes. .
- intersections (coordinates) P1 and P2 which are the ends of a pair of adjacent linear paths L1 and L2
- any type of inversion path is connected as an outer inversion path
- the lawn mower 1 traveling on the road interferes with the entry prohibition area. Therefore, when the generated water drop type inversion path is used as the inner inversion path and connected to the intersections (coordinates) P1 and P2, it does not interfere with the entry prohibition area.
- Select as R1 When the start point of the water droplet type inversion path is connected to the intersection (coordinate) P1, there is a gap between the end point of the water droplet type inversion path and the intersection (coordinate) P2, so a straight line overlapping the straight line L2 is replenished. Then, the water droplet type inversion path is connected to the intersection (coordinate) P2.
- step S9 If an appropriate type of reversal path is not found in step S9 due to the presence of a bunker, pond, etc. inside the green or the like, the display unit 32 or an audio output unit not shown is used. Inform the user to that effect.
- the lawnmower 1 When the lawnmower 1 is remotely controlled while generating a travel route, the user who is remotely controlled may be notified via the transmission / reception unit 35. Then, the user designates the shape of the reverse path via the operation input unit 31.
- step S10 steps S6 to S9 are repeated until the process is completed for all of the pair of adjacent straight paths.
- step S11 the travel start position Pts and the travel end position Pte are designated via the operation input unit 31.
- step S12 the route generation unit 302 starts from the travel start position Pts to the work start position Pls of a certain straight route based on the designated travel start position Pts, travel end position Pte, and attribute information input in step S3.
- the travel route J1 the travel route J2 from the position Ple where the work on all the straight routes has been completed to the work start position Pcs of the outer peripheral route, and the travel route from the work end position Pce of the outer peripheral route to the travel end position Pte.
- a path J3 is generated by a predetermined algorithm.
- the outer periphery 50 of the set work target area, the outer periphery 51 of the entry prohibition area, and all the generated travel routes are displayed on the display unit 32, and the user corrects the travel route by input through the operation input unit 31.
- a selected reversal path can be replaced with one of the previously generated water drop type, right half water drop type, left half water drop type, switchback type reversal paths.
- the position and direction of the straight path, the interval between adjacent straight paths, and the shape of the reverse path can be changed to those specified by the user.
- step S13 the route generation unit 302 records all the generated travel routes on the removable recording medium 40 attached to the storage unit 33 or the removable recording medium interface unit 34.
- step S ⁇ b> 14 the operation setting unit 303 moves the mowing blades 18 and 19 while the lawn mower 1 is running or stopped based on the lawn mower 1 attribute information input via the operation input unit 31.
- Route generation of various settings related to lawn mowing work including starting or stopping the rotation of the cutting blades 18 and 19, the speed of the lawn mower 1, and the traveling direction (forward or reverse) of the lawn mower 1 during reverse path travel
- the operation setting data is generated in association with the travel route generated by the unit 302.
- the default setting is forward, and therefore, the reverse direction is set to reverse when the path is the inner reverse path.
- step S15 the operation setting unit 303 records the generated operation data in the removable recording medium 40 attached to the storage unit 33 or the removable recording medium interface unit 34.
- the generated travel route and operation data can be transferred to the control device 10 via the removable recording medium 40. Further, the generated travel route and operation data may be downloaded to the control device 10 via an arbitrary network by the transmission / reception unit 35 of the travel route generation device 3 and the transmission / reception unit 102 of the control device 10.
- the travel route generation device 3 is configured by a tablet computer held by an operator riding on the lawn mower 1 and downloaded to the control device 10 via a wireless LAN.
- the route generation device 3 is provided in the base station, and is downloaded once from the base station directly to the control device 10 or from the base station to an arbitrary computer device such as a tablet computer, and further, such as a tablet computer. It is also conceivable to download to the control device 10 from any computer device.
- the entire travel route is automatically generated, but part or all of the travel route and / or operation data may be generated by the user's designation.
- the user can display the position and direction of the straight path, the shape and direction of the reversing path, the interval between adjacent straight paths, the connecting path, the speed of the lawn mower 1, and the lifting operation of the cutting blades 18 and 19 by the user.
- the outer periphery 50 of the work target area, the outer periphery 51 of the entry prohibition area, and the travel route that is being generated can be designated.
- step S6 the water droplet type, the right half water droplet type, the left half water droplet type, and the switchback type are connected to the end of the straight path as the outer inversion path and then as the inner inversion path. It is determined whether or not the lawnmower 1 traveling on the reversal path interferes with the entry prohibition area, and when a reversal path of a type that does not interfere with the entry prohibition area is found, the reversal path of that type is traveled along the travel path. Selected as.
- the curvature of the outer inversion path of the water drop type, right half water drop type, or left half water drop type is larger than a predetermined value, and the lawn mower 1 traveling on the inversion path is prohibited from entering in the switchback type outer inversion path.
- the switchback type inner inversion path is selected, i.e., depending on the positional relationship between the outer periphery of the work target area and the outer periphery of the non-entry area, the inner inversion path is not used You may comprise so that it may select as a driving
- terrain data other than the outer periphery of the work target area or the entry prohibition area (for example, inclination data) is further recorded in the storage unit 33, and the terrain data other than the outer periphery of the work target area or the entry prohibition area is also stored.
- a travel route may be generated.
- the cutting width projected on the plane is smaller than the cutting width W of the cutting blade. Therefore, in consideration of the inclination, the outer peripheral path C may be corrected and set from the W / 2 inner side of the outer periphery 50 of the work target area so that no uncut portion is generated near the outer periphery 50 of the work target area. Good.
- the straight path may be generated so that the overlap amount of the cutting width in the adjacent straight path is ensured to be a predetermined value or more.
- the reverse route type may be selected with reference to terrain data other than the outer periphery of the work target area and the outer periphery of the entry prohibition area.
- FIG. 8 shows an example of generating a travel route using a skip route as a part.
- a tray-type reversing route is selected for the reversing routes R3, R5, and R7 in relation to the skip route.
- the tray-shaped reversing paths R3, R5, and R7 in FIG. 8 are shorter in distance than the reversing paths R3, R5, and R7 in FIG. 7, and the lawn mower 1 can travel at a higher speed because of its shape, and The turf is hard to damage. Therefore, in this case, it is possible to realize a travel route that requires less work as a whole and hardly damages the turf.
- the present invention is applied to an automatic traveling type work machine.
- the present invention is applied to a work machine that is driven by a human according to navigation of a traveling route displayed on a display device. Is possible.
- the travel route generation device is separate from the travel control device, but the travel route generation device may be incorporated into the travel control device.
- the lawn mower 1 If the lawn mower 1 is to be withdrawn because the hole is used for play before the lawn mowing work in a certain hole is completed, the lawn mower 1 is felt for abnormality and the hole is used for inspection.
- the lawn mower 1 travels for the lawn mowing work, such as when an unplanned obstacle is detected during the lawn mowing work and an emergency stop is required to avoid the obstacle.
- the lawnmower 1 may stop traveling and leave the traveling route for some reason. In that case, the lawn from the last lawn mowing work completion position (hereinafter also simply referred to as “work completion position”) or the first lawn mowing work incomplete position (hereinafter also simply referred to as “work incomplete position”) at the time of travel departure.
- the user moves the lawn mower 1 to the work completion position or the work incomplete position.
- the travel route where the work should be performed the travel route where the work is not performed, and the travel route where the work should be performed are connected, all the work on the travel route where the previous work should be performed is completed.
- the work completion position is a connection point between the travel route where the previous work should be performed and the travel route where the work is not performed, the start point of the travel route where the subsequent work should be performed (the work is not performed)
- the work may be resumed from the position where the travel route and the travel route where the subsequent work should be performed), that is, the work incomplete position. Therefore, in such a case, the user can also move the work machine near the work incomplete position.
- the lawn mower 1 automatically travels along the travel route based on the current position and a predetermined travel route. That is, the lawn mower 1 travels along a predetermined travel route while performing trajectory correction by control such as feedback control and feedforward control. Therefore, when the lawn mower 1 starts traveling from the position near the work completion position or the work incomplete position (hereinafter, also referred to as “(current) position for entry preparation”), the lawn mower 1 enters the current position and the future. The vehicle enters the travel route and travels on the travel route while correcting the track so as to correct the deviation from the travel route to be attempted. Therefore, it is impossible to control at which position on the travel route the lawnmower 1 actually enters the travel route.
- the lawn mower 1 for preparation for entry it is certain that it is impossible to enter the lawn mower 1 only by moving forward in the travel route before the work completion position or the work incomplete position. If the user is informed that the entry is impossible, if it is almost certain, the lawn mower 1 is surely unable to enter or is almost certain from the arrangement for preparation for entry. The traveling of the mower 1 can be avoided, and a more reliable arrangement can be performed.
- the distance between the position for preparation for entry and the travel route, and the travel route The angle of the direction of the lawn mower 1 in the position for preparing the approach relative to the direction of the present inventors have paid attention to the fact that there is a correlation with whether it is necessary along the travel route from the position for the purpose. That is, when the distance between the position for preparation for entry and the travel route is greater than the predetermined first value, or the absolute angle of the direction of the lawn mower 1 at the position for preparation for entry with respect to the direction of the travel route.
- the lawn mower 1 When the value is larger than the predetermined second value, the lawn mower 1 cannot be put on the trajectory of the travel route only by advancing within a certain distance, or almost impossible. Therefore, in these cases, it is certain or almost certain that entry within a certain distance is impossible, so if the user is informed that entry is impossible, the lawn mower 1 can be notified. On the other hand, it is possible to prevent the lawnmower 1 from running from the arrangement for the entry preparation that is surely or almost impossible to enter, and the entry can be performed more reliably. .
- the work completion position or the work incomplete position is located within the certain distance, there is a possibility that discontinuity may occur between the area where the work has been performed and the area where the work will be performed.
- the operation is completed when the distance from the corresponding point to the point where the lawn mower 1 enters the travel route is a distance of a predetermined third value obtained by adding a margin distance in the traveling direction of the work machine on the travel route. Even when the position is closer to the working machine than the position or the work incomplete position, if the user is informed that entry is impossible, the entry can be made more reliably.
- the lawn mower 1 is arranged so that the absolute value of the angle of the direction of the lawn mower 1 at a position for preparation for entry is approximately along the route, that is, with respect to the direction of the travel route, smaller than a predetermined second value. Since this is often easy, if such a case is assumed, consideration of the angle of the direction of the lawn mower 1 at the position for preparation for entry relative to the direction of the travel route can be omitted. .
- the direction of the lawn mower 1 at the position for preparation for entry with respect to the direction of the travel route is a value smaller than a predetermined value
- the direction of the lawn mower 1 is the same as the direction of the travel route.
- the absolute value of the angle of the direction of the lawn mower 1 at the position for preparation for entry with respect to the direction of the traveling path is a value smaller than 90 ° when trying to enter a straight path, the lawn mower It is possible to prevent a mistaken arrangement in which the direction of 1 is opposite to the direction of the travel route.
- the current position for preparation for entry is a position where the lawnmower 1 is located as a result of deviating from the travel route. If the vehicle travels without deviating, the corresponding points on the travel route when considering which point on the travel route corresponds can be used.
- the distance between the position for preparation for entry and the travel route is the distance between the position for preparation for entry and the corresponding point
- the direction of the travel route is a tangent at the corresponding point on the travel route.
- the travel route where the corresponding point exists is a straight route
- the tangent at the corresponding point on the travel route is assumed to coincide with the straight route.
- the nearest point that is the point on the travel route closest to the position for entry preparation can be used.
- the corresponding point is the work completion side nearest point that is the point on the travel route closest to the position for preparation for entry on the opposite side of the direction of travel of the lawn mower 1 from the work completion position or the work incomplete position.
- the work completion side nearest point that is the point on the travel route closest to the position for preparation for entry on the opposite side of the direction of travel of the lawn mower 1 from the work completion position or the work incomplete position.
- the lawn mower is set to the corresponding point rather than the work completion position or the work incomplete position. If the selection is made under the condition that it is located on the opposite side (work completion side) to the traveling direction of 1, it is possible to prevent the vehicle from entering the wrong traveling route portion.
- the predetermined first value and the predetermined second value are determined in consideration of the steering performance of the lawn mower 1, the distance from which the lawn mower 1 is desired to enter the travel route, and the like. Predetermined. In addition, if the predetermined first value and the predetermined second value are too small, the user has to place the lawn mower 1 in a very narrow accessible area. It is preferable that the value and the predetermined second value are values that can be arranged so that they can be entered without being an expert.
- the second value is preferably a predetermined value of 30 ° or less.
- the predetermined third value is determined in consideration of a margin distance from the desired distance from the corresponding point to the point where the lawnmower 1 enters the travel route.
- FIG. 10 shows a state where the lawn mower 1 is arranged at the position 91 for preparation for entry near the work completion position (work incomplete position) 90 on the straight route L6 of the travel route of FIG. It is shown.
- the lawn mower 1 is arranged in a direction A of + 10 ° with respect to the direction of the straight path L6, away from the straight path L6 by a distance d1.
- the user enters in S21.
- Information indicating that the device is to be disconnected is input to the availability determination device 60 via the operation input unit 17 or a device external to the entry availability determination device 60 such as a tablet computer or a base station computer.
- the operation input unit 17 or a device external to the entry propriety determination device 60 such as a tablet computer or a base station computer is connected.
- the lawn mower 1 is instructed through the operation stop position.
- the work completion / unfinished position recording unit 121 records the designated work stop position in the storage unit 108 as a work completion position.
- the lawn mower 1 stops the lawn mowing work when it reaches the designated work stop position. In order to be more accurate, it is possible to use a position where the position where the work is actually stopped is detected instead of the position where the work is instructed by the user.
- the operation completion / incomplete position recording unit 121 stops the travel of the lawn mower 1 triggered by the input of the departure in S21. The position is detected and recorded in the storage unit 108. Then, the work completion / unfinished position recording unit 121 obtains the lawn mowing work completion position with reference to the travel stop position and the operation data stored in the storage unit 108 and records them in the storage unit 108. In other words, if the travel stops during the mowing operation, the travel stop position and the mowing work completion position are almost the same, but if the travel is stopped at a position where the mowing work is not performed, such as a turn route, the travel stops.
- the mowing work completion position is identified by referring to the operation data associated with the travel route. Further, the work completion / unfinished position recording unit 121 obtains the lawn mowing work incomplete position by referring to the work stop position or the travel stop position and the operation data stored in the storage unit 108, and records it in the storage unit 108.
- the work stop position or the travel stop position is on a straight path that is a path for lawn mowing work, and therefore the work incomplete position matches the work completion position.
- the operation data for the lawn mowing is defined in the operation data of the straight routes L7 and L8. Since the operation data of the reversing path R8 defines an operation that does not cut the lawn, if the travel stop position is on the reversing path R8, the lawn mowing work completion position is the intersection P15, the lawn mowing.
- the incomplete work position is specified as the intersection P16.
- the configuration for obtaining the work incomplete position and recording it in the storage unit 108 can be omitted.
- the lawn mower 1 leaves the travel route and is moved to a predetermined location. Thereafter, when the lawn mowing operation is resumed, the lawn mower 1 moves to a work completion position (work incomplete position) 90 (as described above, the work completion position and the work incomplete position in FIG. 10 coincide with each other. It is also moved to a position 91 for preparing the approach of the lawn mower 1 near the “work completion position 90”.
- the user inputs an instruction to determine whether or not to enter, via the operation input unit 17 or a device external to the determination device 60 such as a tablet computer or a base station computer.
- step S24 the current position 91 and the azimuth A for the preparation for entering the lawn mower 1 are detected by the control information generation unit 107 and the vehicle information reception unit 105, which are detection means.
- step S ⁇ b> 25 the corresponding point determination unit 122 determines the nearest point 92 that is the point on the travel route recorded in the storage unit 108 that is closest to the detected current position 91 for preparing the lawn mower 1 for entry.
- the closest point 92 is used as the corresponding point on the travel route corresponding to the current position 91 for the preparation for entering the detected lawn mower 1, but it is more than the above-mentioned work completion position or work incomplete position.
- corresponding points other than the nearest point such as the work completion side nearest point that is the point on the travel route closest to the position for preparation for entry may be used. .
- step S26 the determination information generation unit 123 determines whether or not the distance d1 between the current position 91 for approach preparation and the closest point 92 is greater than a predetermined first value.
- the travel route is a straight route
- the intersection point between the perpendicular to the straight route L6 and the straight route L6 passing through the position 91 for preparation for entry is the closest point 92.
- step S27 the determination information generation unit 123 determines whether or not the absolute value of the angle of the direction A of the lawn mower 1 with respect to the direction of the tangent at the closest point 92 on the travel route is greater than a predetermined second value.
- the traveling route is a straight route, as described above, the tangent at the closest point 92 coincides with the straight route L6, and the direction A of the lawn mower 1 is relative to the direction of the straight route L6. Since the angle is + 10 °, the angle of the direction A of the lawn mower 1 with respect to the direction of the tangent at the nearest point 92 is + 10 °.
- the boundary between the part where the lawn mowing work has already been performed and the part where the lawn mowing work has not yet been performed can be easily discriminated, and it is easy to move the lawn mower 1 to the work completion position or the work incomplete position.
- step S28 the determination information generation unit 123 determines that the point 93 separated from the nearest point 92 in the traveling direction of the lawn mower 1 on the travel path by a predetermined third value d3 is a work completion position or work incomplete. It is determined whether or not it is located on the traveling direction side of the lawn mower 1 with respect to the position 90. In the example of FIG. 10, the point 93 is located before the work completion position 90. Here, there is no problem even if the lawnmower 1 is overlapped with the lawn mower 1, so that the lawn mower 1 is arranged in front of the work completion position or the work incomplete position at a distance with a margin from the beginning. Etc., this step can be omitted.
- step S29 the determination information generation unit 123 determines that entry is possible in all cases in steps S26 to S28.
- step S30 the determination information generation unit 123 determines that entry is not possible if Yes in any of steps S26 to S28.
- the work completion position and the work incomplete position coincide with each other.
- the travel stop position as described above is not on the travel route. If the travel route in which the work is not performed is a travel route in which the lawn mower 1 travels backward, the vehicle travels only within the predetermined distance from the entry preparation position. I can't. Therefore, when using the inside reversal route as the reversal route, it is not usually attempted to enter such a travel route, but the inside reversal route is mistaken for the outer reversal route and the preparation for entry is arranged.
- the lawn mower 1 Since the work completion position is different from the work incomplete position and the travel path connected to the opposite side of the operation direction of the lawn mower 1 with respect to the work incomplete position, the lawn mower 1 moves backward. If it is a travel route that travels at, it is effective in the case of the above misunderstanding if it is determined that entry is impossible.
- step S31 the determination information generation unit 123 generates determination information as to whether or not entry is possible.
- step S32 the notification signal / command generation unit 124 generates a signal and / or command for instructing notification of the entry possible and / or the entry failure based on the generated determination information.
- the presence / absence of entry is notified via the display unit 18, the audio output unit 19, and the like.
- a notification method a known method such as display on a display, sound output by sound output means, lighting by a laminated display lamp, vibration, or the like can be used.
- the travel route may be displayed on the display and which travel route portion (for example, a straight route, a reverse route, etc.) of the displayed travel route may be displayed.
- the determination information generated by the transmission / reception unit 102 and / or inaccessibility to a tablet computer or a base station computer that functions as an ingress / inability notification device separate from the ingress / egress determination device 60 It is also possible to adopt a configuration in which a command for informing the user is transmitted, displayed on a display such as a tablet computer or a base station computer, and / or audio output is performed.
- step S32 when a signal or command for instructing entry is generated, and when it is notified that entry is possible based on the signal or command, the user instructs the control device 10 to start entry (running start) via the operation input unit 17.
- the lawnmower 1 automatically travels based on the current position and the travel route stored in the storage unit 108, that is, travels while correcting the track along the travel route. Therefore, when the lawn mower 1 starts traveling from the position for preparation for entering, the trajectory is corrected so as to correct the deviation between the current position and the traveling path to be entered from now on, and the traveling path before the point 93 is corrected. Enter the road and drive on the driving route. When the lawn mower 1 enters the travel route, the lawn mowing operation is resumed.
- step S ⁇ b> 32 when a signal or command instructing notification that entry is possible is generated in step S ⁇ b> 32 and notification that entry is possible is made based on the signal or command, the user enters the control device 10 via the operation input unit 17.
- start running start
- the content of the determination information generated in step S31 can be entered, in place of the signal or command instructing the notification that entry is possible in step S32.
- a travel control signal for instructing the lawn mower 1 to start entry is generated by the control information generation unit 107, so that the lawn mower 1 can be automatically operated after entering determination without input by the user. It is good also as a structure which starts approach.
- the determination of whether or not to enter once and the notification of the determination result are performed based on the entry determination start instruction input. And you may alert
- the lawn mower 1 entered the travel route from the entry position on the travel route near the work completion position or the work incomplete position, but the work completion position or work including the start position of the travel route. It goes without saying that an arbitrary position located on the opposite side of the traveling direction of the work machine from the unfinished position can be entered into the travel route as an entry position.
- the object of the present invention can be achieved by the computer of the travel route generation device 3 and the control device 10 (entry availability determination device 60) reading and executing the computer program recorded on the recording medium. Therefore, since the computer program itself read from the recording medium implements the method of the present invention, the computer program constitutes the present invention.
- the present invention can be applied to any work machine such as an agricultural machine or a cleaning machine.
- Transmitter / receiver 25 ... GPS antenna 26 ; Communication antenna 3 ... Travel route generator 30 ⁇ control 31 ... Operation input unit 32 ... Display unit 33 ... Storage unit 34 ... Removable recording medium interface unit 35 ... Transmission / reception unit 301 ... Area setting unit 302 ... Path generation unit 303 ..Operation setting unit 304 ... Main control unit 40 ... Removable recording medium 50 ... Outer periphery 51 of work target area ... Outer periphery 60 of entry prohibition area ... Entry permission / inhibition judging device 90 ... Work Completion position (unfinished position) 91 ... (current) position 92 for preparation for entry Nearest point 93 ... A distance of a predetermined third value d3 from the nearest point 92 in the traveling direction of the lawn mower 1 on the travel route Remote point
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- General Physics & Mathematics (AREA)
- Aviation & Aerospace Engineering (AREA)
- Life Sciences & Earth Sciences (AREA)
- Environmental Sciences (AREA)
- Soil Sciences (AREA)
- Mechanical Engineering (AREA)
- Business, Economics & Management (AREA)
- Health & Medical Sciences (AREA)
- Artificial Intelligence (AREA)
- Evolutionary Computation (AREA)
- Game Theory and Decision Science (AREA)
- Medical Informatics (AREA)
- Guiding Agricultural Machines (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
作業対象領域を所定の走行経路に沿って走行しながら所定作業を行う作業機械の現在位置を検出する検出手段と、前記作業機械が、前記走行経路を離脱した場合に、前記走行経路上の作業完了位置又は作業未完位置よりも前記作業機械の進行方向と反対側に位置する進入位置において、前記作業機械が、前記進入位置において前記走行経路を走行する場合の進行方向と同じ方向に進入するようにされた進入経路に沿って、前記作業機械が、前記作業機械の進入準備のための現在位置から前進のみで進入可能か否かを判定し、進入可能か否かの判定情報を生成する判定情報生成部と、を含み、前記判定情報が、前記進入可否判定装置とは別体の進入可否報知装置に送信される進入可否判定装置。
Description
本発明は、例えばゴルフ場、サッカー場等の競技場や河川の堤防、公園緑地、庭園で利用される芝刈り機や清掃車両のような作業機械、作業機械の走行経路への進入可否判定のための装置、方法、プログラム、プログラムを記録した記録媒体、作業機械の走行制御装置に関する。
芝刈り、耕作、清掃などの作業に対して、作業対象領域を、互いに平行な複数の直線経路の端部を反転経路を介して相互に連結して形成された経路を走行する自走式の作業機械が知られている(例えば、特許文献1、2参照)。
ある作業対象領域における作業が終了しないうちに、その作業対象領域が使用されるため作業機械を待避させる場合、作業機械の異常を感じて検査のために作業機械を作業対象領域の外に移動させる場合、作業を行うための走行中に予定外の障害物を検知したため緊急停止をして障害物を回避しなければならない場合等、作業機械が作業のために走行経路を走行している途中で、何らかの事情によって作業機械の走行を停止し、走行経路を離脱する場合がある。その場合、少なくとも走行経路離脱時の最終の作業完了位置(以下、単に「作業完了位置」ともいう。)から作業が再開されるように作業機械を走行経路に復帰させる必要がある。そのため、ユーザは、作業機械を作業完了位置の近くに移動させる。また、作業が行われるべき経路と作業が行われない経路と作業が行われるべき経路が接続されている場合において、前の作業が行われるべき経路の作業がすべて完了しているとき、すなわち走行経路離脱時の作業完了位置が前の作業が行われるべき経路と作業が行われない経路との接続点であるときは、後の作業が行われるべき経路の始点(作業が行われない経路と後の作業が行われるべき経路の接続点)、すなわち走行経路離脱時の最初の作業未完位置(以下、単に「作業未完位置」ともいう。)から作業が再開されればよい。よって、そのような場合は、ユーザは、作業機械を作業未完位置の近くに移動させてもよい。
一方、作業機械は、自動走行の場合、現在位置と所定の走行経路に基づいて走行経路を自動走行する。すなわち、作業機械は、所定の走行経路に沿うように、フィードバック制御やフィードフォワード制御といった制御によって軌道修正を行いながら走行する。したがって、作業機械は、上記の作業完了位置又は作業未完位置の近くの位置(以下、「進入準備のための位置」ともいう。)から走行を開始すると、現在位置とこれから進入しようとする走行経路とのずれを修正するように軌道修正が行いながら、走行経路に進入し、走行経路上を走行することになる。よって、作業機械が、実際に走行経路上のどの位置で走行経路に進入するのかは制御できない。
したがって、作業機械を作業完了位置又は作業未完位置の手前で走行経路に前進のみで進入させることができるような、進入準備のための作業機械の配置を行うことは、熟練を要するし、熟練者でもそのような配置に失敗することがある。
そこで、本発明は、作業機械が走行経路から離脱した場合に、作業機械を作業完了位置又は作業未完位置の手前で走行経路に前進のみで進入させることができるような、進入準備のための作業機械の配置をより確実に行えるようにすることを目的の1つとする。
本発明の1つの態様は、作業対象領域を所定の走行経路に沿って走行しながら所定作業を行う作業機械の現在位置を検出する検出手段と、前記作業機械が、前記走行経路を離脱した場合に、前記走行経路上の作業完了位置又は作業未完位置よりも前記作業機械の進行方向と反対側に位置する進入位置において、前記作業機械が、前記進入位置において前記走行経路を走行する場合の進行方向と同じ方向に進入するようにされた進入経路に沿って、前記作業機械が、前記作業機械の進入準備のための現在位置から前進のみで進入可能か否かを判定し、進入可能か否かの判定情報を生成する判定情報生成部と、を含み、前記判定情報が、前記進入可否判定装置とは別体の進入可否報知装置に送信される進入可否判定装置を提供するものである。
本発明の1つの態様は、作業対象領域を所定の走行経路に沿って走行しながら所定作業を行う作業機械の現在位置を検出する検出手段と、前記作業機械が、前記走行経路を離脱した場合に、前記走行経路上の作業完了位置又は作業未完位置よりも前記作業機械の進行方向と反対側に位置する進入位置において、前記作業機械が、前記進入位置において前記走行経路を走行する場合の進行方向と同じ方向に進入するようにされた進入経路に沿って、前記作業機械が、前記作業機械の進入準備のための現在位置から前進のみで進入可能か否かを判定し、進入可能か否かの判定情報を生成する判定情報生成部と、前記判定情報に基づいて、進入可能及び/又は進入不可能の報知を指示する信号及び/又は命令を生成する報知信号・命令生成部と、を含む進入可否判定装置を提供するものである。
前記判定情報、及び/又は前記進入可能及び/又は進入不可能の報知を指示する信号及び/又は命令は、前記進入可否判定装置とは別体の進入可否報知装置に出力及び/又は送信されることができる。
本発明の1つの態様は、作業対象領域を所定の走行経路に沿って走行しながら所定作業を行う作業機械が、前記走行経路を離脱した場合に、前記走行経路上の作業完了位置よりも前記作業機械の進行方向と反対側に位置する進入位置において、前記作業機械が、前記進入位置において前記走行経路を走行する場合の進行方向と同じ方向に進入するようにされた進入経路に沿って、前記作業機械が、前記作業機械の進入準備のための現在位置から前進のみで進入可能か否かを判定する進入可否判定装置であって、前記作業機械の現在位置と向きを検出する検出手段と、前記走行経路が記録された記憶部と、前記作業機械の前記検出手段によって検出された前記進入準備のための現在位置に対応する、前記記憶部に記録された走行経路上の点である対応点を決定する対応点決定部と、前記進入準備のための現在位置と前記対応点との距離が所定の第1の値よりも大きい場合に、進入不可能と判定し、前記進入可能か否かの判定情報を生成する判定情報生成部と、を含み、前記所定の第1の値は、少なくとも前記作業機械の操舵性能、及び所望の前記対応点から前記作業機械が前記走行経路に進入する点までの距離を考慮して予め定められたものである進入可否判定装置を提供するものである。
前記検出手段は、更に前記作業機械の向きを検出し、前記判定情報生成部は、前記進入準備のための現在位置と前記対応点との距離が所定の第1の値よりも大きく、又は前記走行経路上の前記対応点における接線の方向に対する、前記作業機械の向きの角度の絶対値が所定の第2の値よりも大きい場合に、進入不可能と判定し、前記進入可能か否かの判定情報を生成することができる。
前記所定の第2の値は、30°以下の所定の値とすることができる。
前記進入可否判定装置は、前記作業完了位置を前記記憶部に記録する作業完了位置記録部を更に含み、前記判定情報生成部は、前記所望の前記対応点から前記作業機械が前記走行経路に進入する点までの距離に余裕距離を考慮して定められた第3の値の距離だけ前記走行経路における前記作業機械の進行方向に離れた点が、前記作業完了位置よりも前記作業機械の進行方向側に位置する場合に、進入不可能と判定することができる。
本発明の1つの態様は、作業対象領域を所定の走行経路に沿って走行しながら所定作業を行う作業機械が、前記走行経路を離脱した場合に、前記走行経路上の作業完了位置又は作業未完位置よりも前記作業機械の進行方向と反対側に位置する進入位置において、前記作業機械が、前記進入位置において前記走行経路を走行する場合の進行方向と同じ方向に進入するようにされた進入経路に沿って、前記作業機械が、前記作業機械の進入準備のための現在位置から前進のみで進入不可能か否かを判定する進入可否判定装置であって、前記作業機械の現在位置を検出する検出手段と、前記走行経路が記録された記憶部と、前記作業機械の前記検出手段によって検出された前記進入準備のための現在位置に対応する、前記記憶部に記録された走行経路上の点である対応点を決定する対応点決定部と、前記進入準備のための現在位置と前記対応点との距離が所定の第1の値よりも大きい場合に、進入不可能と判定し、前記進入可能か否かの判定情報を生成する判定情報生成部と、を含み、前記所定の第1の値は、少なくとも前記作業機械の操舵性能、及び所望の前記対応点から前記作業機械が前記走行経路に進入する点までの距離を考慮して予め定められたものである進入可否判定装置を提供するものである。
前記検出手段は、更に前記作業機械の向きを検出し、前記判定情報生成部は、前記進入準備のための現在位置と前記対応点との距離が所定の第1の値よりも大きく、又は前記走行経路上の前記対応点における接線の方向に対する、前記作業機械の向きの角度の絶対値が所定の第2の値よりも大きい場合に、進入不可能と判定し、前記進入可能か否かの判定情報を生成することができる。
前記所定の第2の値は、30°以下の所定の値とすることができる。
前記作業完了位置及び前記作業未完位置を前記記憶部に記録する作業完了・未完位置記録部を更に含み、前記判定情報生成部は、前記所望の前記対応点から前記作業機械が前記走行経路に進入する点までの距離に余裕距離を考慮して定められた第3の値の距離だけ前記走行経路における前記作業機械の進行方向に離れた点が、前記作業完了位置又は前記作業未完位置よりも前記作業機械の進行方向側に位置する場合に、進入不可能と判定することができる。
前記対応点は、前記作業機械の前記検出手段によって検出された前記進入準備のための現在位置に最も近い、前記記憶部に記録された走行経路上の点である最近点とすることができる。
前記対応点は、前記作業完了位置又は前記作業未完位置よりも前記作業機械の進行方向と反対側において、前記作業機械の前記検出手段によって検出された前記進入準備のための現在位置に最も近い、前記記憶部に記録された走行経路上の点である作業完了側最近点とすることができる。
前記進入可否判定装置は、前記判定情報に基づいて、進入可能及び/又は進入不可能の報知を指示する信号及び/又は命令を生成する報知信号・命令生成部を更に含むことができる。
前記判定情報は、前記進入可否判定装置とは別体の進入可否報知装置に送信されることができる。
前記判定情報、及び/又は前記進入可能及び/又は進入不可能の報知を指示する信号及び/又は命令は、前記進入可否判定装置とは別体の進入可否報知装置に出力及び/又は送信されることができる。
前記判定情報の内容が進入可能である場合に、自動走行による進入開始を前記作業機械に指示する信号を生成することができる。
本発明の1つの態様は、前記作業対象領域を走行する前記作業機械の現在位置及び前記記憶部に記録された前記走行経路に少なくとも基づいて、前記作業機械に前記走行経路を走行させるための走行制御信号を出力することにより、前記作業機械が備える走行駆動機構を制御する制御手段と、前記進入可否判定装置と、を含む作業機械制御装置を提供するものである。
本発明の1つの態様は、前記作業機械制御装置と、前記作業機械制御装置から出力される前記走行制御信号に基づいて自己の走行を駆動する走行駆動機構と、を含む作業機械を提供するものである。
本発明の1つの態様は、作業対象領域を所定の走行経路に沿って走行しながら所定作業を行う作業機械の現在位置を検出するステップと、前記作業機械が、前記走行経路を離脱した場合に、前記走行経路上の作業完了位置又は作業未完位置よりも前記作業機械の進行方向と反対側に位置する進入位置において、前記作業機械が、前記進入位置において前記走行経路を走行する場合の進行方向と同じ方向に進入するようにされた進入経路に沿って、前記作業機械が、前記作業機械の進入準備のための現在位置から前進のみで進入可能か否かを判定し、前記進入可能か否かの判定情報を生成するステップと、を含み、前記判定情報が、進入可否報知装置に送信される進入可否判定方法を提供するものである。
本発明の1つの態様は、作業対象領域を所定の走行経路に沿って走行しながら所定作業を行う作業機械の現在位置を検出するステップと、前記作業機械が、前記走行経路を離脱した場合に、前記走行経路上の作業完了位置又は作業未完位置よりも前記作業機械の進行方向と反対側に位置する進入位置において、前記作業機械が、前記進入位置において前記走行経路を走行する場合の進行方向と同じ方向に進入するようにされた進入経路に沿って、前記作業機械が、前記作業機械の進入準備のための現在位置から前進のみで進入可能か否かを判定し、前記進入可能か否かの判定情報を生成するステップと、前記判定情報に基づいて、進入可能及び/又は進入不可能の報知を指示する信号及び/又は命令を生成するステップと、を含む進入可否判定方法を提供するものである。
前記判定情報、及び/又は前記進入可能及び/又は進入不可能の報知を指示する信号及び/又は命令は、進入可否報知装置に出力及び/又は送信されることができる。
本発明の1つの態様は、作業対象領域を所定の走行経路に沿って走行しながら所定作業を行う作業機械が、前記走行経路を離脱した場合に、前記走行経路上の作業完了位置よりも前記作業機械の進行方向と反対側に位置する進入位置において、前記作業機械が、前記進入位置において前記走行経路を走行する場合の進行方向と同じ方向に進入するようにされた進入経路に沿って、前記作業機械が、前記作業機械の進入準備のための現在位置から前進のみで進入可能か否かを判定する進入可否判定方法であって、前記作業機械の現在位置と向きを検出するステップと、前記作業機械の前記検出手段によって検出された前記進入準備のための現在位置に対応する、前記記憶部に記録された走行経路上の点である対応点を決定するステップと、前記進入準備のための現在位置と前記対応点との距離が所定の第1の値よりも大きい場合に、進入不可能と判定し、前記進入可能か否かの判定情報を生成するステップと、を含み、前記所定の第1の値は、少なくとも前記作業機械の操舵性能、及び所望の前記対応点から前記作業機械が前記走行経路に進入する点までの距離を考慮して予め定められたものである進入可否判定方法を提供するものである。
前記検出するステップは、更に前記作業機械の向きを検出し、前記判定情報を生成するステップは、前記進入準備のための現在位置と前記対応点との距離が所定の第1の値よりも大きく、又は前記走行経路上の前記対応点における接線の方向に対する、前記作業機械の向きの角度の絶対値が所定の第2の値よりも大きい場合に、進入不可能と判定し、前記進入可能か否かの判定情報を生成することができる。
前記所定の第2の値は、30°以下の所定の値とすることができる。
前記進入可否判定方法は、前記作業完了位置を記録するステップと、前記所望の前記対応点から前記作業機械が前記走行経路に進入する点までの距離に余裕距離を考慮して定められた第3の値の距離だけ前記走行経路における前記作業機械の進行方向に離れた点が、前記作業完了位置よりも前記作業機械の進行方向側に位置する場合に、進入不可能と判定するステップと、を更に含むことができる。
本発明の1つの態様は、作業対象領域を所定の走行経路に沿って走行しながら所定作業を行う作業機械が、前記走行経路を離脱した場合に、前記走行経路上の作業完了位置又は作業未完位置よりも前記作業機械の進行方向と反対側に位置する進入位置において、前記作業機械が、前記進入位置において前記走行経路を走行する場合の進行方向と同じ方向に進入するようにされた進入経路に沿って、前記作業機械が、前記作業機械の進入準備のための現在位置から前進のみで進入不可能か否かを判定する進入可否判定方法であって、前記作業機械の現在位置を検出するステップと、前記作業機械の前記検出手段によって検出された前記進入準備のための現在位置に対応する、前記記憶部に記録された走行経路上の点である対応点を決定するステップと、前記進入準備のための現在位置と前記対応点との距離が所定の第1の値よりも大きい場合に、進入不可能と判定し、前記進入可能か否かの判定情報を生成するステップと、を含み、前記所定の第1の値は、少なくとも前記作業機械の操舵性能、及び所望の前記対応点から前記作業機械が前記走行経路に進入する点までの距離を考慮して予め定められたものである進入可否判定方法を提供するものである。
前記検出するステップは、更に前記作業機械の向きを検出し、前記判定情報を生成するステップは、前記進入準備のための現在位置と前記対応点との距離が所定の第1の値よりも大きく、又は前記走行経路上の前記対応点における接線の方向に対する、前記作業機械の向きの角度の絶対値が所定の第2の値よりも大きい場合に、進入不可能と判定し、前記進入可能か否かの判定情報を生成することができる。
前記所定の第2の値は、30°以下の所定の値とすることができる。
前記作業完了位置及び前記作業完了位置を記録するステップと、
前記所望の前記対応点から前記作業機械が前記走行経路に進入する点までの距離に余裕距離を考慮して定められた第3の値の距離だけ前記走行経路における前記作業機械の進行方向に離れた点が、前記作業完了位置又は前記作業未完位置よりも前記作業機械の進行方向側に位置する場合に、進入不可能と判定するステップとを更に含むことができる。
前記所望の前記対応点から前記作業機械が前記走行経路に進入する点までの距離に余裕距離を考慮して定められた第3の値の距離だけ前記走行経路における前記作業機械の進行方向に離れた点が、前記作業完了位置又は前記作業未完位置よりも前記作業機械の進行方向側に位置する場合に、進入不可能と判定するステップとを更に含むことができる。
前記対応点は、前記作業機械の前記検出手段によって検出された前記進入準備のための現在位置に最も近い、走行経路上の点である最近点とすることができる。
前記対応点は、前記作業完了位置又は前記作業未完位置よりも前記作業機械の進行方向と反対側において、前記作業機械の前記検出手段によって検出された前記進入準備のための現在位置に最も近い、前記記憶部に記録された走行経路上の点である作業完了側最近点とすることができる。
前記進入可否判定方法は、前記判定情報に基づいて、進入可能及び/又は進入不可能の報知を指示する信号及び/又は命令を生成するステップを更に含むことができる。
前記判定情報は、前記進入可否判定装置とは別体の進入可否報知装置に送信されることができる。
前記判定情報、及び/又は前記進入可能及び/又は進入不可能の報知を指示する信号及び/又は命令は、前記進入可否判定装置とは別体の進入可否報知装置に出力及び/又は送信されることができる。
前記判定情報の内容が進入可能である場合に、自動走行による進入開始を前記作業機械に指示する信号を生成することができる。
本発明の1つの態様は、前記進入可否判定方法をコンピュータに実行させるためのプログラムを提供するものである。
本発明の1つの態様は、前記プログラムを記録したコンピュータ読み取り可能な記録媒体を提供するものである。
本明細書及び特許請求の範囲において、「作業完了位置」、「作業未完位置」とは、作業機械が走行経路から離脱した時の最終の作業完了位置、最初の作業未完位置をそれぞれ意味する。
本明細書及び特許請求の範囲において、「対応点」とは、進入準備のための現在位置が、作業機械が、所定の走行経路から逸脱した結果位置している位置であると仮定した場合に、仮に逸脱することなく走行していたとすると走行経路上ではどの点に対応するかを考えた場合の走行経路上の対応点を意味する。
上記構成を有する本発明によれば、作業機械が走行経路から離脱した場合に、作業機械を作業完了位置又は作業未完位置の手前で走行経路に前進のみで進入させることができるような、進入準備のための作業機械の配置をより確実に行うことができる。
以下、本発明の作業機械、作業機械の走行経路への進入可否判定のための装置、方法、プログラム、プログラムを記録した記録媒体、作業機械の走行制御装置を、ゴルフ場の芝刈りを行う芝刈り機に適用した場合の実施の形態例を説明する。一般的な芝刈り機は、前進しながら芝刈り作業を行うように設計されている。ゴルフ場のグリーン等の芝を刈る場合、ライン状に芝が刈られた後の隣り合うラインの芝目がそれぞれ逆方向となるように芝刈り機に規則的に芝刈り作業を行わせることが望まれる。グリーン等とラフとの境界についても、なるべく滑らかになるように芝刈り作業を行うことが望まれる。
そのため、本実施形態では、芝刈対象領域であるグリーン等の周縁の芝を刈るための外周経路、及び、グリーン等の芝を規則的に刈るための反転経路を介して相互に連結された略平行な直線経路を芝刈り機に走行させ、それぞれの経路で芝刈り作業させる場合の例を説明する。ここで、本実施形態は、隣接する直線経路が反転経路を介して連結して形成され、芝刈り機が隣接する直線経路を順次逆方向に走行する例を説明するが、例えば特許第3454666号に示されるように、ある直線経路が、いくつかの隣接する直線経路を飛ばした直線経路に反転経路を介して連結して形成された経路(以下、「飛ばし経路」ともいう。)を走行経路の一部又は全部としてもよい。また、略平行な直線経路に替えて、略平行な曲線経路としてもよい。
なお、直線経路での作業が終了した後に外周経路での芝刈り作業を開始するか、外周経路での芝刈り作業を先行させるかは任意であるが、本実施形態では、前者の例を説明する。
<全体概要>
芝刈り作業に必要となる装置類の全体概要を図1(a)、(b)に示す。本実施形態では、RTK-GPS方式(Real Time Kinematic GPS:干渉測位方式)を用いて、現在位置の計測を行いながらゴルフ場の芝刈り作業を行う芝刈り機1の例を示す。
芝刈り作業に必要となる装置類の全体概要を図1(a)、(b)に示す。本実施形態では、RTK-GPS方式(Real Time Kinematic GPS:干渉測位方式)を用いて、現在位置の計測を行いながらゴルフ場の芝刈り作業を行う芝刈り機1の例を示す。
基地局2は、RTK-GPSの基準局に相当するGPS受信装置21及び送受信装置22と、GPSアンテナ25と、通信アンテナ26とを備えている。基地局2は、その経度、緯度、高さが既知の地点に設置される。GPS受信装置21は、芝刈り機1の位置情報の誤差を補正するための補正情報を生成する。この補正情報は、送受信装置22及び通信アンテナ26を通じて、芝刈り機1へ適宜送信される。補正情報の送信タイミングは、例えば、芝刈り機1が要求するタイミングであったり、所定の間隔(例えば100ms毎)であったりする。
本実施形態においては、測位方式として、RTK-GPS方式を用いているが、デファレンシャルGPS方式(Differential GPS:相対測位方式)を用いてもよい。
芝刈り機1は、制御装置10、車速センサ11、方位角速度センサ12、駆動制御部13、GPSアンテナ15、通信アンテナ16、操作入力部17、表示部18、音声出力部19を備えている。
制御装置10は、本発明の作業機械制御装置の一例となるもので、CPU、通信機能、ストレージ機能(内部記録媒体並びに外部記録媒体に対するドライブユニット及び/又は入出力インタフェース)及び表示機能(ディスプレイ)を備えたコンピュータ装置と、所定のコンピュータプログラムとで構成される。このコンピュータプログラムは、コンピュータ装置を、GPS受信部101、送受信部102、車両情報受信部105、駆動指令部106、制御情報生成部107、記憶部108、リムーバブル記録媒体インタフェース部109、主制御部112、作業完了・未完位置記録部121、対応点決定部122、判定情報生成部123、報知信号・命令生成部124として機能させる。主制御部112は、各部の動作を統括的に制御する。このコンピュータ装置は、時刻データと制御動作の同期クロックとを出力するRTC(Real Time Clock)モジュールを備えたものである。芝刈り機が方位角速度センサを備えていない等の場合のために、制御装置10が、方位角速度センサを備えてもよい。制御装置10の詳細については後述する。
車速センサ11は、芝刈り機1の前進又は後退する際の走行速度を検出する。方位角速度センサ12は、三次元軸線回り(ロール、ピッチ、ヨー)の角速度により芝刈り機1の傾き、旋回、ふらつき等の挙動(動態)を検出する。方位角速度センサ12で計測すべきデータを加速度計で代用しても良い。また、芝刈り機1が備える各種計器の計測結果を取り込むことで、センサ11,12を代用することもできる。
駆動制御部13は、後述する作業制御信号に基づいて芝刈り機1が備える刈り刃の昇降及び作動等を駆動する作業駆動機構を制御したり、後述する走行制御信号に基づいて芝刈り機1の右左折、前進、後退等を駆動する走行駆動機構を制御する。この駆動制御部13は、図示されるように、制御装置10とは別に設けても良いが、制御装置10の一機能として実現しても良い。
GPSアンテナ15は、GPS衛星から送信されたGPSデータを受信する位置検出センサとして機能するものである。通信アンテナ16は、基地局2の通信アンテナ26との間の通信を可能にする。この通信は、上記の芝刈り機1の位置情報の誤差を補正するための補正情報、芝刈り機1のオペレータとの通信、芝刈り機1の遠隔操作のための信号等の送受信に使用される。
操作入力部17は、キーボードやマウス等から構成されるが、これらに限定されるものではない。
表示部18は、CRT、液晶ディスプレイ、積層表示灯等から構成されるが、これらに限定されるものではない。
音声出力部19は、スピーカ等から構成されるが、これに限定されるものではない。
走行経路生成装置3は、CPU、通信機能、ストレージ機能(内部記録媒体並びに外部記録媒体に対するドライブユニット及び/又は入出力インタフェース)、入力機能(キーボード、マウス等)、表示機能(ディスプレイ)を備えたコンピュータ装置と、所定のコンピュータプログラムとで構成される。このコンピュータプログラムは、コンピュータ装置を、領域設定部301、経路生成部302、動作設定部303、主制御部304を含む制御部30、操作入力部31、表示部32、記憶部33、リムーバブル記録媒体インタフェース部34、送受信部35として機能させる。主制御部304は、各部の動作を統括的に制御する。走行経路生成装置3の詳細については後述する。
<芝刈り機>
芝刈り機1の外観を図2(a)、(b)に示す。図2(a)は芝刈り機1を側面から見た外観図、同(b)は上面から見た外観図である。上述した制御装置10、車速センサ11、方位角速度センサ12、駆動制御部13、及び走行駆動機構及び作業駆動機構は、芝刈り機1の機体に内蔵されている。
芝刈り機1の外観を図2(a)、(b)に示す。図2(a)は芝刈り機1を側面から見た外観図、同(b)は上面から見た外観図である。上述した制御装置10、車速センサ11、方位角速度センサ12、駆動制御部13、及び走行駆動機構及び作業駆動機構は、芝刈り機1の機体に内蔵されている。
方位角速度センサ12は、芝刈り機1の挙動が正しく伝達される位置に設置される。GPSアンテナ15は、芝刈り機1の機体のほぼ中心部位、すなわち機体の長さ方向と幅方向それぞれのほぼ中心となるように備えられる。また、通信アンテナ16は、GPSアンテナ15の受信の障害にならないように芝刈り機1の機体の後方表面から突出するように取り付けられる。
芝刈り機1は、芝を刈るための一対の刈り刃18、19を備えている。前方の刈り刃18は、走行方向と直交する方向の刈り幅W[m]のうち、左右端の芝を刈り取る。後方の刈り刃19は、刈り幅W[m]のうち、中央部の芝を刈り取る。この刈り幅W[m]が、芝刈り機1の1回の走行、作業で芝を刈りとることができる作業幅となる。
<制御装置>
図1(a)に戻り、制御装置10のGPS受信部101は、GPSアンテナ15で受信したGPSデータを制御情報生成部107へ出力する。送受信部102は、通信アンテナ16を介して、制御情報生成部107と基地局2との間の通信を可能にし、通信アンテナ16で受信した芝刈り機1の位置情報の誤差を補正するための補正情報を制御情報生成部107に出力する。制御情報生成部107は、GPSアンテナ15で受信したGPSデータと通信アンテナ16で受信した芝刈り機1の位置情報の誤差を補正するための補正情報に基づいて、芝刈り機1の現在位置を表す位置情報を生成する。また、送受信部102は、有線若しくは無線、又はLAN(Local Area Network)若しくは公衆通信回線を問わず任意のネットワークに接続されることができる。
図1(a)に戻り、制御装置10のGPS受信部101は、GPSアンテナ15で受信したGPSデータを制御情報生成部107へ出力する。送受信部102は、通信アンテナ16を介して、制御情報生成部107と基地局2との間の通信を可能にし、通信アンテナ16で受信した芝刈り機1の位置情報の誤差を補正するための補正情報を制御情報生成部107に出力する。制御情報生成部107は、GPSアンテナ15で受信したGPSデータと通信アンテナ16で受信した芝刈り機1の位置情報の誤差を補正するための補正情報に基づいて、芝刈り機1の現在位置を表す位置情報を生成する。また、送受信部102は、有線若しくは無線、又はLAN(Local Area Network)若しくは公衆通信回線を問わず任意のネットワークに接続されることができる。
車両情報受信部105は、車速センサ11及び方位角速度センサ12、及び/又はGPSデータによる位置の追跡から、芝刈り機1の走行速度、方位、挙動を表す検知情報を取得する。取得した情報がアナログデータの場合には、それらをデジタルデータに変換して出力する。その際、必要に応じて、方位角速度センサ12の出力からオフセット成分及びドリフト成分の除去処理等を施すデータ補正を行う。車両情報受信部105の出力情報は、現在時刻データと関連付けて、記憶部108に記録される。
駆動指令部106は、制御情報生成部107の出力情報(走行制御信号/作業制御信号)に基づいて、芝刈り機1を走行制御あるいは作業制御するために走行駆動機構あるいは作業駆動機構の制御内容を定めた情報を駆動制御部13へ出力する。駆動制御部13は、この情報をもとに、芝刈り機の走行駆動機構あるいは作業駆動機構を制御する。これにより、芝刈り機1による芝刈り作業が可能となる。
記憶部108は、後述の走行経路生成装置3により生成された走行経路及び動作データや所定のコンピュータプログラム等を記録することができる。記憶部108は、ハードディスクや半導体メモリ等の任意の数の記憶部品から構成されるが、これらに限定されるものではない。
リムーバブル記録媒体インタフェース部109には、CD-ROMやDVD等の光ディスク、USBメモリ、SDメモリカード等のリムーバブル記録媒体40が着脱自在に装着することができる。また、リムーバブル記録媒体インタフェース部109は、装着されたリムーバブル記録媒体40に記録されたデータを読み出したり、リムーバブル記録媒体40にデータを書き込んだりすることができる。リムーバブル記録媒体インタフェース部109は、例えばリムーバブル記録媒体40がCD-ROMやDVD等の光ディスクであれば専用のリーダ/ライタ等であり、USBメモリであればUSBポート等であり、SDメモリカードであればカードスロット等であるが、これらに限定されるものではない。
後述の走行経路生成装置3により生成された走行経路及び動作データが、記憶部108又はリムーバブル記録媒体インタフェース部109に装着されたリムーバブル記録媒体40に記録されており、制御情報生成部107は、その走行経路及び動作データとGPSデータや各種センサ11等より取得した現在位置とに基づいて、走行制御信号及び作業制御信号を生成し、出力する。これにより自動走行による作業を可能にする。
制御装置10に含まれる進入可否判定装置60に特有の構成である、作業完了・未完位置記録部121、対応点決定部122、判定情報生成部123、報知信号・命令生成部124については、次の<進入可否判定装置>の項で説明する。
<進入可否判定装置>
進入可否判定装置60は、本発明の進入可否判定装置の一例となるもので、図1aの制御装置10内の点線で囲まれた部分に相当する。上で説明した制御装置10の構成と重複する構成については説明を省略する。
進入可否判定装置60は、本発明の進入可否判定装置の一例となるもので、図1aの制御装置10内の点線で囲まれた部分に相当する。上で説明した制御装置10の構成と重複する構成については説明を省略する。
作業完了・未完位置記録部121は、芝刈り機1が芝刈り作業のために走行経路を走行している途中で、芝刈り機1の走行を停止し、走行経路を離脱した時の最終の芝刈り作業完了位置及び最初の芝刈り作業未完位置を記憶部108に記録する。
対応点決定部122は、検出された芝刈り機1の進入準備のための現在位置に最も近い、記憶部108に記録された走行経路上の点である最近点を決定する。
判定情報生成部123は、芝刈り機1の進入準備のための現在位置と最近点との距離が所定の第1の値よりも大きく、又は走行経路上の最近点における接線に対する、進入準備のための現在位置における芝刈り機1の向きの角度の絶対値が所定の第2の値よりも大きい場合に、芝刈り機1の走行経路への進入が不可能であると判定し、進入可能か否かの判定情報を生成する。
報知信号・命令生成部124は、判定情報に基づいて、進入可能及び/又は進入不可能の報知を指示する信号又は命令を生成する。
作業完了・未完位置記録部121、対応点決定部122、判定情報生成部123、報知信号・命令生成部124の動作の詳細については後述する。
<走行経路生成装置>
芝刈り機1が走行するための走行経路は、走行経路生成装置3によって生成される。図1(b)を参照して、操作入力部31は、キーボードやマウス等から構成されるが、これらに限定されるものではない。表示部32は、CRTや液晶ディスプレイ等から構成されるが、これらに限定されるものではない。
芝刈り機1が走行するための走行経路は、走行経路生成装置3によって生成される。図1(b)を参照して、操作入力部31は、キーボードやマウス等から構成されるが、これらに限定されるものではない。表示部32は、CRTや液晶ディスプレイ等から構成されるが、これらに限定されるものではない。
記憶部33は、後述の走行経路生成装置3により生成された走行経路及び動作データや所定のコンピュータプログラム等を記録することができる。記憶部33は、ハードディスクや半導体メモリ等の任意の数の記憶部品から構成されるが、これらに限定されるものではない。
リムーバブル記録媒体インタフェース部34には、CD-ROMやDVD等の光ディスク、USBメモリ、SDメモリカード等のリムーバブル記録媒体40が着脱自在に装着することができる。また、リムーバブル記録媒体インタフェース部109は、装着されたリムーバブル記録媒体40に記録されたデータを読み出したり、リムーバブル記録媒体40にデータを書き込んだりすることができる。リムーバブル記録媒体インタフェース部109は、例えばリムーバブル記録媒体40がCD-ROMやDVD等の光ディスクであれば専用のリーダ/ライタ等であり、USBメモリであればUSBポート等であり、SDメモリカードであればカードスロット等であるが、これらに限定されるものではない。
送受信部35は、有線若しくは無線、又はLAN(Local Area Network)若しくは公衆通信回線を問わず任意のネットワークに接続されることができる。送受信部35は、例えば、後述の走行経路生成装置3により生成された走行経路及び動作データをネットワークを介して制御装置1に送信することができる。
制御部30は、領域設定部301、経路生成部302、動作設定部303を有する。領域設定部301は、芝刈り機1が芝刈り作業を行う作業対象領域の外周50、及び崖、バンカー、岩、立木などの存在のために芝刈り機1の進入が禁止である進入禁止領域51の外周の設定を行う。
具体的には、領域設定部301は、図3(b)に、座標A1、A2、・・・、An、座標I11、I12、I13、・・・、座標I21、I22、I23、・・・として例示されるような、GPSデータ等を用いる公知の測量装置によって実際に測量された作業対象領域の外周50及び進入禁止領域の外周51についての離散的な位置情報の集合が記録された記録媒体の情報をリムーバブル記録媒体インタフェース部を介して読み出し、作業対象領域の外周50及び進入禁止領域の外周51についての離散的な位置情報の隣り合う座標の各々を繋いだものを作業対象領域の外周50及び進入禁止領域の外周51として記憶部33に記録する。測量装置はGPSデータ等を用いるものに限定されず、任意のものを用いることができる。また、作業対象領域の外周50及び進入禁止領域の外周51についての緯度経度などを操作入力部31を介して直接入力してもよい。設定された作業対象領域の外周50及び進入禁止領域の外周51を任意の方法で修正することができるようにしてもよい。
経路生成部302は、領域設定部301によって設定された作業対象領域の外周50に基づいて外周経路Cを生成する。経路生成部302は更に、後述のとおり、生成された外周経路Cに基づいて、直線経路を生成するとともに、例えば、任意に設定された自動走行開始位置から、ある直線経路の作業開始位置までの走行経路、全ての直線経路での作業が終了した位置から外周経路の作業開始位置までの走行経路、外周経路の作業終了位置から任意に設定された自動走行終了位置までの走行経路である「つなぎ経路」をも生成する。つまり、芝刈り機1が走行すべき経路を記憶部33に記録する。
経路生成部302は、操作入力部31を介して入力された芝刈り機1の機体サイズ、刈り刃の刈り幅、最小旋回半径や旋回時に描く曲線の形状等の旋回特性を含む属性情報、隣接する直線経路間の間隔と、作業対象領域の外周50と進入禁止領域の外周51との位置関係とに基づいて、一つの直線経路(第1直線経路)を走行し終えた芝刈り機1が次の直線経路(第2直線経路)へと方向転換するための反転経路のタイプを、少なくとも反転経路上を走行する芝刈り機1が進入禁止領域の外周51に干渉しないように選択し、第1及び第2直線経路に連結し、走行経路として記憶部33に記録する。
動作設定部303は、経路生成部302によって生成された走行経路と関連づけられた、芝刈り機1の走行中あるいは停止中の刈り刃18,19の昇降動作や刈り刃18,19の回転の起動又は停止などを含む芝刈り作業に係る各種設定、芝刈り機1の速度や反転経路走行時の進行方向(前進又は後進)を含む動作データを生成する。
以上の装置構成を前提に、本発明の一実施形態に係る走行経路生成装置の走行経路生成処理の例を図4に示すフローチャート、図7に示す生成される走行経路等を参照して、以下に説明する。なお、説明の便宜上、図7における、作業対象領域の外周50、進入禁止領域の外周51、直線経路、反転経路の各々の縮尺や形状は一部正確ではない。
ステップS1において、上述のように、領域設定部301は、図3(b)に、座標A1、A2、・・・、An、座標I11、I12、I13、・・・、座標I21、I22、I23、・・・として例示されるような、GPSデータ等を用いる公知の測量装置によって実際に測量された作業対象領域の外周50及び進入禁止領域の外周51についての離散的な位置情報の集合が記録された記録媒体の情報をリムーバブル記録媒体インタフェース部を介して読み出し、作業対象領域の外周50及び進入禁止領域の外周51についての離散的な位置情報の隣り合う座標の各々を繋いだものを作業対象領域の外周50及び進入禁止領域の外周51として記憶部33に記録する。
ステップS2において、操作入力部31を介して、芝刈り機1の機体サイズ、速度特性、刈り刃の刈り幅、最小旋回半径や旋回時に描く曲線の形状等の旋回特性を含む属性情報、隣接する直線経路間の間隔が入力される。入力される情報の一部又は全部は、記憶部33に予め記憶しておき、これを読み出す方式としてもよい。ここで、隣接する直線経路間の間隔は、刈り刃の刈り幅に基づいて、隣接する直線経路での刈り幅のオーバーラップ量を考慮して決められるものであり、入力された刈り刃の刈り幅に基づいて経路生成部302が自動計算をしてもよい。
ステップS3において、外周経路Cは、刈り刃18の刈り幅Wを考慮すると、作業対象領域の外周50から約W/2[m]だけ内側となるので、経路生成部302は、作業対象領域の外周50から外周経路Cを生成する。
ステップS4において、経路生成部302は、生成された外周経路Cに基づいて直線経路を生成する。まず、直線経路の作業開始位置Plsと作業開始位置Plsに対向する直線経路の端部P1が操作入力部31を介して指定される。この作業開始位置Plsと端部P1を通過する直線とステップS2で入力された隣接する直線経路間の間隔だけ離れて生成された直線群の中から、外周経路Cとの交点を持つものを選択して、その交点につながる線分を直線経路とする。
例えば、図5に示すように、外周経路Cと直線経路との交点のうち、作業開始位置Plsである交点(座標)をP0とする。また、外周経路Cを挟んで交点(座標)P0(Pls)と対向する交点(座標)がP1となる。さらに、交点(座標)P1に対して反時計回り方向で隣接する交点(座標)をP2、外周経路Cを挟んで交点(座標)P2と対向する交点(座標)をP3とする。以下同様に、交点(座標)P4から交点(座標)P19(Ple)まで、順番に番号を割り当てていく。このように、複数の交点(座標)に対して0から順番に番号を割り当てていく作業をラベリングといい、番号をラベルという。ラベリングの順番が、芝刈り機1が直線経路を走行する際に通過する、外周経路Cとの交点(座標)の順番となる。
つまり、芝刈り機1は、交点(座標)P0(Pls)から交点(座標)P1に向かって直線経路を走行し、その後、交点(座標)P2から交点(座標)P3に方向転換して、順次、直線経路を走行する。交点(座標)P4以降についても同様となる。
設定された作業対象領域の外周50と進入禁止領域の外周51、生成された直線経路は表示部32に表示され、ユーザは操作入力部31を介した入力によって、生成された直線経路の位置や方向、隣接する直線経路間の間隔等の修正を行うことができる。
本実施形態では、略平行な経路を直線経路としたが、任意の曲線経路としてもよい。
本実施形態では、直線経路の作業開始位置Plsに対して、作業開始位置Plsに対向する直線経路の端部P1を指定することによって直線経路の傾きを決定したが、直線経路の作業開始位置Plsを指定した後に、経路生成部302が、記憶部30に記憶されたユーザが予め設定した規則に基づいて、直線経路の傾き(曲線経路の場合は曲線経路の方向)を自動的に決定してもよい。ユーザが予め設定する規則としては、例えば、指定された直線経路の作業開始位置Plsを通過する直線及びその直線に基づく直線群を、直線経路の作業開始位置Plsを中心として回転させ、外周経路Cとの交点につながる線分群において最大の長さの線分が得られる傾きを直線経路の傾きとすることが考えられる。
本実施形態では作業領域は一つの方向の直線で刈り込んだ一つの面で構成されるが、ゴルフ場でのドックレッグコースのような場合では、全体を同じ方向に刈り込まず、コースをいくつかの部分に分けて、その各部分について刈り込む方向を一つの方向に揃える場合がある。そのような場合には、各部分の領域を、例えば操作入力部31を介して指定し、各部分について、ステップS4以下の処理をそれぞれ実施すればよい。
ステップS5において、経路生成部302は、入力された属性情報と隣接する直線経路間の間隔に基づいて、図6に示すような水滴型、右半水滴型、左半水滴型、スイッチバック型の反転経路を、それぞれの反転経路のタイプに対応する所定のアルゴリズムを用いて生成し、記憶部33に記録する。本実施形態では、各タイプの反転経路は各1つ生成されるが、各タイプの反転経路について、曲率の異なる複数の反転経路を生成してもよい。ここで、例えば最小旋回半径が大きい等、芝刈り機1の旋回性能によっては、隣接する直線経路間の間隔が小さい場合、水滴型、右半水滴型、左半水滴型のいずれかが生成禁止である場合がある。
水滴型の反転経路の特徴は、左右の両側で急激なカーブがないため、運転性(drivability)がよいが、作業対象領域の外周50と進入禁止領域の外周51が接近している場合に、反転経路上を走行する芝刈り機1と進入禁止領域の外周51との間に干渉が生じやすい。また、反転経路の曲率が大きい場合は、芝を傷めやすい。
右半水滴型の反転経路の特徴は、反転経路の左側について進入禁止領域の外周51への干渉を避けやすいことが挙げられる。左半水滴型の反転経路についても同様に、反転経路の右側について進入禁止領域の外周51への干渉を避けやすい。
スイッチバック型の反転経路は、図6に示されるように、2つのスイッチバック点(切り返し点)を有し、始点と第1のスイッチバック点、第1のスイッチバック点と第2のスイッチバック点、第2のスイッチバック点と終点はそれぞれ緩和曲線であるクロソイド曲線をベースとしている。スイッチバック型の反転経路の特徴は、反転経路が緩和曲線であるクロソイド曲線をベースとして構成されているので、芝を傷めにくい。一方、反転には時間がかかる。
また、反転経路の方向のタイプは、芝刈り機1が反転経路に作業対象領域の外側方向に進入する外側反転経路と、芝刈り機1が反転経路に作業対象領域の内側方向に進入する内側反転経路が用意されている。外側反転経路においては、芝刈り機1は反転経路に前進で進入することになり、内側反転経路においては、芝刈り機1は反転経路に後進で進入することになる。
ステップS6において、水滴型、右半水滴型、左半水滴型、スイッチバック型の順で、隣接する一対の直線経路の端部に外側反転経路として接続された反転経路上を走行する芝刈り機1が進入禁止領域に干渉するか否かを判定し、進入禁止領域に干渉しないタイプの反転経路が発見された時点で、ステップS7において、そのタイプの反転経路を走行経路として選択し、隣接する一対の直線経路の端部に連結する。このとき、通常、生成された反転経路の始点又は終点のいずれかと隣接する一対の直線経路の端部にいずれかとの間に間が空くので、その直線経路に重なるか又はその直線経路の延長となる直線を補充して連結する。
例えば、図7において、生成された水滴型の反転経路を外側反転経路として、隣接する一対の直線経路L3、L4の端部である交点(座標)P5、P6に接続してみると、その反転経路上を走行する芝刈り機1は進入禁止領域に干渉する。そこで、次に生成された右半水滴型の反転経路を外側反転経路として、交点(座標)P5、P6に接続してみると、なお進入禁止領域に干渉する。そこで、生成された左半水滴型の反転経路を外側反転経路として、交点(座標)P5、P6に接続してみると、進入禁止領域に干渉しなくなるので、この左半水滴型の反転経路を走行経路R3として選択する。そして、左半水滴型の反転経路の終点を交点(座標)P6に連結すると、左半水滴型の反転経路の始点と交点(座標)P5との間に間が空くので、直線経路L3の延長となる直線を補充して、左半水滴型の反転経路を交点(座標)P5に連結する。
ステップS8において、いずれのタイプの反転経路を外側反転経路として接続しても反転経路上を走行する芝刈り機1が進入禁止領域の外周51に干渉する場合は、同様に水滴型、右半水滴型、左半水滴型、スイッチバック型の順で、隣接する一対の直線経路の端部に内側反転経路として接続された反転経路上を走行する芝刈り機1が進入禁止領域に干渉するか否かを判定し、進入禁止領域に干渉しないタイプの反転経路が発見された時点で、ステップS9において、そのタイプの反転経路を走行経路として選択し、隣接する一対の直線経路の端部に連結する。このとき、通常、生成された反転経路の始点又は終点のいずれかと隣接する一対の直線経路の端部にいずれかとの間に間が空くので、その直線経路に重なるか又はその直線経路の延長となる直線を補充して連結する。
例えば、図7において、隣接する一対の直線経路L1、L2の端部である交点(座標)P1、P2については、いずれのタイプの反転経路についても外側反転経路として接続した場合は、反転経路上を走行する芝刈り機1は進入禁止領域に干渉する。そこで、生成された水滴型の反転経路を内側反転経路として、交点(座標)P1、P2に接続してみると、進入禁止領域に干渉しなくなるので、この左半水滴型の反転経路を走行経路R1として選択する。そして、水滴型の反転経路の始点を交点(座標)P1に連結すると、水滴型の反転経路の終点と交点(座標)P2との間に間が空くので、直線経路L2と重なる直線を補充して、水滴型の反転経路を交点(座標)P2に連結する。
なお、グリーン等の内部にバンカーや池等が存在する等の理由によって、ステップS9において、適切なタイプの反転経路が発見されなかった場合は、表示部32や図示されていない音声出力部を用いてその旨をユーザに知らせる。芝刈り機1が、走行経路を生成しながら遠隔操縦されている場合は、送受信部35を介して遠隔操縦しているユーザに知らせてもよい。そして、ユーザは、反転経路の形状を操作入力部31を介して指定するようにする。
ステップS10において、ステップS6~S9を、隣接する一対の直線経路のすべてについて終了するまで繰り返す。
ステップS11において、操作入力部31を介して、走行開始位置Pts、走行終了位置Pteを指定する。
ステップS12において、経路生成部302は、指定された走行開始位置Pts、走行終了位置Pte、ステップS3で入力された属性情報に基づいて、走行開始位置Ptsから、ある直線経路の作業開始位置Plsまでの走行経路J1、全ての直線経路での作業が終了した位置Pleから外周経路の作業開始位置Pcsまでの走行経路J2、外周経路の作業終了位置Pceから走行終了位置Pteまでの走行経路であるつなぎ経路J3を所定のアルゴリズムにより生成する。これにより、走行開始位置、反転経路を介して直線経路が相互に連結して形成された走行経路、外周経路、走行終了位置が、つなぎ経路により接続され、全走行経路が生成される。
設定された作業対象領域の外周50と進入禁止領域の外周51、生成された全走行経路は表示部32に表示され、ユーザは操作入力部31を介した入力によって、走行経路の修正を行うことができる。例えば、ある選択された反転経路を、既に生成された水滴型、右半水滴型、左半水滴型、スイッチバック型の反転経路の1つに置き換えることができる。また、例えば、直線経路の位置や方向、隣接する直線経路間の間隔、反転経路の形状をユーザの指定のものに変更することもできる。
ステップS13において、経路生成部302は、生成された全走行経路を記憶部33又はリムーバブル記録媒体インタフェース部34に装着されたリムーバブル記録媒体40に記録する。
ステップS14において、動作設定部303は、操作入力部31を介して入力された芝刈り機1属性情報に基づいて、芝刈り機1の走行中あるいは停止中の刈り刃18,19の昇降動作や刈り刃18,19の回転の起動又は停止などを含む芝刈り作業に係る各種設定、芝刈り機1の速度、芝刈り機1の反転経路走行時の進行方向(前進又は後進)を、経路生成部302によって生成された走行経路と関連づけて行い、動作設定データを生成する。
芝刈り機1の反転経路走行時の進行方向(前進又は後進)については、デフォルトの設定が前進であるので、内側反転経路である場合に後進とする。
ステップS15において、動作設定部303は、生成された動作データを記憶部33又はリムーバブル記録媒体インタフェース部34に装着されたリムーバブル記録媒体40に記録する。
生成された走行経路及び動作データは、リムーバブル記録媒体40を介して制御装置10に移すことができる。また、生成された走行経路及び動作データは、走行経路生成装置3の送受信部35及び制御装置10の送受信部102によって任意のネットワークを介して制御装置10にダウンロードしてもよい。例えば、芝刈り機1に乗車しているオペレータが持っているタブレット型のコンピュータで走行経路生成装置3を構成し、無線LAN経由で制御装置10にダウンロードすることが考えられる。また、基地局に経路生成装置3を設け、基地局から直接制御装置10に、又は基地局からタブレット型のコンピュータのような任意のコンピュータ装置に一旦ダウンロードし、更にそのタブレット型のコンピュータのような任意のコンピュータ装置から制御装置10にダウンロードすることも考えられる。
本実施形態によれば、作業対象領域の外周と進入禁止領域の外周が接近していても、作業対象領域の全域にわたって作業を行うことを可能とする作業機械の走行経路を生成することができる。
上記の実施形態においては、全走行経路は自動生成されたが、走行経路及び/又は動作データの一部又は全部をユーザの指定により生成してもよい。例えば、直線経路の位置や方向、反転経路の形状や方向、隣接する直線経路間の間隔、つなぎ経路、芝刈り機1の速度、刈り刃18,19の昇降動作は、ユーザが、表示部32に表示された作業対象領域の外周50、進入禁止領域の外周51、生成中の走行経路を参照して、指定する構成とすることができる。
上記の実施形態においては、ステップS6において、水滴型、右半水滴型、左半水滴型、スイッチバック型の順で、外側反転経路として、次いで内側反転経路として、直線経路の端部に接続された反転経路上を走行する芝刈り機1が進入禁止領域に干渉するか否かを判定し、進入禁止領域に干渉しないタイプの反転経路が発見された時点で、そのタイプの反転経路を走行経路として選択した。しかしながら、作業対象領域の外周と進入禁止領域の外周との位置関係によっては、進入禁止領域の外周とは干渉しない水滴型、右半水滴型、又は左半水滴型の外側反転経路はあるが、その反転経路の曲率が大きく芝を傷める可能性があり、一方でスイッチバック型の外側反転経路では反転経路上を走行する芝刈り機1が進入禁止領域の外周と干渉してしまう場合が考えられる。したがって、水滴型、右半水滴型、又は左半水滴型の外側反転経路の曲率が所定の値よりも大きく、スイッチバック型の外側反転経路では反転経路上を走行する芝刈り機1が進入禁止領域の外周と干渉する場合、スイッチバック型の内側反転経路を選択する、すなわち、作業対象領域の外周と進入不可領域の外周との位置関係に応じて、外側反転経路ではなく、内側反転経路を走行経路として選択するように構成してもよい。
また、作業対象領域の外周や進入禁止領域の外周以外の地形データ(例えば、傾斜データ)を更に記憶部33に記録しておき、作業対象領域の外周や進入禁止領域の外周以外の地形データも参照して、走行経路が生成されるようにしてもよい。例えば、傾斜がある場合、平面上に投影された刈り幅は、刈り刃の刈り幅Wよりも小さくなる。そこで、作業対象領域の外周50付近に刈り残しが生じないように、傾斜を考慮して、外周経路Cを作業対象領域の外周50のW/2内側から補正して設定されるようにしてもよい。また、傾斜を考慮して、隣接する直線経路での刈り幅のオーバーラップ量が所定の値以上確保されるように直線経路が生成されるようにしてもよい。また、作業対象領域の外周や進入禁止領域の外周以外の地形データも参照して、反転経路のタイプが選択されるようにしてもよい。
上記の実施形態においては、隣接する直線経路が反転経路を介して連結して形成され、芝刈り機が隣接する直線経路を順次逆方向に走行する例を説明したが、上述の飛ばし経路を用いる場合は、反転経路のタイプとして更に図6に示される盆型の反転経路を生成するアルゴリズムを用意し、ステップS6において、盆型、水滴型、右半水滴型、左半水滴型、スイッチバック型の順で、外側反転経路として、次いで内側反転経路として、直線経路の端部に接続された反転経路が進入禁止領域に干渉するか否かを判定し、進入禁止領域に干渉しないタイプの反転経路が発見された時点で、そのタイプの反転経路を走行経路として選択し、直線経路の端部に連結すればよい。図8に、飛ばし経路を一部に用いた走行経路の生成例を示す。図8の走行経路においては、飛ばし経路に関連して反転経路R3、R5、R7について盆型の反転経路が選択されている。図8の盆型の反転経路R3、R5、R7は、図7の反転経路R3、R5、R7に比べて、距離も短く、またその形状から芝刈り機1はより大きな速度で走行でき、かつ芝も傷めにくい。したがって、この場合、全体として作業が短時間で、芝を傷めにくい走行経路を実現することができる。
上記の実施形態においては、本発明を自動走行方式の作業機械に適用した例を説明したが、本発明は、表示装置に表示される走行経路のナビゲーションにしたがって人間が運転を行う作業機械に適用可能である。
上記の実施形態においては、走行経路生成装置は、走行制御装置とは別個のものであったが、走行制御装置に走行経路生成装置を組み入れてもよい。
次に、本発明の一実施形態に係る進入可否判定装置及び方法について説明する。まず、進入可否判定の原理について説明する。
あるホールでの芝刈り作業が終了しないうちにホールがプレイのために使用されるため芝刈り機1を待避させる場合、芝刈り機1の異常を感じて検査のために芝刈り機1をホール外に移動させる場合、芝刈り作業を走行中に予定外の障害物を検知したため緊急停止をして障害物を回避しなければならない場合等、芝刈り機1が芝刈り作業のために走行経路を走行している途中で、何らかの事情によって芝刈り機1の走行を停止し、走行経路を離脱する場合がある。その場合、走行離脱時の最終の芝刈り作業完了位置(以下、単に「作業完了位置」ともいう。)又は最初の芝刈り作業未完位置(以下、単に「作業未完位置」ともいう。)から芝刈り作業が再開されるように芝刈り機1を走行経路に復帰させる必要がある。そのため、ユーザは、芝刈り機1を作業完了位置又は作業未完位置の近くに移動させる。また、作業が行われるべき走行経路と作業が行われない走行経路と作業が行われるべき走行経路が接続されている場合において、前の作業が行われるべき走行経路の作業がすべて完了しているとき、すなわち作業完了位置が前の作業が行われるべき走行経路と作業が行われない走行経路との接続点であるときは、後の作業が行われるべき走行経路の始点(作業が行われない走行経路と後の作業が行われるべき走行経路の接続点)、すなわち作業未完位置から作業が再開されればよい。よって、そのような場合は、ユーザは、作業機械を作業未完位置の近くに移動させることもできる。
一方、芝刈り機1は、現在位置と所定の走行経路に基づいて走行経路を自動走行する。すなわち、芝刈り機1は、所定の走行経路に沿うように、フィードバック制御やフィードフォワード制御といった制御によって軌道修正を行いながら走行する。したがって、芝刈り機1は、上記の作業完了位置又は作業未完位置の近くの位置(以下、「進入準備のための(現在)位置」ともいう。)から走行を開始すると、現在位置とこれから進入しようとする走行経路とのずれを修正するように軌道修正を行いながら、走行経路に進入し、走行経路上を走行することになる。よって、芝刈り機1が、実際に走行経路上のどの位置で走行経路に進入するのかは制御できない。
したがって、芝刈り機1を作業完了位置又は作業未完位置の手前で走行経路に前進のみで進入させることができるような進入準備のための芝刈り機1の配置を行うことは、熟練を要するし、熟練者でもそのような配置に失敗することがある。
そこで、進入準備のための芝刈り機1のある配置に対して、芝刈り機1を作業完了位置又は作業未完位置の手前で走行経路に前進のみで進入させることが不可能であることが確実か、又はほぼ確実である場合、進入不可である旨をユーザに報知すれば、芝刈り機1に対して、進入不可が確実であるか、又はほぼ確実である進入準備のための配置から芝刈り機1の走行が行われることを避けることができ、進入がより確実な配置を行うことができる。
更に、どのような場合に、より確実に進入準備のための芝刈り機1の配置を行うことができるかについて鋭意研究したところ、進入準備のための位置と走行経路との距離と、走行経路の方向に対する、進入準備のための位置における芝刈り機1の向きの角度は、それそれ、芝刈り機1を前進のみで走行経路の軌道にのせるためにはどのぐらいの距離が進入準備のための位置から走行経路に沿って必要であるかということと相関関係があることに、本発明者らは着目した。すなわち、進入準備のための位置と走行経路との距離が所定の第1の値よりも大きい場合や、走行経路の方向に対する、進入準備のための位置における芝刈り機1の向きの角度の絶対値が所定の第2の値よりも大きい場合は、一定の距離内で芝刈り機1を前進のみで走行経路の軌道にのせることができないか、又はほぼできない。したがって、これらの場合は、一定の距離内での進入が不可能であることが確実であるか、又はほぼ確実であるので、進入不可である旨をユーザに報知すれば、芝刈り機1に対して、進入不可が確実であるか、又はほぼ確実である進入準備のための配置から芝刈り機1の走行が行われることを避けることができ、進入がより確実な配置を行うことができる。
そして、上記一定の距離内に作業完了位置又は作業未完位置が位置する場合は、作業が行われた領域とこれから作業が行われる領域に不連続が生じる可能性があるので、所望の、後述の対応点から芝刈り機1が走行経路に進入する点までの距離に余裕距離を加えた予め定められた第3の値の距離だけ走行経路における作業機械の進行方向に離れた点が、作業完了位置又は作業未完位置よりも作業機械の進行方向側に位置する場合も、進入不可である旨をユーザに報知すれば、進入が更により確実な配置を行うことができる。
ここで、芝刈り作業が既に行われた部分とまだ行われていない部分の境界が容易に判別でき、芝刈り機1を作業完了位置の近くに移動させることが容易であるような場合、走行経路にほぼ沿って、すなわち走行経路の方向に対する、進入準備のための位置における芝刈り機1の向きの角度の絶対値が所定の第2の値よりも小さい値で芝刈り機1を配置することは容易である場合が多いから、そのような場合を前提とするならば、走行経路の方向に対する、進入準備のための位置における芝刈り機1の向きの角度の考慮は省略することができる。
また、走行経路の方向に対する、進入準備のための位置における芝刈り機1の向きの角度の絶対値が所定の値よりも小さい値であれば、芝刈り機1の向きが走行経路の方向と反対方向になるような配置に誤ってしてしまうことを防止することができる作用効果もある。例えば、直線経路に進入しようとしているときに、走行経路の方向に対する、進入準備のための位置における芝刈り機1の向きの角度の絶対値が90°よりも小さい値であれば、芝刈り機1の向きが走行経路の方向と反対方向になるような配置に誤ってしてしまうことを防止することができる。
上述の進入準備のための位置と走行経路との距離、走行経路の方向、芝刈り機1を前進のみで走行経路の軌道にのせるためにはどのぐらいの距離が進入準備のための位置から走行経路に沿って必要であるかを求めるためには、進入準備のための現在位置が、芝刈り機1が、走行経路から逸脱した結果位置している位置であると仮定したときに、仮に逸脱することなく走行していたとすると走行経路上ではどの点に対応するかを考えた場合の走行経路上の対応点を用いることができる。
すなわち、対応点を用いた場合、進入準備のための位置と走行経路との距離は、進入準備のための位置と対応点の距離となり、走行経路の方向は、走行経路上の対応点における接線の方向となり、芝刈り機1を前進のみで走行経路の軌道にのせるためにはどのぐらいの距離が進入準備のための位置から走行経路に沿って必要であるかを求める際には対応点を起点として距離を考えることになる。
ここで、対応点が存在する走行経路が直線経路である場合、走行経路上の対応点における接線は、その直線経路と一致するものとする。
そして、その対応点の一例として、進入準備のための位置に最も近い走行経路上の点である最近点を用いることができる。
また、対応点を、作業完了位置又は作業未完位置よりも芝刈り機1の進行方向と反対側において、進入準備のための位置に最も近い走行経路上の点である作業完了側最近点とすると、例えば進入準備のための位置の近くに両側に走行経路が存在するような場合に、進入すべきでない走行経路部分に誤って進入することを防止することができる。すなわち、進入準備のための位置の近くに両側に走行経路が存在し、進入準備のための位置に最も近い走行経路上の点が進入するべき走行経路部分ではない方の走行経路部分上に存在し、進入準備のための位置に2番目に最も近い走行経路上の点が進入するべき走行経路部分上に存在したような場合、対応点を、作業完了位置又は作業未完位置よりも芝刈り機1の進行方向と反対側(作業完了側)に位置するという条件の下に選択すれば、誤った走行経路部分に進入することを防止することができる。
ここで、対応点として、上述の最近点や作業完了側最近点以外の適切な点を用いることもできることは言うまでもない。
上記の所定の第1の値及び所定の第2の値は、芝刈り機1の操舵性能や、どのくらいの距離で対応点から芝刈り機1を走行経路に進入させたいか等を考慮して予め定める。また、所定の第1の値及び所定の第2の値があまりにも小さいと、ユーザは非常に狭い範囲の進入可能エリアに芝刈り機1を配置しなければならなくなるので、所定の第1の値及び所定の第2の値は、熟練者でなくとも進入可能に配置することができる程度の値とすることが好ましい。
上記の事情を考慮すると、第2の値は、30°以下の所定の値であることが好ましい。
また、上記の所定の第3の値は、上記の所望の、対応点から芝刈り機1が走行経路に進入する点までの距離に余裕距離を考慮して定められる。
続いて、本発明の一実施形態に係る進入可否判定装置の進入可否判定処理の例を図9に示すフローチャート、図10に示す芝刈り機が進入準備のための位置に配置されている状態の一例等を参照して、以下に説明する。ここで、図10は、図7の走行経路の直線経路L6上の作業完了位置(作業未完位置)90の近くで、芝刈り機1が進入準備のための位置91に配置されている状態を示したものである。芝刈り機1は、直線経路L6から距離d1だけ離れて、直線経路L6の方向に対して+10°の向きAに配置されている。
まず、芝刈り機1が芝刈り作業のために走行経路を走行している途中で、何らかの事情によって芝刈り機1の走行を停止し、走行経路を離脱する場合、S21において、ユーザは、進入可否判定装置60に、操作入力部17又はタブレット型コンピュータや基地局のコンピュータ等の進入可否判定装置60の外部の機器を介して離脱する旨を入力する。
S22において、ユーザは、予め走行経路を離脱する必要があることが分かっている場合等においては、操作入力部17又はタブレット型コンピュータや基地局のコンピュータ等の進入可否判定装置60の外部の機器を介して作業停止位置を芝刈り機1に指示する。作業完了・未完位置記録部121は、指示された作業停止位置を作業完了位置として記憶部108に記録する。芝刈り機1は、指示された作業停止位置に到達すると芝刈り作業を停止する。より正確を期するために、ユーザが指示した作業停止位置に替えて、実際に作業が停止された位置を検出したものを用いてもよい。芝刈り機1の走行停止が事前に指示されたものでなかった場合、S21において離脱する旨が入力されたことをトリガとして、作業完了・未完位置記録部121は、芝刈り機1の走行停止位置を検出し、記憶部108に記録する。そして、作業完了・未完位置記録部121は、記憶部108に記憶された走行停止位置と動作データを参照して芝刈り作業完了位置を求め、記憶部108に記録する。すなわち、芝刈り作業中に走行停止した場合は、走行停止位置と芝刈り作業完了位置がほぼ一致するが、ターン経路等の芝刈り作業を行っていない位置において走行停止した場合等においては、走行停止位置と芝刈り作業完了位置は一致しないので、走行経路に関連づけられている動作データを参照することによって、芝刈り作業完了位置を特定する。また、作業完了・未完位置記録部121は、その作業停止位置又は走行停止位置と記憶部108に記憶された動作データを参照して芝刈り作業未完位置を求め、記憶部108に記録する。例えば、図10においては、作業停止位置又は走行停止位置は、芝刈り作業を行う経路である直線経路上にあるので、作業未完位置は作業完了位置と一致する。また、例えば、図7の走行経路の直線経路L7、交点P15、反転経路R8、交点P16、直線経路L8の部分において、直線経路L7、L8の動作データには芝刈りを行うための動作が規定されており、反転経路R8の作業データには芝刈りをしないような動作が規定されているから、走行停止位置が反転経路R8上であった場合、芝刈り作業完了位置は交点P15、芝刈り作業未完位置は交点P16と特定される。ここで、作業完了位置の近くからの進入のみ可能であればよい場合は、作業未完位置を求め記憶部108に記録する構成は、省略することができる。
次に、芝刈り機1は、走行経路から離脱し、所定の場所に移動させられる。その後、芝刈り作業を再開する際に、芝刈り機1は、作業完了位置(作業未完位置)90(上述のように図10においては作業完了位置と作業未完位置が一致するので、以降は単に「作業完了位置90」ともいう。)の近くの芝刈り機1の進入準備のための位置91まで移動させられる。S23において、ユーザは、操作入力部17又はタブレット型コンピュータや基地局のコンピュータ等の進入可否判定装置60の外部の機器を介して、進入可否判定装置60に、進入可否判定の指示を入力する。
ステップS24において、芝刈り機1の進入準備のための現在位置91と方位Aが検出手段である制御情報生成部107と車両情報受信部105により検出される。
ステップS25において、対応点決定部122は、検出された芝刈り機1の進入準備のための現在位置91に最も近い、記憶部108に記録された走行経路上の点である最近点92を決定する。本実施形態においては、検出された芝刈り機1の進入準備のための現在位置91に対応する走行経路上の対応点として最近点92を用いるが、上述の作業完了位置又は作業未完位置よりも芝刈り機1の進行方向と反対側において、進入準備のための位置に最も近い走行経路上の点である作業完了側最近点等の最近点以外の対応点を用いてもよいことは言うまでもない。
ステップS26において、判定情報生成部123は、進入準備のための現在位置91と最近点92との距離d1が所定の第1の値よりも大きいか否かを判定する。図10の例においては、走行経路が直線経路であるので、進入準備のための位置91を通る、直線経路L6に対する垂線と、直線経路L6との交点が最近点92となる。
ステップS27において、判定情報生成部123は、走行経路上の最近点92における接線の向きに対する芝刈り機1の向きAの角度の絶対値が所定の第2の値よりも大きいか否かを判定する。図10の例においては、走行経路が直線経路であるので、上述のように、最近点92における接線は直線経路L6と一致し、芝刈り機1の向きAは直線経路L6の向きに対して+10°であるから、最近点92における接線の向きに対する芝刈り機1の向きAの角度は+10°である。ここで、芝刈り作業が既に行われた部分とまだ行われていない部分の境界が容易に判別でき、芝刈り機1を作業完了位置又は作業未完位置の近くに移動させることが容易であるような場合、走行経路にほぼ沿って、すなわち走行経路上の最近点における接線と芝刈り機1の向きのなす角度の絶対値が小さい角度で芝刈り機1を配置することは容易である場合が多いから、そのような場合を前提とするならば、本ステップは省略することができる。
ステップS28において、判定情報生成部123は、最近点92から予め定められた第3の値d3の距離だけ走行経路における芝刈り機1の進行方向に離れた点93が、作業完了位置又は作業未完位置90よりも芝刈り機1の進行方向側に位置するか否かを判定する。図10の例においては、点93は、作業完了位置90の手前に位置している。ここで、芝刈り機1による芝刈り作業は重複して行われても問題はないので、当初から余裕をもった距離で作業完了位置又は作業未完位置の手前に芝刈り機1を配置すること等を前提とするならば、本ステップは省略することができる。
ステップS29において、判定情報生成部123は、ステップS26~28のすべてにおいてNoの場合は、進入可能と判定する。
ステップS30において、判定情報生成部123は、ステップS26~28のいずれかにおいてYesの場合は、進入不可能と判定する。
ここで、図10においては、作業完了位置と作業未完位置が一致していたが、作業完了位置と作業未完位置が異なる場合、すなわち上述のような走行停止位置が作業が行われない走行経路上にあった場合は、その作業が行われない走行経路が芝刈り機1が後進で走行する走行経路であったとすると、進入準備の位置から一定の距離内で前進のみで走行経路に進入することができない。したがって、反転経路として内側反転経路を用いるような場合は、通常はそのような走行経路に進入しようとはしないが、内側反転経路を外側反転経路と思い違いをして進入準備の配置をしてしまったような場合も考えられるので、作業完了位置と作業未完位置が異なり、かつ作業未完位置に対して芝刈り機1の進行方向と反対側に接続される走行経路が、芝刈り機1が後進で走行する走行経路であった場合、進入不可能と判定すれば、上記の思い違いのような場合に有効である。
ステップS31において、判定情報生成部123は、進入可能か否かの判定情報を生成する。
ステップS32において、報知信号・命令生成部124は、生成された判定情報に基づいて、進入可能及び/又は進入不可能の報知を指示する信号及び/又は命令を生成する。
生成された進入可能及び/又は進入不可能の報知を指示する信号又は命令に基づいて、表示部18、音声出力部19等を介して進入可否の報知が行われる。報知の手法としては、ディスプレイへの表示、音声出力手段による音声出力、積層表示灯による点灯、振動など公知の手法を用いることができる。その際に、併せて、ディスプレイに走行経路を表示すると共に表示された走行経路のいずれの走行経路部分(例えば、直線経路、反転経路等)に進入するのかを表示してもよい。また、進入可否判定装置60とは別体の進入可否報知装置として機能するタブレット型コンピュータや基地局のコンピュータ等に送受信部102を介して、生成された判定情報又は進入可能及び/又は進入不可能の報知を指示する命令を送信し、タブレット型のコンピュータや基地局のコンピュータ等のディスプレイに表示し、及び/又は音声出力を行う構成とすることもできる。
ステップS32において進入可能の報知を指示する信号又は命令が生成され、それに基づいて進入可能と報知された場合、ユーザは、操作入力部17を介して制御装置10に進入開始(走行開始)を指示する。芝刈り機1は、現在位置と記憶部108に記憶された走行経路に基づいて自動走行する、すなわち、走行経路に沿うように軌道修正を行いながら走行する。したがって、芝刈り機1は、進入準備のための位置から走行を開始すると、現在位置とこれから進入しようとする走行経路とのずれ修正するように軌道修正が行われ、点93の手前で走行経路に進入し、走行経路上を走行する。芝刈り機1が走行経路に進入すると、芝刈り作業を再開する。
上記の実施形態においては、ステップS32において進入可能の報知を指示する信号又は命令が生成され、それに基づいて進入可能と報知された場合、ユーザは、操作入力部17を介して制御装置10に進入開始(走行開始)を指示したが、ステップS31において生成された判定情報の内容が進入可能であった場合に、ステップS32において進入可能の報知を指示する信号又は命令が生成されることに替えて又は加えて、芝刈り機1に進入開始(走行開始)を指示する走行制御信号が制御情報生成部107によって生成され、これによってユーザの入力なく、進入可能判定後に自動的に芝刈り機1が進入を開始する構成としてもよい。
上記の実施形態においては、進入可否判定開始指示入力に基づいて、1回の進入可否判定及び判定結果の報知を行ったが、進入可否判定終了を指示するまで常時又は間欠的に繰り返し進入可否判定及び判定結果の報知を行ってもよい。
上記の実施形態においては、芝刈り機1は、作業完了位置又は作業未完位置の近くの走行経路上の進入位置から走行経路に進入したが、走行経路の開始位置を含む、作業完了位置又は作業未完位置よりも作業機械の進行方向と反対側に位置する任意の位置を進入位置として走行経路に進入することができることは言うまでもない。
なお、上記の実施形態の方法を実現するコンピュータプログラムを記録した記録媒体を、走行経路生成装置3や制御装置10(進入可否判定装置60)に対して供給してもよい。この場合、走行経路生成装置3や制御装置10(進入可否判定装置60)のコンピュータが、記録媒体に記録されたコンピュータプログラムを読み取り、実行することによって、本発明の目的を達成することができる。したがって、記録媒体から読み取られたコンピュータプログラム自体が本発明の方法を実現するため、そのコンピュータプログラムが本発明を構成する。
上記の実施形態においては、本発明を芝刈り機に適用した例を説明したが、本発明は、農業機械や清掃機械等の任意の作業機械に適用可能である。
以上、本発明について、例示のためにいくつかの実施形態に関して説明してきたが、本発明はこれに限定されるものでなく、本発明の範囲及び精神から逸脱することなく、形態及び詳細について、様々な変形及び修正を行うことができることは、当業者に明らかであろう。
1・・・芝刈り機
10・・・制御装置
11・・・車速センサ
12・・・方位角速度センサ
13・・・駆動制御部
15・・・GPSアンテナ
16・・・通信アンテナ
17・・・操作入力部
18・・・表示部
19・・・音声出力部
101・・・GPS受信部
102・・・送受信部
105・・・車両情報受信部
106・・・駆動指令部
107・・・制御情報生成部
108・・・記憶部
109・・・リムーバブル記録媒体インタフェース部
112・・・主制御部
121・・・作業完了・未完位置記録部
122・・・対応点決定部
123・・・判定情報生成部
124・・・報知信号・命令生成部
2・・・基地局
21・・・GPS受信装置
22・・・送受信装置
25・・・GPSアンテナ
26・・・通信アンテナ
3・・・走行経路生成装置
30・・・制御部
31・・・操作入力部
32・・・表示部
33・・・記憶部
34・・・リムーバブル記録媒体インタフェース部
35・・・送受信部
301・・・領域設定部
302・・・経路生成部
303・・・動作設定部
304・・・主制御部
40・・・リムーバブル記録媒体
50・・・作業対象領域の外周
51・・・進入禁止領域の外周
60・・・進入可否判定装置
90・・・作業完了位置(作業未完位置)
91・・・進入準備のための(現在)位置
92・・・最近点
93・・・最近点92から予め定められた第3の値d3の距離だけ走行経路における芝刈り機1の進行方向に離れた点
10・・・制御装置
11・・・車速センサ
12・・・方位角速度センサ
13・・・駆動制御部
15・・・GPSアンテナ
16・・・通信アンテナ
17・・・操作入力部
18・・・表示部
19・・・音声出力部
101・・・GPS受信部
102・・・送受信部
105・・・車両情報受信部
106・・・駆動指令部
107・・・制御情報生成部
108・・・記憶部
109・・・リムーバブル記録媒体インタフェース部
112・・・主制御部
121・・・作業完了・未完位置記録部
122・・・対応点決定部
123・・・判定情報生成部
124・・・報知信号・命令生成部
2・・・基地局
21・・・GPS受信装置
22・・・送受信装置
25・・・GPSアンテナ
26・・・通信アンテナ
3・・・走行経路生成装置
30・・・制御部
31・・・操作入力部
32・・・表示部
33・・・記憶部
34・・・リムーバブル記録媒体インタフェース部
35・・・送受信部
301・・・領域設定部
302・・・経路生成部
303・・・動作設定部
304・・・主制御部
40・・・リムーバブル記録媒体
50・・・作業対象領域の外周
51・・・進入禁止領域の外周
60・・・進入可否判定装置
90・・・作業完了位置(作業未完位置)
91・・・進入準備のための(現在)位置
92・・・最近点
93・・・最近点92から予め定められた第3の値d3の距離だけ走行経路における芝刈り機1の進行方向に離れた点
Claims (38)
- 作業対象領域を所定の走行経路に沿って走行しながら所定作業を行う作業機械の現在位置を検出する検出手段と、
前記作業機械が、前記走行経路を離脱した場合に、前記走行経路上の作業完了位置又は作業未完位置よりも前記作業機械の進行方向と反対側に位置する進入位置において、前記作業機械が、前記進入位置において前記走行経路を走行する場合の進行方向と同じ方向に進入するようにされた進入経路に沿って、前記作業機械が、前記作業機械の進入準備のための現在位置から前進のみで進入可能か否かを判定し、進入可能か否かの判定情報を生成する判定情報生成部と、
を含み、
前記判定情報が、前記進入可否判定装置とは別体の進入可否報知装置に送信される進入可否判定装置。 - 作業対象領域を所定の走行経路に沿って走行しながら所定作業を行う作業機械の現在位置を検出する検出手段と、
前記作業機械が、前記走行経路を離脱した場合に、前記走行経路上の作業完了位置又は作業未完位置よりも前記作業機械の進行方向と反対側に位置する進入位置において、前記作業機械が、前記進入位置において前記走行経路を走行する場合の進行方向と同じ方向に進入するようにされた進入経路に沿って、前記作業機械が、前記作業機械の進入準備のための現在位置から前進のみで進入可能か否かを判定し、進入可能か否かの判定情報を生成する判定情報生成部と、
前記判定情報に基づいて、進入可能及び/又は進入不可能の報知を指示する信号及び/又は命令を生成する報知信号・命令生成部と、
を含む進入可否判定装置。 - 前記判定情報、及び/又は前記進入可能及び/又は進入不可能の報知を指示する信号及び/又は命令が、前記進入可否判定装置とは別体の進入可否報知装置に出力及び/又は送信される請求項2に記載の進入可否判定装置。
- 作業対象領域を所定の走行経路に沿って走行しながら所定作業を行う作業機械が、前記走行経路を離脱した場合に、前記走行経路上の作業完了位置よりも前記作業機械の進行方向と反対側に位置する進入位置において、前記作業機械が、前記進入位置において前記走行経路を走行する場合の進行方向と同じ方向に進入するようにされた進入経路に沿って、前記作業機械が、前記作業機械の進入準備のための現在位置から前進のみで進入可能か否かを判定する進入可否判定装置であって、
前記作業機械の現在位置を検出する検出手段と、
前記走行経路が記録された記憶部と、
前記作業機械の前記検出手段によって検出された前記進入準備のための現在位置に対応する、前記記憶部に記録された走行経路上の点である対応点を決定する対応点決定部と、
前記進入準備のための現在位置と前記対応点との距離が所定の第1の値よりも大きい場合に、進入不可能と判定し、前記進入可能か否かの判定情報を生成する判定情報生成部と、
を含み、
前記所定の第1の値は、少なくとも前記作業機械の操舵性能、及び所望の前記対応点から前記作業機械が前記走行経路に進入する点までの距離を考慮して予め定められたものである進入可否判定装置。 - 前記検出手段は、更に前記作業機械の向きを検出し、
前記判定情報生成部は、前記進入準備のための現在位置と前記対応点との距離が所定の第1の値よりも大きく、又は前記走行経路上の前記対応点における接線の方向に対する、前記作業機械の向きの角度の絶対値が所定の第2の値よりも大きい場合に、進入不可能と判定し、前記進入可能か否かの判定情報を生成する請求項4に記載の進入可否判定装置。 - 前記所定の第2の値は、30°以下の所定の値である請求項5に記載の進入可否判定装置。
- 前記作業完了位置を前記記憶部に記録する作業完了位置記録部を更に含み、
前記判定情報生成部は、前記所望の前記対応点から前記作業機械が前記走行経路に進入する点までの距離に余裕距離を考慮して定められた第3の値の距離だけ前記走行経路における前記作業機械の進行方向に離れた点が、前記作業完了位置よりも前記作業機械の進行方向側に位置する場合に、進入不可能と判定する請求項4~6のいずれか1項に記載の進入可否判定装置。 - 作業対象領域を所定の走行経路に沿って走行しながら所定作業を行う作業機械が、前記走行経路を離脱した場合に、前記走行経路上の作業完了位置又は作業未完位置よりも前記作業機械の進行方向と反対側に位置する進入位置において、前記作業機械が、前記進入位置において前記走行経路を走行する場合の進行方向と同じ方向に進入するようにされた進入経路に沿って、前記作業機械が、前記作業機械の進入準備のための現在位置から前進のみで進入不可能か否かを判定する進入可否判定装置であって、
前記作業機械の現在位置を検出する検出手段と、
前記走行経路が記録された記憶部と、
前記作業機械の前記検出手段によって検出された前記進入準備のための現在位置に対応する、前記記憶部に記録された走行経路上の点である対応点を決定する対応点決定部と、
前記進入準備のための現在位置と前記対応点との距離が所定の第1の値よりも大きい場合に、進入不可能と判定し、前記進入可能か否かの判定情報を生成する判定情報生成部と、
を含み、
前記所定の第1の値は、少なくとも前記作業機械の操舵性能、及び所望の前記対応点から前記作業機械が前記走行経路に進入する点までの距離を考慮して予め定められたものである進入可否判定装置。 - 前記検出手段は、更に前記作業機械の向きを検出し、
前記判定情報生成部は、前記進入準備のための現在位置と前記対応点との距離が所定の第1の値よりも大きく、又は前記走行経路上の前記対応点における接線の方向に対する、前記作業機械の向きの角度の絶対値が所定の第2の値よりも大きい場合に、進入不可能と判定し、前記進入可能か否かの判定情報を生成する請求項8に記載の進入可否判定装置。 - 前記所定の第2の値は、30°以下の所定の値である請求項9に記載の進入可否判定装置。
- 前記作業完了位置及び前記作業未完位置を前記記憶部に記録する作業完了・未完位置記録部を更に含み、
前記判定情報生成部は、前記所望の前記対応点から前記作業機械が前記走行経路に進入する点までの距離に余裕距離を考慮して定められた第3の値の距離だけ前記走行経路における前記作業機械の進行方向に離れた点が、前記作業完了位置又は前記作業未完位置よりも前記作業機械の進行方向側に位置する場合に、進入不可能と判定する請求項8~10のいずれか1項に記載の進入可否判定装置。 - 前記対応点は、前記作業機械の前記検出手段によって検出された前記進入準備のための現在位置に最も近い、前記記憶部に記録された走行経路上の点である最近点である請求項4~11のいずれか1項に記載の進入可否判定装置。
- 前記対応点は、前記作業完了位置又は前記作業未完位置よりも前記作業機械の進行方向と反対側において、前記作業機械の前記検出手段によって検出された前記進入準備のための現在位置に最も近い、前記記憶部に記録された走行経路上の点である作業完了側最近点である請求項4~11のいずれか1項に記載の進入可否判定装置。
- 前記判定情報に基づいて、進入可能及び/又は進入不可能の報知を指示する信号及び/又は命令を生成する報知信号・命令生成部を更に含む請求項4~13のいずれか1項に記載の進入可否判定装置。
- 前記判定情報が、前記進入可否判定装置とは別体の進入可否報知装置に送信される請求項4~13のいずれか1項に記載の進入可否判定装置。
- 前記判定情報、及び/又は前記進入可能及び/又は進入不可能の報知を指示する信号及び/又は命令が、前記進入可否判定装置とは別体の進入可否報知装置に出力及び/又は送信される請求項14に記載の進入可否判定装置。
- 前記判定情報の内容が進入可能である場合に、自動走行による進入開始を前記作業機械に指示する信号を生成する請求項1~16のいずれか1項に記載の進入可否判定装置。
- 前記作業対象領域を走行する前記作業機械の現在位置及び前記記憶部に記録された前記走行経路に少なくとも基づいて、前記作業機械に前記走行経路を走行させるための走行制御信号を出力することにより、前記作業機械が備える走行駆動機構を制御する制御手段と、
請求項1~17のいずれか1項に記載の進入可否判定装置と、
を含む作業機械制御装置。 - 請求項18に記載の作業機械制御装置と、
前記作業機械制御装置から出力される前記走行制御信号に基づいて自己の走行を駆動する走行駆動機構と、
を含む作業機械。 - 作業対象領域を所定の走行経路に沿って走行しながら所定作業を行う作業機械の現在位置を検出するステップと、
前記作業機械が、前記走行経路を離脱した場合に、前記走行経路上の作業完了位置又は作業未完位置よりも前記作業機械の進行方向と反対側に位置する進入位置において、前記作業機械が、前記進入位置において前記走行経路を走行する場合の進行方向と同じ方向に進入するようにされた進入経路に沿って、前記作業機械が、前記作業機械の進入準備のための現在位置から前進のみで進入可能か否かを判定し、前記進入可能か否かの判定情報を生成するステップと、
を含み、
前記判定情報が、進入可否報知装置に送信される進入可否判定方法。 - 作業対象領域を所定の走行経路に沿って走行しながら所定作業を行う作業機械の現在位置を検出するステップと、
前記作業機械が、前記走行経路を離脱した場合に、前記走行経路上の作業完了位置又は作業未完位置よりも前記作業機械の進行方向と反対側に位置する進入位置において、前記作業機械が、前記進入位置において前記走行経路を走行する場合の進行方向と同じ方向に進入するようにされた進入経路に沿って、前記作業機械が、前記作業機械の進入準備のための現在位置から前進のみで進入可能か否かを判定し、前記進入可能か否かの判定情報を生成するステップと、
前記判定情報に基づいて、進入可能及び/又は進入不可能の報知を指示する信号及び/又は命令を生成するステップと、
を含む進入可否判定方法。 - 前記判定情報、及び/又は前記進入可能及び/又は進入不可能の報知を指示する信号及び/又は命令が、進入可否報知装置に出力及び/又は送信される請求項21に記載の進入可否判定方法。
- 作業対象領域を所定の走行経路に沿って走行しながら所定作業を行う作業機械が、前記走行経路を離脱した場合に、前記走行経路上の作業完了位置よりも前記作業機械の進行方向と反対側に位置する進入位置において、前記作業機械が、前記進入位置において前記走行経路を走行する場合の進行方向と同じ方向に進入するようにされた進入経路に沿って、前記作業機械が、前記作業機械の進入準備のための現在位置から前進のみで進入可能か否かを判定する進入可否判定方法であって、
前記作業機械の現在位置を検出するステップと、
前記作業機械の前記検出手段によって検出された前記進入準備のための現在位置に対応する、前記記憶部に記録された走行経路上の点である対応点を決定するステップと、
前記進入準備のための現在位置と前記対応点との距離が所定の第1の値よりも大きい場合に、進入不可能と判定し、前記進入可能か否かの判定情報を生成するステップと、
を含み、
前記所定の第1の値は、少なくとも前記作業機械の操舵性能、及び所望の前記対応点から前記作業機械が前記走行経路に進入する点までの距離を考慮して予め定められたものである進入可否判定方法。 - 前記検出するステップは、更に前記作業機械の向きを検出し、
前記判定情報を生成するステップは、前記進入準備のための現在位置と前記対応点との距離が所定の第1の値よりも大きく、又は前記走行経路上の前記対応点における接線の方向に対する、前記作業機械の向きの角度の絶対値が所定の第2の値よりも大きい場合に、進入不可能と判定し、前記進入可能か否かの判定情報を生成する請求項23に記載の進入可否判定方法。 - 前記所定の第2の値は、30°以下の所定の値である請求項24に記載の進入可否判定方法。
- 前記作業完了位置を記録するステップと、
前記所望の前記対応点から前記作業機械が前記走行経路に進入する点までの距離に余裕距離を考慮して定められた第3の値の距離だけ前記走行経路における前記作業機械の進行方向に離れた点が、前記作業完了位置よりも前記作業機械の進行方向側に位置する場合に、進入不可能と判定するステップと、
を更に含む請求項23~25のいずれか1項に記載の進入可否判定方法。 - 作業対象領域を所定の走行経路に沿って走行しながら所定作業を行う作業機械が、前記走行経路を離脱した場合に、前記走行経路上の作業完了位置又は作業未完位置よりも前記作業機械の進行方向と反対側に位置する進入位置において、前記作業機械が、前記進入位置において前記走行経路を走行する場合の進行方向と同じ方向に進入するようにされた進入経路に沿って、前記作業機械が、前記作業機械の進入準備のための現在位置から前進のみで進入不可能か否かを判定する進入可否判定方法であって、
前記作業機械の現在位置を検出するステップと、
前記作業機械の前記検出手段によって検出された前記進入準備のための現在位置に対応する、前記記憶部に記録された走行経路上の点である対応点を決定するステップと、
前記進入準備のための現在位置と前記対応点との距離が所定の第1の値よりも大きい場合に、進入不可能と判定し、前記進入可能か否かの判定情報を生成するステップと、
を含み、
前記所定の第1の値は、少なくとも前記作業機械の操舵性能、及び所望の前記対応点から前記作業機械が前記走行経路に進入する点までの距離を考慮して予め定められたものである進入可否判定方法。 - 前記検出するステップは、更に前記作業機械の向きを検出し、
前記判定情報を生成するステップは、前記進入準備のための現在位置と前記対応点との距離が所定の第1の値よりも大きく、又は前記走行経路上の前記対応点における接線の方向に対する、前記作業機械の向きの角度の絶対値が所定の第2の値よりも大きい場合に、進入不可能と判定し、前記進入可能か否かの判定情報を生成する請求項27に記載の進入可否判定方法。 - 前記所定の第2の値は、30°以下の所定の値である請求項28に記載の進入可否判定方法。
- 前記作業完了位置及び前記作業完了位置を記録するステップと、
前記所望の前記対応点から前記作業機械が前記走行経路に進入する点までの距離に余裕距離を考慮して定められた第3の値の距離だけ前記走行経路における前記作業機械の進行方向に離れた点が、前記作業完了位置又は前記作業未完位置よりも前記作業機械の進行方向側に位置する場合に、進入不可能と判定するステップと、
を更に含む請求項27~29のいずれか1項に記載の進入可否判定方法。 - 前記対応点は、前記作業機械の前記検出手段によって検出された前記進入準備のための現在位置に最も近い、走行経路上の点である最近点である請求項23~30のいずれか1項に記載の進入可否判定方法。
- 前記対応点は、前記作業完了位置又は前記作業未完位置よりも前記作業機械の進行方向と反対側において、前記作業機械の前記検出手段によって検出された前記進入準備のための現在位置に最も近い、前記記憶部に記録された走行経路上の点である作業完了側最近点である請求項23~30のいずれか1項に記載の進入可否判定方法。
- 前記判定情報に基づいて、進入可能及び/又は進入不可能の報知を指示する信号及び/又は命令を生成するステップを更に含む請求項23~32のいずれか1項に記載の進入可否判定方法。
- 前記判定情報が、進入可否報知装置に送信される請求項23~32のいずれか1項に記載の進入可否判定方法。
- 前記判定情報、及び/又は前記進入可能及び/又は進入不可能の報知を指示する信号及び/又は命令が、進入可否報知装置に出力及び/又は送信される請求項33に記載の進入可否判定方法。
- 前記判定情報の内容が進入可能である場合に、自動走行による進入開始を前記作業機械に指示する信号を生成する請求項20~35のいずれか1項に記載の進入可否判定方法。
- 請求項20~36のいずれか1項に記載の進入可否判定方法をコンピュータに実行させるためのプログラム。
- 請求項37に記載のプログラムを記録したコンピュータ読み取り可能な記録媒体。
Priority Applications (8)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
EP23151843.2A EP4184276A1 (en) | 2014-07-04 | 2015-02-13 | Travel route automatic selection system and method for a work machine, program and computer-readable recording medium |
JP2015510525A JP6236652B2 (ja) | 2014-07-04 | 2015-02-13 | 作業機械、作業機械の走行経路生成、走行経路への進入可否判定、走行経路自動選択のためのシステム、方法、プログラム、プログラムを記録した記録媒体、作業機械の走行制御システム |
EP15814660.5A EP3165985A4 (en) | 2014-07-04 | 2015-02-13 | Work machine; system, method, and program for generating movement paths for work vehicle, determining possibility of entry to movement paths, and automatically selecting movement path; recording medium on which program therefor is recorded; and system for controlling movement of work machine |
PCT/JP2015/054020 WO2016002246A1 (ja) | 2014-07-04 | 2015-02-13 | 作業機械、作業機械の走行経路生成、走行経路への進入可否判定、走行経路自動選択のためのシステム、方法、プログラム、プログラムを記録した記録媒体、作業機械の走行制御システム |
US15/387,339 US10126752B2 (en) | 2014-07-04 | 2016-12-21 | Work machine, system, method, program, and recording medium recording program for generating travel route of work machine, for determining availability of entry to travel route, and for automatically selecting travel route, and travel control system of work machine |
US15/388,359 US10114377B2 (en) | 2014-07-04 | 2016-12-22 | Work machine, system, method, and recording medium recording computer program for generating travel route of work machine, and travel control system of work machine |
US15/388,424 US10120382B2 (en) | 2014-07-04 | 2016-12-22 | Work machine, system, method, and recording medium recording computer program for determining availability of entry to travel route, and travel control system of work machine |
JP2016256505A JP6289603B2 (ja) | 2014-07-04 | 2016-12-28 | 作業機械、作業機械の走行経路生成、走行経路への進入可否判定、走行経路自動選択のためのシステム、方法、プログラム、プログラムを記録した記録媒体、作業機械の走行制御システム |
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
PCT/JP2014/067964 WO2016002082A1 (ja) | 2014-07-04 | 2014-07-04 | 作業機械、作業機械の走行経路生成のための装置、方法、プログラム、プログラムを記録した記録媒体、作業機械の走行制御装置 |
JPPCT/JP2014/067964 | 2014-07-04 |
Publications (1)
Publication Number | Publication Date |
---|---|
WO2016002096A1 true WO2016002096A1 (ja) | 2016-01-07 |
Family
ID=52573832
Family Applications (3)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/JP2014/067964 WO2016002082A1 (ja) | 2014-07-04 | 2014-07-04 | 作業機械、作業機械の走行経路生成のための装置、方法、プログラム、プログラムを記録した記録媒体、作業機械の走行制御装置 |
PCT/JP2014/076278 WO2016002096A1 (ja) | 2014-07-04 | 2014-10-01 | 作業機械、作業機械の走行経路への進入可否判定のための装置、方法、プログラム、プログラムを記録した記録媒体、作業機械の走行制御装置 |
PCT/JP2015/054020 WO2016002246A1 (ja) | 2014-07-04 | 2015-02-13 | 作業機械、作業機械の走行経路生成、走行経路への進入可否判定、走行経路自動選択のためのシステム、方法、プログラム、プログラムを記録した記録媒体、作業機械の走行制御システム |
Family Applications Before (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/JP2014/067964 WO2016002082A1 (ja) | 2014-07-04 | 2014-07-04 | 作業機械、作業機械の走行経路生成のための装置、方法、プログラム、プログラムを記録した記録媒体、作業機械の走行制御装置 |
Family Applications After (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/JP2015/054020 WO2016002246A1 (ja) | 2014-07-04 | 2015-02-13 | 作業機械、作業機械の走行経路生成、走行経路への進入可否判定、走行経路自動選択のためのシステム、方法、プログラム、プログラムを記録した記録媒体、作業機械の走行制御システム |
Country Status (4)
Country | Link |
---|---|
US (3) | US10126752B2 (ja) |
EP (2) | EP4184276A1 (ja) |
JP (3) | JP5669998B1 (ja) |
WO (3) | WO2016002082A1 (ja) |
Cited By (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2018101351A1 (ja) * | 2016-12-02 | 2018-06-07 | 株式会社クボタ | 走行経路管理システム及び走行経路決定装置 |
JP2018092620A (ja) * | 2016-12-02 | 2018-06-14 | 株式会社クボタ | 走行経路決定装置 |
JP2018099112A (ja) * | 2016-12-19 | 2018-06-28 | 株式会社クボタ | 走行経路管理システム |
JP2018099041A (ja) * | 2016-12-19 | 2018-06-28 | 株式会社クボタ | 走行経路管理システム |
JP2019057308A (ja) * | 2018-11-20 | 2019-04-11 | ヤンマー株式会社 | 自律走行システム |
CN109936975A (zh) * | 2016-12-02 | 2019-06-25 | 株式会社久保田 | 行进路线管理系统及行进路线决定装置 |
WO2020085240A1 (ja) * | 2018-10-22 | 2020-04-30 | 株式会社ナイルワークス | 運転経路生成システム、運転経路生成方法、運転経路生成プログラム、座標測量システム、およびドローン |
JP2020108384A (ja) * | 2020-03-04 | 2020-07-16 | 株式会社クボタ | 走行経路管理システム及び収穫機 |
JP2020129408A (ja) * | 2020-05-21 | 2020-08-27 | ヤンマーパワーテクノロジー株式会社 | 自律走行システム |
JP2022063315A (ja) * | 2020-04-21 | 2022-04-21 | ヤンマーパワーテクノロジー株式会社 | 自律走行システム |
US11726485B2 (en) | 2016-09-05 | 2023-08-15 | Kubota Corporation | Autonomous work vehicle travel system, travel route managing device, travel route generating device, and travel route determining device |
Families Citing this family (51)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US10188029B1 (en) | 2014-10-20 | 2019-01-29 | Hydro-Gear Limited Partnership | Method of generating a three-dimensional map of a lawn and its use to improve mowing efficiency |
DE102015121972A1 (de) * | 2015-12-16 | 2017-06-22 | Vorwerk & Co. Interholding Gmbh | System und Verfahren zur Bearbeitung eines Bodens mit einer mobilen Robotereinheit |
EP3633481A1 (en) * | 2016-03-09 | 2020-04-08 | Yanmar Co., Ltd. | Work vehicle |
JP6977000B2 (ja) * | 2016-03-18 | 2021-12-08 | ヤンマーパワーテクノロジー株式会社 | 作業車両用経路生成システム |
CA2953477C (en) * | 2016-04-28 | 2020-06-02 | Komatsu Ltd. | Work machine management apparatus |
US10152891B2 (en) * | 2016-05-02 | 2018-12-11 | Cnh Industrial America Llc | System for avoiding collisions between autonomous vehicles conducting agricultural operations |
JP6945279B2 (ja) * | 2016-06-28 | 2021-10-06 | 株式会社クボタ | 作業車 |
JP6747117B2 (ja) * | 2016-07-11 | 2020-08-26 | 株式会社Ihi | 航走制御方法および航走制御システム |
JP6688197B2 (ja) * | 2016-09-09 | 2020-04-28 | ヤンマー株式会社 | 自律走行システム |
JP6695248B2 (ja) * | 2016-09-26 | 2020-05-20 | ヤンマー株式会社 | 自律走行システム |
JP6832828B2 (ja) * | 2016-10-26 | 2021-02-24 | 株式会社クボタ | 走行経路決定装置 |
JP6739382B2 (ja) * | 2017-03-24 | 2020-08-12 | ヤンマーパワーテクノロジー株式会社 | 自律走行システム |
JP6718838B2 (ja) * | 2017-03-31 | 2020-07-08 | ヤンマーパワーテクノロジー株式会社 | 農作業車両の運転支援システム |
JP6964735B2 (ja) * | 2017-04-26 | 2021-11-10 | 株式会社クボタ | 自動操舵システム |
BE1024475B1 (nl) * | 2017-05-09 | 2018-03-01 | Cnh Industrial Belgium Nv | Werkwijze voor het oogsten en oogsttoestel |
JP6980087B2 (ja) * | 2017-05-29 | 2021-12-15 | 株式会社クボタ | 自動走行作業車両のための衛星測位システム |
US10980173B2 (en) * | 2017-09-13 | 2021-04-20 | Black & Decker Inc. | Riding mower with removeable battery module |
US10409287B2 (en) * | 2017-11-30 | 2019-09-10 | Komatsu America Corp. | Vehicle guide display and path navigation method |
WO2019180950A1 (ja) * | 2018-03-23 | 2019-09-26 | 本田技研工業株式会社 | 設置位置通知システム |
JP6850760B2 (ja) * | 2018-03-28 | 2021-03-31 | ヤンマーパワーテクノロジー株式会社 | 作業車両の自動走行装置 |
CN110573979B (zh) * | 2018-03-29 | 2023-11-14 | 深圳市大疆软件科技有限公司 | 作业路径调整方法及装置、可移动设备作业路径调整方法及设备、和记录介质 |
WO2019194631A1 (ko) * | 2018-04-06 | 2019-10-10 | 엘지전자 주식회사 | 이동로봇과 이동로봇의 제어방법 |
JP7034866B2 (ja) * | 2018-08-20 | 2022-03-14 | 株式会社クボタ | 収穫機 |
JP7068969B2 (ja) * | 2018-08-29 | 2022-05-17 | ヤンマーパワーテクノロジー株式会社 | 自動走行システム |
CN109362026B (zh) * | 2018-09-13 | 2021-01-05 | 北京宝驰新风科技有限公司 | 一种用于车辆寻找车主的反向定位寻找系统 |
CN109634270A (zh) * | 2018-10-25 | 2019-04-16 | 丰疆智慧农业股份有限公司 | 用于无人驾驶农机的作业控制系统及作业控制方法 |
JP2020086995A (ja) * | 2018-11-27 | 2020-06-04 | 富士ゼロックス株式会社 | 自律移動装置およびプログラム |
WO2020117699A1 (en) * | 2018-12-02 | 2020-06-11 | Mtd Products Inc | Autonomous mower navigation system and method |
US11105653B2 (en) * | 2019-02-05 | 2021-08-31 | Caterpillar Inc. | System for generating map with instructional tips |
SE544390C2 (en) * | 2019-03-05 | 2022-05-03 | Husqvarna Ab | Robotic work tool system and method for controlling a robotic work tool based on information from a recording device |
JP6854312B2 (ja) * | 2019-03-15 | 2021-04-07 | ヤンマーパワーテクノロジー株式会社 | 走行領域特定装置 |
TWI684085B (zh) * | 2019-04-24 | 2020-02-01 | 揚昇育樂事業股份有限公司 | 自駕車輛之自駕行駛路徑中央控制裝置 |
JP7353796B2 (ja) * | 2019-05-17 | 2023-10-02 | ヤンマーパワーテクノロジー株式会社 | 作業車両用の自動走行システム |
JP7280759B2 (ja) * | 2019-06-20 | 2023-05-24 | ヤンマーパワーテクノロジー株式会社 | 散布作業用の自動走行システム |
US11623689B2 (en) * | 2019-09-09 | 2023-04-11 | Mtd Products Inc | Real time kinematics power equipment device with auto-steering |
CN118476376A (zh) * | 2019-11-29 | 2024-08-13 | 株式会社久保田 | 自动行驶控制系统、联合收割机、收获机 |
JP7275010B2 (ja) * | 2019-11-29 | 2023-05-17 | 株式会社クボタ | 自動走行制御システム、及び、コンバイン |
JP7047830B2 (ja) * | 2019-12-05 | 2022-04-05 | オムロン株式会社 | 自律走行システム、自律走行方法、及び自律走行プログラム |
JP7330878B2 (ja) * | 2019-12-18 | 2023-08-22 | 株式会社クボタ | 作業機 |
JP7316612B2 (ja) * | 2020-02-04 | 2023-07-28 | パナソニックIpマネジメント株式会社 | 運転支援装置、車両、及び、運転支援方法 |
SG11202109597YA (en) * | 2020-02-13 | 2021-11-29 | Sunrise Resort Inc | Golf-shot-tracking-self-driving-path central controlling system |
US12103516B2 (en) * | 2020-03-31 | 2024-10-01 | Baidu Usa Llc | Parking-trajectory generation method combined with offline and online solutions |
JP2020113325A (ja) * | 2020-04-03 | 2020-07-27 | ヤンマーパワーテクノロジー株式会社 | 自律走行システム |
JP7332732B2 (ja) * | 2020-04-03 | 2023-08-23 | ヤンマーパワーテクノロジー株式会社 | 自律走行システム |
JP7401422B2 (ja) * | 2020-11-27 | 2023-12-19 | 株式会社クボタ | 作業機 |
JP7511491B2 (ja) | 2021-01-05 | 2024-07-05 | 株式会社クボタ | 自動走行システム及び自動走行方法 |
JP6997889B2 (ja) * | 2021-01-29 | 2022-01-18 | ヤンマーパワーテクノロジー株式会社 | 経路生成システム |
JP7506632B2 (ja) | 2021-03-25 | 2024-06-26 | ヤンマーホールディングス株式会社 | 車両監視方法、車両監視システム、及び車両監視プログラム |
US20230065712A1 (en) * | 2021-08-31 | 2023-03-02 | Deere & Company | Methods, apparatus, and articles of manufacture to generate a turn path for a vehicle |
JP2023150418A (ja) * | 2022-03-31 | 2023-10-16 | ヤンマーホールディングス株式会社 | 経路生成方法、経路生成システム、及び経路生成プログラム |
CN115240452B (zh) * | 2022-09-23 | 2022-12-09 | 山东科翔智能科技有限公司 | 一种智能化农机北斗导航自动驾驶辅助系统 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2004171430A (ja) * | 2002-11-22 | 2004-06-17 | Sanyo Electric Co Ltd | 搬送車 |
JP2009053927A (ja) * | 2007-08-27 | 2009-03-12 | Panasonic Electric Works Co Ltd | 自律移動のための経路生成装置および該装置を用いた自律移動装置 |
JP2013257743A (ja) * | 2012-06-13 | 2013-12-26 | Sumitomo Heavy Ind Ltd | 移動体 |
Family Cites Families (19)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH0346011A (ja) * | 1989-07-14 | 1991-02-27 | Toshiba Corp | 無人搬送車の合流制御装置 |
JPH0949729A (ja) * | 1995-08-07 | 1997-02-18 | Hitachi Ltd | 移動作業機械の運転方法及び作業データの作成方法 |
JP3318170B2 (ja) * | 1995-11-02 | 2002-08-26 | 株式会社日立製作所 | 自動走行機械の経路生成方法 |
DE19629618A1 (de) * | 1996-07-23 | 1998-01-29 | Claas Ohg | Routenplanungssystem für landwirtschaftliche Arbeitsfahrzeuge |
JP3454666B2 (ja) * | 1997-05-15 | 2003-10-06 | 株式会社日立産機システム | 自走式作業機械の走行制御方法 |
JPH117318A (ja) * | 1997-06-16 | 1999-01-12 | Nissan Motor Co Ltd | 移動ロボットの走行制御方法 |
GB2386970A (en) * | 2002-03-26 | 2003-10-01 | Mcmurtry Ltd | Environmentally responsive ground maintenance equipment |
JP4110937B2 (ja) * | 2002-11-18 | 2008-07-02 | 日産自動車株式会社 | 駐車支援装置 |
US6907336B2 (en) * | 2003-03-31 | 2005-06-14 | Deere & Company | Method and system for efficiently traversing an area with a work vehicle |
JP2005078415A (ja) * | 2003-09-01 | 2005-03-24 | Fuji Heavy Ind Ltd | 走行経路生成方法、走行経路生成装置およびコンピュータプログラム |
JP4369419B2 (ja) * | 2005-12-09 | 2009-11-18 | 株式会社小松製作所 | 無人車両の誘導走行制御装置 |
JP2008129695A (ja) * | 2006-11-17 | 2008-06-05 | Toyota Motor Corp | 移動体の経路生成システム及び経路生成方法 |
JP5140864B2 (ja) * | 2010-11-22 | 2013-02-13 | 株式会社小松製作所 | 無人車両の走行システムおよび走行経路生成方法 |
US8548666B2 (en) * | 2011-12-23 | 2013-10-01 | Agco Corporation | Auto-guidance |
JP2013228821A (ja) * | 2012-04-24 | 2013-11-07 | Mamiya-Op Nequos Co Ltd | 作業機械及びその構成装置、コンピュータプログラム |
JP5859912B2 (ja) * | 2012-05-10 | 2016-02-16 | 株式会社Ihiスター | 作業機用の制御装置及び作業機用の制御方法 |
JP6085958B2 (ja) * | 2012-11-30 | 2017-03-01 | トヨタ自動車株式会社 | 駐車支援装置 |
GB201223363D0 (en) * | 2012-12-24 | 2013-02-06 | Agco Int Gmbh | Path planning method for agricultural vehicle guidance |
US9072219B2 (en) * | 2013-06-20 | 2015-07-07 | Deere & Company | Robotic mower navigation system |
-
2014
- 2014-07-04 JP JP2014545017A patent/JP5669998B1/ja active Active
- 2014-07-04 WO PCT/JP2014/067964 patent/WO2016002082A1/ja active Application Filing
- 2014-10-01 WO PCT/JP2014/076278 patent/WO2016002096A1/ja active Application Filing
-
2015
- 2015-02-13 EP EP23151843.2A patent/EP4184276A1/en not_active Withdrawn
- 2015-02-13 JP JP2015510525A patent/JP6236652B2/ja active Active
- 2015-02-13 WO PCT/JP2015/054020 patent/WO2016002246A1/ja active Application Filing
- 2015-02-13 EP EP15814660.5A patent/EP3165985A4/en not_active Withdrawn
-
2016
- 2016-12-21 US US15/387,339 patent/US10126752B2/en active Active
- 2016-12-22 US US15/388,424 patent/US10120382B2/en active Active
- 2016-12-22 US US15/388,359 patent/US10114377B2/en active Active
- 2016-12-28 JP JP2016256505A patent/JP6289603B2/ja active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2004171430A (ja) * | 2002-11-22 | 2004-06-17 | Sanyo Electric Co Ltd | 搬送車 |
JP2009053927A (ja) * | 2007-08-27 | 2009-03-12 | Panasonic Electric Works Co Ltd | 自律移動のための経路生成装置および該装置を用いた自律移動装置 |
JP2013257743A (ja) * | 2012-06-13 | 2013-12-26 | Sumitomo Heavy Ind Ltd | 移動体 |
Cited By (23)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US11726485B2 (en) | 2016-09-05 | 2023-08-15 | Kubota Corporation | Autonomous work vehicle travel system, travel route managing device, travel route generating device, and travel route determining device |
US11320279B2 (en) | 2016-12-02 | 2022-05-03 | Kubota Corporation | Travel route management system and travel route determination device |
KR102586896B1 (ko) * | 2016-12-02 | 2023-10-11 | 가부시끼 가이샤 구보다 | 주행 경로 관리 시스템 및 주행 경로 결정 장치 |
JP2018092620A (ja) * | 2016-12-02 | 2018-06-14 | 株式会社クボタ | 走行経路決定装置 |
CN109936975A (zh) * | 2016-12-02 | 2019-06-25 | 株式会社久保田 | 行进路线管理系统及行进路线决定装置 |
KR20190091262A (ko) * | 2016-12-02 | 2019-08-05 | 가부시끼 가이샤 구보다 | 주행 경로 관리 시스템 및 주행 경로 결정 장치 |
WO2018101351A1 (ja) * | 2016-12-02 | 2018-06-07 | 株式会社クボタ | 走行経路管理システム及び走行経路決定装置 |
EP3549419A4 (en) * | 2016-12-02 | 2020-08-05 | Kubota Corporation | ROUTE MANAGEMENT SYSTEM AND ROUTE DETERMINATION DEVICE |
JP2018099041A (ja) * | 2016-12-19 | 2018-06-28 | 株式会社クボタ | 走行経路管理システム |
JP2018099112A (ja) * | 2016-12-19 | 2018-06-28 | 株式会社クボタ | 走行経路管理システム |
WO2020085240A1 (ja) * | 2018-10-22 | 2020-04-30 | 株式会社ナイルワークス | 運転経路生成システム、運転経路生成方法、運転経路生成プログラム、座標測量システム、およびドローン |
US12117297B2 (en) | 2018-10-22 | 2024-10-15 | Nileworks Inc. | Traveling route generating system, traveling route generating method, traveling route generating program, coordinate measuring system, and drone |
JP7062314B2 (ja) | 2018-10-22 | 2022-05-06 | 株式会社ナイルワークス | 運転経路生成システム、運転経路生成方法、運転経路生成プログラム、座標測量システム、およびドローン |
CN112912808A (zh) * | 2018-10-22 | 2021-06-04 | 株式会社尼罗沃克 | 行驶路径生成系统、行驶路径生成方法、行驶路径生成程序、座标测量系统以及无人机 |
CN112912808B (zh) * | 2018-10-22 | 2023-12-26 | 株式会社尼罗沃克 | 行驶路径生成系统、行驶路径生成方法、计算机可读取记录介质、坐标测量系统以及无人机 |
JPWO2020085240A1 (ja) * | 2018-10-22 | 2021-02-15 | 株式会社ナイルワークス | 運転経路生成システム、運転経路生成方法、運転経路生成プログラム、座標測量システム、およびドローン |
JP2019057308A (ja) * | 2018-11-20 | 2019-04-11 | ヤンマー株式会社 | 自律走行システム |
JP7050837B2 (ja) | 2020-03-04 | 2022-04-08 | 株式会社クボタ | 走行経路管理システム及び収穫機 |
JP2020108384A (ja) * | 2020-03-04 | 2020-07-16 | 株式会社クボタ | 走行経路管理システム及び収穫機 |
JP2022063315A (ja) * | 2020-04-21 | 2022-04-21 | ヤンマーパワーテクノロジー株式会社 | 自律走行システム |
JP7349518B2 (ja) | 2020-04-21 | 2023-09-22 | ヤンマーパワーテクノロジー株式会社 | 自律走行システム |
JP2020129408A (ja) * | 2020-05-21 | 2020-08-27 | ヤンマーパワーテクノロジー株式会社 | 自律走行システム |
JP7122339B2 (ja) | 2020-05-21 | 2022-08-19 | ヤンマーパワーテクノロジー株式会社 | 自律走行システム |
Also Published As
Publication number | Publication date |
---|---|
JPWO2016002082A1 (ja) | 2017-04-27 |
US20170168491A1 (en) | 2017-06-15 |
JP6289603B2 (ja) | 2018-03-07 |
WO2016002082A1 (ja) | 2016-01-07 |
US20170102702A1 (en) | 2017-04-13 |
EP3165985A4 (en) | 2018-03-14 |
JP5669998B1 (ja) | 2015-02-18 |
JP2017068870A (ja) | 2017-04-06 |
US10114377B2 (en) | 2018-10-30 |
US10126752B2 (en) | 2018-11-13 |
US20170168490A1 (en) | 2017-06-15 |
EP3165985A1 (en) | 2017-05-10 |
US10120382B2 (en) | 2018-11-06 |
JP6236652B2 (ja) | 2017-11-29 |
JPWO2016002246A1 (ja) | 2017-04-27 |
EP4184276A1 (en) | 2023-05-24 |
WO2016002246A1 (ja) | 2016-01-07 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
WO2016002096A1 (ja) | 作業機械、作業機械の走行経路への進入可否判定のための装置、方法、プログラム、プログラムを記録した記録媒体、作業機械の走行制御装置 | |
JPWO2016002246A6 (ja) | 作業機械、作業機械の走行経路生成、走行経路への進入可否判定、走行経路自動選択のためのシステム、方法、プログラム、プログラムを記録した記録媒体、作業機械の走行制御システム | |
KR20210039452A (ko) | 자동 조타 시스템 및 수확기, 자동 조타 방법, 자동 조타 프로그램, 기록 매체 | |
US20180156622A1 (en) | Method and robot system for autonomous control of a vehicle | |
KR102575115B1 (ko) | 작업 차량 및 주행 영역 특정 장치 | |
RU2467374C2 (ru) | Устройство для определения маршрута транспортного средства | |
EP3351079B1 (en) | Work travel management system and method for managing work travel of a work vehicle | |
EP1915894B1 (en) | Method and apparatus for creating curved swath patterns for farm machinery | |
KR101879247B1 (ko) | 자율주행 농업기계의 작업경로 설정방법 | |
JP5667731B1 (ja) | 圃場ガイダンスシステム及び圃場ガイダンス方法並びにソフトウェア及びソフトウェアを格納した記憶媒体 | |
US7715979B2 (en) | Nudge compensation for curved swath paths | |
US20160091898A1 (en) | Intelligent Control Apparatus, System, and Method of Use | |
JP2013228821A (ja) | 作業機械及びその構成装置、コンピュータプログラム | |
US9821847B2 (en) | Method for guiding an off-road vehicle along a curved path | |
US20160274587A1 (en) | System and method for automatically generating vehicle guidance waypoints and waylines | |
JP2015167562A (ja) | 圃場ガイダンスシステム及び圃場ガイダンス方法並びにソフトウェア及びソフトウェアを格納した記憶媒体 | |
KR102584112B1 (ko) | 자율 주행 농기계의 제어 방법 및 장치 | |
EP3330824A1 (en) | Method and robot system for autonomous control of a vehicle | |
US12038758B2 (en) | Robotic work tool system and method for transporting a robotic work tool between different areas | |
US20190391595A1 (en) | Robotic vehicle with defined path and safety measures | |
JP5879011B1 (ja) | 芝刈り機 | |
JP6857267B2 (ja) | 圃場ガイダンスシステム及び圃場ガイダンス方法並びにソフトウェア及びソフトウェアを格納した記憶媒体 | |
JP2006004412A (ja) | 移動体 | |
JP7470878B2 (ja) | 車両、操舵制御のためのシステム、方法、プログラム、プログラムを記録した記録媒体、自動走行システム | |
WO2023119425A1 (ja) | 作業領域決定装置、芝刈りシステム、作業領域決定方法、および作業領域決定プログラム |
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: 14896389 Country of ref document: EP Kind code of ref document: A1 |
|
NENP | Non-entry into the national phase |
Ref country code: DE |
|
NENP | Non-entry into the national phase |
Ref country code: JP |
|
122 | Ep: pct application non-entry in european phase |
Ref document number: 14896389 Country of ref document: EP Kind code of ref document: A1 |