WO2019124463A1 - 自動走行作業機、自動走行草刈機、草刈機及び草刈機自動走行システム - Google Patents
自動走行作業機、自動走行草刈機、草刈機及び草刈機自動走行システム Download PDFInfo
- Publication number
- WO2019124463A1 WO2019124463A1 PCT/JP2018/046872 JP2018046872W WO2019124463A1 WO 2019124463 A1 WO2019124463 A1 WO 2019124463A1 JP 2018046872 W JP2018046872 W JP 2018046872W WO 2019124463 A1 WO2019124463 A1 WO 2019124463A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- traveling
- line
- travel
- unit
- automatic
- Prior art date
Links
- 244000025254 Cannabis sativa Species 0.000 title claims description 201
- 238000001514 detection method Methods 0.000 claims abstract description 280
- 238000004364 calculation method Methods 0.000 claims description 63
- 238000005520 cutting process Methods 0.000 claims description 60
- 238000003860 storage Methods 0.000 claims description 58
- 241001494496 Leersia Species 0.000 claims description 48
- 238000004891 communication Methods 0.000 claims description 48
- 238000012937 correction Methods 0.000 claims description 38
- 230000005540 biological transmission Effects 0.000 claims description 19
- 238000000034 method Methods 0.000 claims description 19
- 238000003306 harvesting Methods 0.000 claims description 18
- 230000000903 blocking effect Effects 0.000 claims description 6
- 238000007599 discharging Methods 0.000 claims description 6
- 238000005259 measurement Methods 0.000 description 8
- 235000013399 edible fruits Nutrition 0.000 description 7
- 239000000446 fuel Substances 0.000 description 6
- 238000000926 separation method Methods 0.000 description 6
- 238000012545 processing Methods 0.000 description 5
- 238000010586 diagram Methods 0.000 description 4
- 230000007257 malfunction Effects 0.000 description 3
- 230000001133 acceleration Effects 0.000 description 2
- 239000003814 drug Substances 0.000 description 2
- 229940079593 drug Drugs 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 230000006870 function Effects 0.000 description 2
- 238000009434 installation Methods 0.000 description 2
- 238000004519 manufacturing process Methods 0.000 description 2
- 239000002420 orchard Substances 0.000 description 2
- 230000000630 rising effect Effects 0.000 description 2
- 239000004575 stone Substances 0.000 description 2
- 241000255777 Lepidoptera Species 0.000 description 1
- 240000008042 Zea mays Species 0.000 description 1
- 235000005824 Zea mays ssp. parviglumis Nutrition 0.000 description 1
- 235000002017 Zea mays subsp mays Nutrition 0.000 description 1
- 230000006835 compression Effects 0.000 description 1
- 238000007906 compression Methods 0.000 description 1
- 235000005822 corn Nutrition 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 230000001902 propagating effect Effects 0.000 description 1
- 239000004065 semiconductor Substances 0.000 description 1
- 230000002123 temporal effect Effects 0.000 description 1
- 239000002023 wood Substances 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/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
- 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
-
- 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
-
- A—HUMAN NECESSITIES
- A01—AGRICULTURE; FORESTRY; ANIMAL HUSBANDRY; HUNTING; TRAPPING; FISHING
- A01D—HARVESTING; MOWING
- A01D34/00—Mowers; Mowing apparatus of harvesters
- A01D34/01—Mowers; Mowing apparatus of harvesters characterised by features relating to the type of cutting apparatus
- A01D34/02—Mowers; Mowing apparatus of harvesters characterised by features relating to the type of cutting apparatus having reciprocating cutters
- A01D34/125—Mowers; Mowing apparatus of harvesters characterised by features relating to the type of cutting apparatus having reciprocating cutters with means for discharging mown material
-
- A—HUMAN NECESSITIES
- A01—AGRICULTURE; FORESTRY; ANIMAL HUSBANDRY; HUNTING; TRAPPING; FISHING
- A01D—HARVESTING; MOWING
- A01D34/00—Mowers; Mowing apparatus of harvesters
- A01D34/01—Mowers; Mowing apparatus of harvesters characterised by features relating to the type of cutting apparatus
- A01D34/02—Mowers; Mowing apparatus of harvesters characterised by features relating to the type of cutting apparatus having reciprocating cutters
- A01D34/28—Adjusting devices for the cutter-bar
-
- A—HUMAN NECESSITIES
- A01—AGRICULTURE; FORESTRY; ANIMAL HUSBANDRY; HUNTING; TRAPPING; FISHING
- A01D—HARVESTING; MOWING
- A01D34/00—Mowers; Mowing apparatus of harvesters
- A01D34/01—Mowers; Mowing apparatus of harvesters characterised by features relating to the type of cutting apparatus
- A01D34/412—Mowers; Mowing apparatus of harvesters characterised by features relating to the type of cutting apparatus having rotating cutters
- A01D34/63—Mowers; Mowing apparatus of harvesters characterised by features relating to the type of cutting apparatus having rotating cutters having cutters rotating about a vertical axis
- A01D34/64—Mowers; Mowing apparatus of harvesters characterised by features relating to the type of cutting apparatus having rotating cutters having cutters rotating about a vertical axis mounted on a vehicle, e.g. a tractor, or drawn by an animal or a vehicle
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/01—Satellite radio beacon positioning systems transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/13—Receivers
- G01S19/14—Receivers specially adapted for specific applications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/01—Satellite radio beacon positioning systems transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/13—Receivers
- G01S19/35—Constructional details or hardware or software details of the signal processing chain
- G01S19/36—Constructional details or hardware or software details of the signal processing chain relating to the receiver frond end
-
- 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/0221—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving a learning process
-
- 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/028—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle using a RF signal
- G05D1/0282—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle using a RF signal generated in a local control room
-
- 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/04—Control of altitude or depth
Definitions
- the present invention is an automatic traveling work machine provided with a traveling vehicle, a positioning receiver for receiving a positioning signal from a navigation satellite, and an automatic traveling control device for automatically traveling along a traveling route based on the positioning signal.
- the present invention relates to an automatic traveling mowing machine provided with a traveling machine body that performs mowing travel, and a discharge mechanism that discharges mown grass after mowing from the discharge port to the ground after mowing.
- the present invention relates to a mower provided with a traveling machine body performing mowing traveling, a traveling control unit for controlling the traveling machine body, and a distance sensor.
- the present invention relates to an automatic traveling system of a mowing machine that automatically mows and travels in a traveling area set in advance on a slope.
- Patent Document 1 a traveling machine body ("frame 1-5" in the literature), a positioning receiver (“GPS device 4" in the literature) for obtaining position information of the mowing machine, and There is disclosed a remote control type mower provided with an automatic travel control device (“Control device 3" in the literature) which performs travel and mowing work following the travel route.
- GPS device 4" positioning receiver
- Control device 3 automatic travel control device
- Patent Document 2 a traveling machine body performing mowing travel (“the vehicle body 3" in the literature), a detection device (“the object detection unit 11" in the literature) that detects an object present in the range of the work area, Driving along a target line calculation unit (“reference line setting unit 13" in the literature) that calculates a target line based on a detected object, and a target line (“reference line SL” in the literature) based on the target line calculation unit
- an automatic mowing machine provided with an automatic travel control device (“travel control unit 16" in the literature) for causing the vehicle to travel automatically.
- a target line is calculated with two or more fruit trees in the orchard as targets.
- Patent Document 2 a traveling machine body performing mowing travel (“the vehicle body 3" in the literature), a detection device (“the object detection unit 11" in the literature) that detects an object present in the range of the work area, A distance calculation unit (“the distance calculation unit 14" in the document) for calculating the separation distance from the reference line (reference "SL” in the document) calculated based on the detected object to the traveling vehicle body;
- An automatic mowing machine is disclosed that is provided with a traveling control unit (reference numeral "16” in the literature) that performs traveling control so that the distance to the point falls within a preset range.
- a reference line is generated with two or more fruit trees in the orchard as targets.
- Patent Document 3 a memory for storing an object detection unit (“the distance detection means 12 in the literature”) provided on the front in the traveling direction of the airframe, various parameters for traveling (including a destination)
- a traveling route setting unit (in the document, "route generation unit 14") for setting a route for traveling based on information stored in the storage unit; and a traveling route setting unit
- An autonomous mobile device includes a control instruction unit (“travel control means 16" in the literature) that travels to a destination based on the route set in the above.
- the object detection unit detects a boundary (symbol "3" in the literature) constituted by an object such as a wall, a fence, a fence, or various installation objects, and the traveling route setting unit avoids the object based on the boundary.
- a boundary symbol "3" in the literature
- the traveling route setting unit avoids the object based on the boundary.
- the positioning receiver may be inclined, which may reduce the number of navigation satellites that can be captured by the positioning receiver, and may decrease the positioning accuracy of the positioning receiver.
- the positioning signal transmitted from the navigation satellite is diffusely reflected by the river or paddy field, making the positioning receiver susceptible to multipath effects The accuracy may be reduced.
- an object of the present invention is an automatic traveling working machine capable of receiving a positioning signal from a navigation satellite with high accuracy even on an inclined slope, and capable of automatically traveling without departing from the traveling route. It is to provide.
- the present invention relates to an assist device wherein, when the extension end of the cord-like body extended downward from the arm part is swingably connected to the hand part, the extension end of the cord-like body swings to the hand part
- the purpose is to make the connection as appropriate.
- an object of the present invention to provide an automatic traveling mowing machine capable of calculating a target line and automatically traveling based on a target line even when there is no target in the mowing target area. It is in.
- an object of the present invention is a mowing machine capable of automatically traveling by accurately discriminating the grass before harvesting and the ground after harvesting even when there is no target in the mowing target area To provide.
- the object of the present invention is to provide an object detection unit that can detect even when the inclination angle on the slope is not uniform or unevenness is present on the slope in the same slope.
- An object of the present invention is to provide a mowing machine automatic traveling system capable of accurately following an object.
- An automatic traveling work machine comprises a traveling airframe, a positioning receiver for receiving a positioning signal from a navigation satellite, an automatic traveling control device for automatically traveling along a traveling route based on the positioning signal, and the traveling aircraft body.
- a tilt detection unit that detects tilt of the vehicle and outputs tilt angle information
- a tilt angle determination unit that determines a tilt angle based on the tilt angle information
- rotation control that rotates the positioning receiver with one or more degrees of freedom
- a mechanism is provided, and the rotation control mechanism holds the positioning receiver horizontally based on the tilt angle.
- the positioning receiver since the rotation control mechanism for holding the positioning receiver horizontally is provided, the positioning receiver is held horizontally by the rotation control mechanism even when the traveling vehicle travels on the sloped slope. Therefore, the positioning receiver never tilts. This enables the positioning receiver to accurately capture a sufficient number of navigation satellites and is less susceptible to multipath effects. As a result, it is possible to realize an automatic traveling work machine that can receive a positioning signal from a navigation satellite with high accuracy even on a sloped slope and can automatically travel without departing from the traveling route.
- the rotation control mechanism is provided immediately below the positioning receiver.
- the positioning receiver is sufficient without the positioning signal transmitted from the navigation satellite being blocked by the rotation control mechanism. A large number of navigation satellites can be accurately captured.
- a shield plate which covers the lower side of the positioning receiver and which blocks the propagation of the positioning signal is provided.
- a traveling route setting unit configured to preset a traveling route of the traveling machine body
- the traveling route setting unit is parallel to the teaching traveling trajectory based on a teaching traveling trajectory by human operation of the traveling vehicle body. It is preferable to generate a plurality of line travel routes.
- a plurality of line travel routes are generated based on the teaching travel trajectory. For this reason, in the operation target of the automatic traveling work machine, the line traveling path is generated by the manual operation of only a part of the work target area, and the automatic traveling based on the line traveling path becomes possible.
- the tilt angle determination unit determines the tilt angle based on the tilt angle information detected over the teaching travel locus, and the rotation control mechanism is configured to start automatic travel on the line travel route.
- the positioning receiver is rotated at the timing of
- the positioning receiver rotates during automatic traveling, the number of navigation satellites supplemented by the positioning receiver may easily change, and the positioning accuracy of the positioning receiver may not be stable.
- the positioning receiver is rotated at the timing before the start of automatic traveling, so the positioning accuracy of the positioning receiver can be easily stabilized compared to the configuration in which the positioning receiver rotates during automatic traveling.
- the tilt angle determination unit updates the tilt angle based on the tilt angle information detected over one of the line travel routes, and the rotation control mechanism is configured to perform the next line travel route. It is preferable to rotate the positioning receiver at a timing before the start of the automatic traveling.
- the inclination angle of the slope is not always constant, and the inclination angle may be different between the upper side and the lower side of the slope.
- the difference between the inclination angles of the slopes of two adjacent line travel paths is often smaller than the difference of the inclination angles of the slopes of two non-adjacent line travel paths.
- the inclination angle can be updated based on the inclination angle information detected over the line traveling route traveled immediately before. Therefore, as the inclination angle close to the inclination angle of the slope in the next line traveling route, the inclination angle of the slope in the line traveling route which traveled one before can be used.
- a storage unit for storing the inclination angle is provided, and the storage unit stores the traveling route and the inclination angles for each of a plurality of preset points in the traveling route, and the automatic It is preferable that the traveling control device automatically travels along the traveling path stored in the storage unit, and the rotation control mechanism rotates the positioning receiver at a timing when the traveling vehicle passes the point. .
- the rotation control mechanism can be rotated at a portion of the slope where the inclination angle greatly changes during the automatic traveling.
- the positioning receiver can be held horizontally even if there is a place where the inclination angle changes greatly during automatic traveling.
- a communication unit that performs information communication with the outside of the machine is provided, and the travel route and the inclination angle can be transmitted to an external terminal via the communication unit and displayed on the external terminal.
- the solution means corresponding to [Problem 2] is as follows.
- the automatic traveling mowing machine according to the present invention comprises a traveling machine body for mowing traveling, a discharge mechanism for discharging the mowed grass after harvesting to the ground after harvesting from the discharge port, and a detection device for detecting the mowed grass discharged by the discharging mechanism. And a target line calculation unit that calculates a target line based on the detection of the cutting grass, and a distance between a target line based on the target line calculation unit and the traveling machine body is maintained at a predetermined distance. And an automatic travel control device for automatically traveling the traveling vehicle body.
- the cut grass after harvesting is discharged from the discharge mechanism, and the cut grass after discharge is detected by the detection device. For this reason, calculation of a target line is attained by making the cut grass after discharge into a target object. Thereby, even when there is no target in the mowing target area, the target line is calculated, and an automatic traveling mowing machine capable of automatic traveling based on the target line is realized.
- the discharge mechanism discharges the cut grass in a lump along the traveling track of the traveling body, and the cut grass in a block form a convex portion continuously or intermittently along the traveling track of the traveling body Preferably, it is configured to form.
- the grass cuttings are discharged in a lump and the convex portions are formed on the grass cuttings, so that the detection device can detect the grass cuttings with high accuracy.
- the discharge mechanism be provided on a side portion of the traveling machine body on which the ground after the cutting is positioned.
- the cutting grass can be discharged from the discharging mechanism to the ground after cutting, and the detection device can accurately detect the cutting grass discharged to the flat ground. .
- the detection device is provided on a side portion of the traveling machine body on which the ground after the cutting is located.
- the detection device since the detection device is provided on the side portion of the traveling machine body, the detection device can detect the cut grass even if the cut grass is directly below the detection device. For this reason, the detection device can capture the cut grass immediately after being discharged from the discharge mechanism.
- a discharge path extending from the traveling machine body to the discharge port is formed in the discharge mechanism, and the discharge path has a narrow cross-sectional shape as the discharge port is located. .
- the cut grass before being discharged from the discharge port is compressed by the narrowed discharge path on the side where the discharge port is positioned, so that the cut grass at the time of discharge tends to be lumpy.
- the discharge mechanism includes an open / close mechanism capable of opening and closing the discharge port, and a pressure detection unit that detects the pressure of the cut grass, and the pressure detection unit is configured to have a pressure higher than a preset pressure. It is preferable that the open / close mechanism is opened when it is detected.
- the solution means corresponding to [Problem 3] is as follows.
- the distance between the traveling machine body performing mowing traveling the traveling control unit for controlling the traveling machine body, the traveling machine body, and an object positioned in the left-right direction of the machine body
- a distance sensor for scanning a decoding control unit for generating ground height data over both the left and right of the vehicle based on the distance and scanning angle detected by the scanning of the distance sensor, and an approximation line based on the ground height data
- An object detection unit for generating a ground reference line identified as a ground line after harvesting and a grass reference line identified as a grass line before harvesting; a distance between the grass reference line and the traveling airframe A target distance calculation unit that calculates a target distance based on the distance, and a travel instruction unit that outputs an instruction signal such that the distance between the grass reference line and the traveling vehicle matches the target distance.
- the distance sensor identifies the ground after harvesting and the grass before harvesting by manipulating the lateral direction of the traveling vehicle, and the grass reference line based on the identification of the grass and the traveling vehicle are set in advance.
- the traveling vehicle is controlled to maintain the determined distance. From this, the mowing machine can perform mowing traveling automatically along the boundary between the ground after cutting and the grass before cutting. As a result, even if there is no target in the mowing target area, a mowing machine capable of automatically traveling by accurately discriminating the grass before mowing and the ground after mowing is realized.
- a traveling mode determination unit that determines a traveling mode of the traveling vehicle is provided, and the traveling mode has a manual control mode and an automatic control mode, and the traveling mode is the manual control mode.
- the traveling control unit controls the traveling machine body based on an operation signal of manual control, and when the traveling mode is the automatic control mode, the traveling control unit operates the traveling machine body based on an instruction signal of the traveling instruction unit. It is preferable to control
- the mowing machine can be operated remotely according to the conditions of the mowing target area and the conditions of the traveling aircraft. With this configuration, it is possible to switch the signal input by the traveling control unit to the operation signal in the manual control mode and the instruction signal in the automatic control mode from the determination of the traveling mode by the traveling mode determination unit Become.
- the distance sensor is configured to scan by rotating around a longitudinal axis of the machine body.
- the distance sensor can scan the ground in the vicinity of the lower part of the traveling body among the ground after cutting. As a result, the distance sensor can scan the ground after harvesting and the grass before harvesting precisely.
- the distance sensor be provided at either the front or the rear of the traveling body.
- the distance sensor can scan the ground directly below the distance sensor, as compared to a configuration in which the distance sensor is provided at the front-rear center of the traveling vehicle. As a result, the distance sensor can scan the ground after harvesting and the grass before harvesting precisely.
- the distance sensor be provided at both the front and the rear of the traveling body.
- the distance sensor provided at the front of the traveling machine can scan the ground and grass before mowing and the mowing is performed using the distance sensor provided at the rear of the traveling machine. You can scan the ground and grass behind. As a result, the mower can accurately follow the boundary between the ground after harvesting and the grass before harvesting.
- the object detection unit calculates the ground reference by calculating an approximate line from data in the range in the left-right direction of the machine preset from the vertical direction of the machine of the distance sensor among the ground height data. Preferably, it is configured to generate a line.
- the object detection unit calculates an approximation line from data of a location where data having a height of a predetermined value or more from the ground reference line in the ground height data continues over a predetermined range or more.
- the object detection unit calculates an approximation line from data of a location where data having a height of a predetermined value or more from the ground reference line in the ground height data continues over a predetermined range or more.
- the ground height data generated as the grass candidate line is limited to data of a portion where the data is continuous over a predetermined range or more. For this reason, the data which is not continuous over a certain range is excluded from the data of the grass candidate line, and the risk of erroneously detecting the grass is reduced. Further, since the grass candidate line is generated based on the approximate line, the ground after cutting and the grass before mowing can be efficiently discriminated from the ground height data.
- a plurality of the grass candidate lines are generated, and the traveling machine body is provided with an inertial sensor for detecting an inclination angle of the traveling machine body, and the object detection unit is configured to select the grass candidate line among the grass candidate lines.
- the grass reference line is one of the candidate grass lines in which the inclination angle of the line with respect to the ground reference line and the calculated inclination angle calculated from the inclination angle detected by the inertial sensor are within a predetermined reference range.
- it is configured to be configured to identify a line.
- grass often grows upward along a specific direction (e.g. vertical direction) even on slopes.
- the specific direction can be calculated based on the inclination angle of the inertial sensor. For this reason, the discrimination
- the grass reference line is limited to a height range set in advance from the ground reference line.
- the target distance is a moving average value of the plurality of values. It is preferable to be calculated based on.
- the distance between the grass and the traveling airframe changes significantly by detection of stones or piles on the ground
- the target distance is a moving average value
- the change in the target distance is determined by the grass reference line and the traveling airframe Is smaller than the change in the distance d, and the instruction signal in the travel instruction unit is stabilized.
- the solution means corresponding to [Problem 4] is as follows.
- the automatic mowing machine traveling system according to the present invention is an automatic traveling system of a mowing machine that automatically mowing and traveling in a traveling area set in advance on a slope, provided at the uppermost end of the slope and transmitting a detection signal.
- An object detection unit for detecting an object by acquiring a reflection signal with respect to the detection signal, a reflection unit provided on a side surface of the mowing machine on which the object detection unit is located, and detected by the object detection unit;
- a communication unit provided in each of the object detection unit and the mowing machine, a storage unit for storing area information of the traveling area, and work history information of the mowing machine, and a traveling path of the mowing machine
- a travel route setting unit to set and a control instruction unit to transmit an instruction signal to the mowing machine are provided, the object detection unit is configured to follow the reflection unit, and the control instruction unit is configured to Anti object acquired by the object detection unit Based on the signal, the traveling locus of the mowing machine is calculated to calculate an error between the traveling locus of the mowing machine and the traveling route, and the instruction signal is generated to reduce the error, and the mowing machine Automatic mowing travel is performed along the travel path according to the instruction signal.
- the object detection unit is provided at the uppermost end of the slope and the reflection unit is provided on the side surface of the mowing machine.
- the object detection unit is fixed at a fixed point position, and the detection target of the object detection unit can be used as a mowing machine, so that the object detection unit is stable compared to the configuration in which the object detection unit is provided in the mowing machine It becomes possible to detect the reflection part of the mower. From this, even if the mower is sharply inclined due to irregularities or the like on the slope, the object detection unit can detect the reflection portion of the mower without being affected by the irregularities or the like on the slope. . By this, even if the inclination angle on the slope is not uniform or unevenness is present on the slope on the same slope, the mower can automatically follow the object with high accuracy by the object detection unit. A traveling system is realized.
- the mowing machine is provided with an inclination sensor for detecting an inclination angle of the mowing machine, and the object detection unit includes an angle of the object detection unit so as to coincide with the inclination angle detected by the inclination sensor. It is preferable that a tilt correction control unit that performs adjustment be provided.
- the inclination angle detected by the inclination sensor of the mower often follows the inclination angle of the slope. From this, in the case of this configuration, the object detection unit determines the inclination angle of the slope by the inclination correction control unit. Slant along. As a result, it is not necessary to adjust the inclination of the object detection unit by manual operation for different slopes, and the object detection unit can easily follow the reflection unit of the mower corresponding to various inclination angles. .
- a plurality of horizontally long reflection sheets are vertically arranged in the reflection portion, and It is preferable that the respective reflection sheets have different lengths in the longitudinal direction.
- the object detection unit when the object detection unit scans in the horizontal direction, the object detection unit can detect the length of the horizontally long reflective sheet. Since the lengths of the plurality of reflection sheets are different from each other, the object detection unit can determine which one of the upper side and the lower side of the reflection portion follows, based on the length of the reflection sheet. . As a result, the object detection unit can follow the upper and lower center points of the reflection unit, and the object detection unit preferably uses the reflection unit even if the mower moves up and down rapidly due to unevenness or the like on the slope. Can follow.
- each of the reflection sheets has a longer length in the longitudinal direction as it is located on the lower side of the machine.
- the object detection unit can easily determine which one of the upper side and the lower side of the reflection unit is following, and the risk of an erroneous determination can be reduced.
- a mounting jig for fixing the object detection unit is provided at the uppermost end of the slope, and the object detection unit is configured to be detachable from the mounting jig.
- the mounting jig is fixed to the uppermost end of the slope and the object detection unit can be configured to be portable, so there is no need to install and fix the object detection unit in all traveling areas. For this reason, compared with the structure which installs and fixes an object detection part in all driving
- the area information and the work history information are detected from the storage unit while the storage unit is provided to the mounting jig and the object detection unit is fixed to the mounting jig.
- the unit is configured to be readable.
- the area information and the work history information can be stored in the storage unit from the object detection unit.
- the automatic mowing travel area information and work history information are updated, the updated information is stored in the storage unit, so the same object detection unit is used at the next automatic mowing travel Even if not, the latest area information and work history information can be read out.
- the automatic mowing traveling more stable than the past automatic mowing traveling becomes possible.
- the traveling path setting unit generates a plurality of line traveling paths parallel to the teaching traveling path based on a teaching traveling path by manual operation of the mowing machine.
- a plurality of line travel routes are generated based on the teaching travel trajectory. For this reason, in the operation target of the automatic mowing travel, the line travel path is generated by the manual operation of only a part of the work target area, and the automatic travel based on the line travel path becomes possible.
- the plurality of line travel paths be positioned in parallel with each other below the slope with respect to the teaching travel path.
- the object detection unit is provided at the upper end of the slope, automatic mowing travel is sequentially performed from the upper side to the lower side of the slope in the present configuration. Therefore, the ground between the object detection unit and the mowing machine is always the ground after cutting, and the object detection unit can preferably follow the reflection unit of the mowing machine without being disturbed by uncut grass.
- the teaching travel locus and the plurality of line travel paths are stored in the storage unit as the work history information, and the travel path setting unit is configured to line the teaching travel locus based on the work history information. It is preferable that the traveling route can be reproduced and that the plurality of line traveling routes can be reproduced.
- FIG. It is a figure which shows 4th Embodiment, Comprising: It is explanatory drawing for demonstrating the inclination of the object detection part 301.
- FIG. It is a figure which shows 4th Embodiment, Comprising: It is a figure which shows a reflection part.
- an automatic traveling mowing machine as an automatic traveling work machine exemplified in the present embodiment includes a traveling body 1, a first wheel 2A, a second wheel 2B, and a mowing apparatus 3.
- the positioning receiver 4 and the rotation control mechanism 5 are provided.
- the first wheels 2 ⁇ / b> A are provided on the one end side in the longitudinal direction of the traveling body 1 in a left-right pair.
- the second wheels 2 ⁇ / b> B are provided on the other end side in the longitudinal direction of the traveling airframe 1 in a left-right pair.
- the mowing device 3 is provided between the first wheel 2A and the second wheel 2B in the lower part of the traveling body 1.
- the positioning receiver 4 is provided on the traveling body 1.
- the rotation control mechanism 5 is rotatable with multiple degrees of freedom, and is provided between the positioning receiver 4 and the traveling body 1.
- the positioning receiver 4 uses GPS (Global Positioning System) which is a well-known technology as an example of a satellite positioning system (GNSS: Global Navigation Satellite System) that receives radio waves from navigation satellites and detects the position of the vehicle. And configured to receive the positioning signal.
- the positioning receiver 4 is not limited to the GPS, and may be configured to support multi-GNSS.
- a shield plate 6 is provided between the positioning receiver 4 and the rotation control mechanism 5. The blocking plate 6 is provided directly below the positioning receiver 4.
- an antenna 8 capable of communicating with the transmitter 7 (see FIG. 4) is provided above the traveling body 1.
- the transmitter 7 is configured such that the operator can manually operate the automatic traveling work machine while carrying it.
- the transmitter 7 may be, for example, an operation by a proportional type transmitter operated by the operator at hand or an operation by a portable terminal device having a touch panel display screen.
- the traveling airframe 1 is provided with a transmission mechanism for transmitting the power of the engine EA to the first wheel 2A and the second wheel 2B and transmitting the power to the mowing apparatus 3.
- the power transmission mechanism is configured to be able to interrupt power transmission to the first wheel 2A, the second wheel 2B, and the mowing device 3.
- the power of the engine EA is transmitted to the first wheel 2A, the second wheel 2B, and the mowing apparatus 3, whereby mowing work can be performed while the vehicle is traveling.
- a first steering motor 9A is provided on the first wheel 2A, and the first wheel 2A is configured to swing around a longitudinal axis center by the driving force of the first steering motor 9A so as to be steerable.
- the second steering motor 9B is provided on the second wheel 2B, and the second wheel 2B is configured to swing around the longitudinal axis center by the driving force of the second steering motor 9B so that steering operation is possible.
- the first wheel 2A and the second wheel 2B can be changed in direction to a straight advance posture, a rightward swing posture, and a left swing posture, respectively.
- the automatic traveling mowing is carried out, for example, in a state in which a control unit UA for enabling automatic traveling of the automatic traveling mowing machine along a preset traveling path is incorporated in a microcomputer, for example.
- the machine is equipped.
- the control unit UA includes a traveling mode determination unit 10, a storage unit 11, a traveling route setting unit 12, and an automatic traveling control device 13.
- the storage unit 11 is configured to be able to store position information based on a positioning signal received by the positioning receiver 4.
- the travel route setting unit 12 sets a travel route for the traveling machine body 1 to automatically travel.
- the automatic travel control device 13 is configured such that the traveling body 1 travels along the travel route set by the travel route setting unit 12.
- control unit UA is configured to be able to switch between an automatic travel mode and a manual travel mode by the determination of the travel mode determination unit 10.
- the automatic traveling work machine carries out mowing traveling etc. based on the manual operation of the transmitter 7, so the automatic traveling control device 13 is invalidated, but the traveling route setting in conjunction with the automatic traveling control device 13 The unit 12 may also be invalidated.
- the output targets of the automatic travel control device 13 are the travel control motor 15, the forward / reverse motor 16, the first steering motor 9A, and the second steering motor 9B.
- the travel control motor 15 operates an accelerator 20 that adjusts the amount of fuel supplied to the engine EA, and a brake 21 that brakes the first wheel 2A and the second wheel 2B.
- the forward / reverse motor 16 switches the forward / reverse switching mechanism 22.
- the forward / reverse switching mechanism 22 is provided in a transmission that transmits the power of the engine EA to the first wheel 2A and the second wheel 2B, and switches the power of the engine EA in forward and reverse directions. Gear mechanism.
- the first steering motor 9A steers the first wheel 2A
- the second steering motor 9B steers the second wheel 2B.
- Each of the traveling control motor 15 and the forward and reverse motor 16 may be an electric motor or an electromagnetic switch.
- the automatic cruise control device 13 specifies the position and orientation of the traveling vehicle 1 from the positioning signal received by the positioning receiver 4. Then, by outputting control signals to the traveling control motor 15, the forward / reverse motor 16, the first steering motor 9A, and the second steering motor 9B, the traveling machine body 1 is driven along the traveling route described later.
- the automatic travel control device 13 is configured to travel. Further, the automatic travel control device 13 is configured to be switchable between an automatic travel mode based on a control signal of the automatic travel control device 13 and a manual travel mode based on a control signal by manual operation.
- the traveling body 1 is provided with a communication unit 17 capable of receiving an operation signal wirelessly transmitted from the transmitter 7 via the antenna 8. Information received by the communication unit 17 is input to the control unit UA.
- the state of the automatic traveling mowing machine can be transmitted from the communication unit 17 to the device outside the machine body, and for example, it is also possible to display the current position or the state of the automatic traveling mowing machine on the display screen of the mobile terminal device.
- the state of the automatic traveling mowing machine may be, for example, the vehicle speed of mowing traveling, the remaining amount of fuel, or may indicate a malfunction of various devices mounted on the automatic traveling mowing machine.
- the control unit UA is provided with a traveling route setting unit 12.
- a travel route for the traveling machine body 1 to automatically travel is preset by the travel route setting unit 12.
- a plurality of linear line traveling routes LA are set as traveling routes for automatically traveling on a slope.
- each line travel route LA is generated by the travel route setting unit 12 in the following procedure.
- teaching traveling is performed in the manual traveling mode along the upper end edge of the slope.
- the teaching travel is performed based on a manual operation by the operator operating the transmitter 7.
- the operator performs the start point setting operation with the transmitter 7 in a state where the traveling machine body 1 is located at the start point position TAs.
- the operator travels the traveling body 1 along the linear shape from the start position TAs to the end position TAf, and the operator performs the end point setting operation with the transmitter 7 in a state where the traveling body 1 is positioned at the start position TAs.
- the teaching process is performed.
- a teaching path TA is set.
- the position of the traveling vehicle 1 during teaching traveling may be sequentially positioned by the positioning receiver 4, and the positioning signal may be stored in the storage unit 11.
- a teaching path TA can be obtained by extracting positional coordinates of the traveling body 1 with time, from a set of positioning signals ranging from the start position TAs of the teaching travel and the end position TAf of the teaching travel. This configuration is particularly useful when the teaching path TA is curvilinear.
- a plurality of line travel routes LA are generated at equal intervals toward the lower side of the slope as a travel route parallel to the teaching route TA.
- line traveling routes LA (1) to LA (10) along the teaching route TA are generated at equal intervals downstream of the teaching route TA on the slope.
- the line travel route LA is set in a state where the work width slightly overlaps so as not to cause the uncut area in consideration of the width of the area to be mowing work and the mowing work width by the work vehicle.
- the start position LAs and the end position LAf are assigned to the respective line travel routes LA (1) to LA (10), and the direction from the start position LAs to the end position LAf is the traveling direction of the traveling airframe 1
- the respective line travel routes LA (1) to LA (10) are configured.
- a traveling route for traveling body 1 to travel in each of line travel routes LA (1) to LA (10) in order is set, and in the present embodiment, traveling is performed while turning from the upper side to the lower side of the slope.
- a route in which the airframe 1 repeats linear reciprocating travel is set. That is, the line travel route LA (n + 1) to which the next route is allocated on the slope downstream side of the end point position LAf in any one of the line travel routes LA (1) to LA (9).
- the travel route is set such that the start positions LAs of) are adjacent to each other.
- the automatic traveling mowing machine travels automatically while mowing along the line traveling route LA.
- the automatic traveling control device 13 sets the starting point position LAs of the line traveling path LA (2) to which the next route is assigned. It outputs a control signal to move.
- the automatic traveling control device 13 may output a control signal to move to the start position LAs of the next line traveling route LA (2) while the traveling airframe 1 makes a U-turn, or the traveling airframe A control signal may be output so as to move to the start position LAs of the next line traveling route LA (2) while repeating the switchback without changing the direction of 1.
- the switchback in the present embodiment is repeatedly moved forward and backward by the switching operation of the forward / reverse switching mechanism 22, and the position of the traveling body 1 is determined. It is a traveling mode of moving to the start position LAs so as to be shifted to the lower side of the slope from the position of the end position LAf.
- the movement from the end position LAf to the next start position LAs may be performed by the manual travel mode.
- switching from the manual traveling mode to the automatic traveling mode may be performed by human operation or may be performed automatically.
- the automatic traveling mowing machine takes the line traveling route LA. (2) run automatically while mowing along.
- the automatic travel control device 13 is configured to specify the position and orientation of the traveling vehicle 1 from the positioning signal received by the positioning receiver 4, the slope on which the automatic traveling mowing machine in this embodiment is inclined is When traveling, the positioning receiver 4 is also inclined according to the inclination degree of the slope. The inclination of the positioning receiver 4 may reduce the number of navigation satellites that can be captured by the positioning receiver 4. In addition, when a river or a paddy field exists in the lower direction of the slope slope, the positioning signal transmitted from the navigation satellite is irregularly reflected by the river or the paddy field, so that the positioning receiver 4 becomes susceptible to multipath. The positioning accuracy may be reduced.
- the distance between the positioning receiver 4 and the ground is often short, and such a problem is likely to occur.
- the blocking plate 6 is provided immediately below the positioning receiver 4, and the blocking plate 6 blocks the positioning signal diffusely reflected in the river or the paddy field below the positioning receiver 4.
- the positioning receiver 4 is less likely to be affected by multipath, and the possibility of lowering the positioning accuracy is reduced.
- a rotation control mechanism 5 for reducing the inclination of the positioning receiver 4 is provided below the positioning receiver 4.
- the shielding plate 6 is provided below the positioning receiver 4, and the rotation control mechanism 5 is provided below the shielding plate 6, and the positioning receiver 4 and the shielding plate are provided.
- the reference numeral 6 is configured to be able to pivot integrally with the axis of rotation of the rotation control mechanism 5.
- the rotation control mechanism 5 is configured to rotate with two degrees of freedom. That is, the rotation control mechanism 5 is configured to be rotatable about two axes of a roll axis along the longitudinal direction of the traveling body 1 and a pitch axis along the lateral direction of the traveling body 1. ing.
- the positioning receiver 4 rotates with multiple degrees of freedom. As described above, even when the traveling body 1 travels on a slope, the rotation control mechanism 5 rotates so as to hold the positioning receiver 4 in the horizontal attitude.
- the inclination angle detection unit 30 is provided in the traveling body 1 and the inclination angle detection unit 30 is, for example, an IMU (Inertial Measurement Unit), which is an example of an inertial sensor, detects inclination of the traveling body 1 and detects inclination angle information ImA. Output The angle for the positioning receiver 4 to hold the horizontal attitude is determined by the inclination angle determination unit 31, and the inclination angle determination unit 31 determines the inclination angle IA output to the rotation control mechanism 5 based on the inclination angle information ImA. Do.
- the tilt angle IA includes a roll angle along the longitudinal direction of the traveling body 1 and a pitch angle along the lateral direction of the traveling body 1.
- the determined inclination angle IA is output to the rotation control mechanism 5, and the rotation control mechanism 5 adjusts the rotation angle of the roll axis and the pitch axis based on the input inclination angle IA.
- the inclination angle determination unit 31 may determine the inclination angle information ImA detected by the inclination angle detection unit 30 as it is as the inclination angle IA, and may output the inclination angle IA to the rotation control mechanism 5 as it is. Furthermore, a configuration is also possible in which the rotation control mechanism 5 horizontally holds the positioning receiver 4 in real time by rotating the positioning receiver 4 immediately based on the input inclination angle IA. However, in such a configuration, the positioning receiver 4 continues to rotate with respect to the traveling body 1 following the unevenness of the ground during traveling of the traveling body 1, and the inclination of the positioning receiver 4 relative to the traveling body 1 There is a risk that the posture may not be stable.
- the inclination angle detection unit 30 continues detection of the inclination angle information ImA across the start position TAs and the end position TAf of the teaching travel, The output of the tilt angle information ImA to the tilt angle determination unit 31 is continued. Then, the inclination angle determination unit 31 calculates the average value of the inclination angle information ImA detected over the start position TAs and the end position TAf, and determines this average value as the inclination angle IA (0).
- the rotation control mechanism 5 When the traveling body 1 automatically travels on the first line traveling route LA (1), the rotation control mechanism 5 performs positioning so that the positioning receiver 4 holds the inclination of the inclination angle IA (0) with respect to the traveling body 1 Positioning and holding the receiver 4 The timing at which the rotation control mechanism 5 rotates the positioning receiver 4 is between the end point position TAf and the start point position LAs of the first line travel route LA (1).
- the inclination angle detection unit 30 When traveling body 1 travels along the first line traveling route LA (1), the inclination angle detection unit 30 inclines over the start position LAs and the end position LAf in the line traveling route LA (1). The detection of the information ImA is continued, and the output of the tilt angle information ImA to the tilt angle determination unit 31 is continued. Then, the inclination angle determination unit 31 calculates the average value of the inclination angle information ImA detected over the starting point position LAs and the end point position LAf in the first line traveling route LA (1), and calculates this average value as the inclination angle Determined as IA (1). That is, the inclination angle determination unit 31 updates the inclination angle IA from the inclination angle IA (0) to the inclination angle IA (1). After the traveling body 1 reaches the end point position LAf of the first line traveling path LA (1), it is based on the inclination angle IA (1) until it moves to the starting point position LAs of the next line traveling path LA (1) The rotation control mechanism 5 rotates.
- the rotation control mechanism so that the positioning receiver 4 holds the inclination of the inclination angle IA (1) with respect to the traveling airframe 1 when the traveling airframe 1 is traveling along the first line traveling route LA (2) 5 positions and holds the positioning receiver 4;
- the inclination angle detection unit 30 in order for the inclination angle determination unit 31 to calculate the inclination angle IA (2), the inclination angle detection unit 30 also performs inclination angle information ImA across the start position LAs and the end position LAf in the line travel route LA (2). And continues to output the tilt angle information ImA to the tilt angle determination unit 31. Then, when the traveling airframe 1 reaches the end point position LAf of the line travel route LA (2), the inclination angle determination unit 31 updates the inclination angle IA from the inclination angle IA (1) to the inclination angle IA (2).
- the rotation control mechanism 5 The positioning receiver 4 is configured to be positioned and held at the inclination angle IA (n-1) determined by the previous line traveling route LA (n-1).
- the difference between the slope angles of the slopes between the adjacent line travel route LA (n-1) and the line travel route LA (n) is the difference between the slope angles of the slopes of two line travel routes LA which are separated without being adjacent to each other. Often less than the difference.
- the transmitter 7 When the transmitter 7 is, for example, a mobile terminal device and has a display screen, the transmitter 7 is configured to be able to display the tilt angle information ImA and the tilt angle IA on the display screen via the communication unit 17 ing.
- a travel route including a teaching travel locus and a line travel route LA can also be displayed on the display screen.
- the line travel routes LA (1) to LA (10) are generated from the teaching route TA based on the positioning signal stored in the storage unit 11 during teaching travel. It is not limited to the embodiment described above.
- all travel routes including the teaching route TA and the line travel route LA are stored in the storage unit 11, and automatic travel is performed along the travel route stored in the storage unit 11 at the next automatic travel by the automatic travel mowing machine. It may be a configuration to be performed. As a result, it is not necessary to perform teaching traveling before the next automatic traveling, and it is possible to omit labor of human operation.
- each of the inclination angles IA (0) to I (9) may be stored in the storage unit 11 as well as the traveling route.
- the traveling airframe 1 is moved from the end point position LAf of one of the line traveling paths LA (1) to LA (9) to the starting point position LAs of the next line traveling path LA (n + 1)
- the rotation control mechanism 5 may be configured to rotate the positioning receiver 4 based on the inclination angle IA (n) corresponding to the line travel route LA (n + 1).
- the teaching route TA, the line travel route LA, and the inclination angle IA are not limited to the storage unit 11, and may be managed by an external terminal, for example.
- the communication unit 17 is configured to be able to communicate with an external terminal via a WAN (Wide Area Network) or the like, and the teaching route TA, the line travel route LA, and the inclination angle IA are through the communication unit 17. It may be configured to be read from the external terminal, or may be configured to be stored in the external terminal via the communication unit 17 through the teaching route TA and the line travel route LA, and the inclination angle IA. good.
- the inclination angle determination unit 31 is configured to update the inclination angle IA when reaching the end point position LAf of each line traveling route LA, but in the embodiment described above It is not limited.
- the tilt angle IA is stored in the storage unit 11 in a state of being associated with position information based on the positioning signal received by the positioning receiver 4 and the rotation control mechanism when the traveling body 1 passes a specific position 5 may rotate and the positioning receiver 4 may be hold
- the position information of the positions P1 to P11 is stored in the storage unit 11, and the position information of the positions P1 to P11
- the storage unit 11 may be configured to store the inclination angles IA (P1) to I (P11) corresponding to each of the above. Every time the traveling vehicle 1 passes the positions P1 to P11, the inclination angle determination unit 31 reads the inclination angles IA (P1) to I (P11) corresponding to the position information of the positions P1 to P11, respectively, and controls the rotation control mechanism. The 5 rotates the positioning receiver 4. As a result, for example, in a mortar-like land, the positioning receiver can be held horizontally even if there is a place where the inclination angle greatly changes during automatic traveling.
- each line travel route LA is set based on the linear teaching route TA, but may be set based on the curvilinear teaching route TA.
- a curved line traveling route LA parallel to the teaching route TA may be set at equal intervals based on the curving teaching route TA.
- the inclination angle determination unit 31 is configured to update the inclination angle IA when reaching the end point position LAf of each line traveling route LA, but in the embodiment described above It is not limited.
- the inclination angle determination unit 31 calculates the average value of the inclination angle information ImA detected over the start position TAs and the end position TAf of the teaching travel, determines this average value as the inclination angle IA, and thereafter The tilt angle IA may not be updated.
- IMU is illustrated as the above-mentioned inclination angle detection part 30, it is not limited to an embodiment mentioned above.
- a pendulum type or float type inclination angle detector may be used as the inclination angle detection unit 30, a pendulum type or float type inclination angle detector may be used.
- the inertial sensor may be a gyro sensor or an acceleration sensor.
- the positioning receiver 4 and the rotation control mechanism 5 illustrated in the above-described embodiment may be configured in an integral form.
- the automatic traveling mowing machine has been described as traveling automatically while mowing the grass, but it is also possible to use the automatic traveling mowing machine as another working vehicle such as a drug sprayer.
- FIG. 10 An embodiment of an automatic traveling work machine according to the present invention will be described based on the drawings.
- a traveling machine body 101, a first wheel 102A, a second wheel 102B, and a mowing apparatus 103 are provided as an automatic traveling mowing machine as an automatic traveling work machine exemplified in the present embodiment.
- the first wheels 102 ⁇ / b> A are provided on the one end side in the longitudinal direction of the traveling machine body 101 in a left-right pair.
- the second wheels 102 ⁇ / b> B are provided on the other end side in the longitudinal direction of the traveling machine body 101 as a left-right pair.
- the mowing apparatus 103 is provided between the first wheel 102A and the second wheel 102B in the lower part of the traveling body 101.
- the discharge mechanism 104 (refer FIG.13 and FIG.14) is provided in the one end side part of the traveling body 101, and the discharge mechanism 104 discharges the cut grass cut away by the mowing apparatus 103.
- FIG. Furthermore, a detection device 110 is provided on the upper part of the traveling machine body 101. The detection device 110 will be described later.
- An antenna 108 capable of communicating with the transmitter 107 is provided upright on the top of the traveling vehicle body 101.
- the transmitter 107 is configured such that the operator can manually operate the automatic traveling work machine while carrying it.
- the transmitter 107 may be, for example, an operation by a proportional type transmitter operated by the operator at hand or an operation by a portable terminal device having a touch panel display screen.
- the traveling machine body 101 is provided with a transmission mechanism that transmits the power of the engine EB to the first wheel 102A and the second wheel 102B and to the mowing apparatus 103.
- the transmission mechanism is configured to be able to interrupt power transmission to the first wheel 102A, the second wheel 102B, and the mowing apparatus 103.
- the power of the engine EB is transmitted to the first wheel 102A, the second wheel 102B, and the mowing apparatus 103, whereby mowing work can be performed while the vehicle is traveling.
- a first steering motor 109A is provided on the first wheel 102A, and the first wheel 102A is configured to swing around a longitudinal axis center by the driving force of the first steering motor 109A so that steering operation is possible.
- the second steering motor 109B is provided on the second wheel 102B, and the second wheel 102B is configured to swing around the longitudinal axis center by the driving force of the second steering motor 109B so that steering operation is possible.
- the first wheel 102A and the second wheel 102B can be changed in direction to a straight advance posture, a rightward swing posture, and a left swing posture, respectively.
- the discharge mechanism 104 is provided so as to protrude on either the left or right side of the traveling airframe 101.
- the dotted area GNB indicates an uncut area among the mowing target areas. The same applies to the area GNB shown in FIGS. 16 to 22 described later.
- the discharge mechanism 104 is provided on the side of the traveling machine body 101 where the ground after cutting is located. The projecting tip end of the discharge mechanism 104 is opened to form a discharge port 104a. Further, in the discharge mechanism 104, a discharge path 104b is formed across the discharge port 101b of the traveling machine body 101 and the discharge port 104a of the discharge mechanism 104.
- the discharge path 104b is formed in the shape of a front stop where the cross-sectional shape is narrowed narrowly as it is positioned on the side where the discharge port 104a is positioned. Due to this shape, the cut grass cut by the mowing device 103 enters the discharge path 104b from the discharge port 101b, and is compressed at a location on the side where the discharge port 104a is located to form a lump cut grass G.
- An opening and closing mechanism 141 for opening and closing the outlet 104 a is provided in the outlet 104 a. Further, a pressure sensor 142 (pressure detection means) for measuring the degree of compression of cut grass is provided at a position of the discharge mechanism 104 on the side where the discharge port 104a is positioned.
- the open / close mechanism 141 is configured to be switchable between an open state in which the discharge port 104 a is opened and a closed state in which the discharge port 104 a is closed.
- the pressure sensor 142 is, for example, a switch that operates when receiving a pressure higher than a preset pressure, and is configured such that the open / close mechanism 141 is in an open state while the pressure sensor 142 operates.
- the opening and closing mechanism 141 may be configured to be opened and closed by an electric motor, or may be opened and closed by an electromagnetic switch.
- the pressure sensor 142 may be a load cell, or may be a spring-type switch that operates when the pressure of the cutting grass resists the biasing force.
- the discharge mechanism 104 is provided on the side of the traveling machine body 101 where the ground after cutting is located. For this reason, in a state where the traveling machine body 101 travels mowing, the cut grass is discharged in bulk from the discharge port 104a to the ground after cutting, so that the cut grass G is linearly arranged on the ground after cutting. That is, the lump cut grass G continuously forms a convex portion along the traveling path of the traveling machine body 101 on the ground after cutting.
- the mass cut grass G may be intermittently arranged on the ground after cutting by switching between the open state and the closed state in the opening and closing mechanism 141. In this case, the convex portions along the traveling trajectory of the traveling vehicle body 101 are also intermittently formed. Thus, on the ground after cutting, a line of line shape formed by the convex portions of the massive cut grass G is continuously or intermittently formed.
- the control unit UB includes a traveling mode determination unit 1111, a target line calculation unit 112, an automatic travel control device 113, and a decoding unit 114.
- the target line calculation unit 112 sets a target line LB for the traveling machine body 101 to automatically travel.
- the automatic travel control device 113 is configured such that the traveling vehicle body 101 travels in parallel with the target line LB set by the target line calculation unit 112.
- the decoding unit 114 converts the detection signal detected by the detection device 110 into data for the target line calculation unit 112 to calculate the target line LB. Further, the control unit UB is configured to be able to switch between the automatic travel mode and the manual travel mode by the determination of the travel mode determination unit 111. In the manual traveling mode, since the automatic traveling work machine carries out mowing traveling etc. based on the manual operation of the transmitter 107, the automatic traveling control device 113 is invalidated, but the target line is calculated in conjunction with the automatic traveling control device 113. The unit 112 may also be invalidated.
- the output targets of the automatic travel control device 113 are the travel control motor 115, the forward / reverse motor 116, the first steering motor 109A, and the second steering motor 109B.
- the travel control motor 115 operates an accelerator 120 that adjusts the amount of fuel supplied to the engine EB, and a brake 121 that brakes the first wheel 102A and the second wheel 102B.
- the forward / reverse motor 116 switches the forward / reverse switching mechanism 122.
- the forward / reverse switching mechanism 122 is provided in a transmission that transmits the power of the engine EB to the first wheel 102A and the second wheel 102B, and switches the power of the engine EB in the forward direction and the reverse direction.
- Gear mechanism The first steering motor 109A steers the first wheel 102A, and the second steering motor 109B steers the second wheel 102B.
- Each of the traveling control motor 115 and the forward / reverse motor 116 may be an electric motor or an electromagnetic switch.
- the traveling machine body 101 is provided with a communication unit 117 capable of receiving an operation signal wirelessly transmitted from the transmitter 107 via the antenna 108. Information received by the communication unit 117 is input to the control unit UB.
- the state of the automatic traveling mowing machine can be transmitted from the communication unit 117 to the device outside the machine body, and it is also possible to display the current position or state of the automatic traveling mowing machine, for example, on the display screen of the mobile terminal device.
- the state of the automatic traveling mowing machine may be, for example, the vehicle speed of mowing traveling, the remaining amount of fuel, or may indicate a malfunction of various devices mounted on the automatic traveling mowing machine.
- the detection device 110 is provided on the top of the traveling body 101.
- the detection device 110 is, for example, an LRF (Laser Range Finder), and transmits, for example, an air-propagating signal such as a laser beam as a detection signal.
- an air-propagating signal such as a laser beam
- the detection signal is reflected on the surface of the detection target.
- the detection apparatus 110 acquires the detection signal reflected by the surface of a detection target as a reflected signal. That is, the detection device 110 transmits a detection signal toward the detection range of the detection device 110, and acquires a reflection signal with respect to the detection signal.
- the detection device 110 is configured to calculate the distance between the detection device 110 and the detection target based on the time from transmission of the detection signal to acquisition of the reflection signal.
- the processing in which the detection device 110 transmits a detection signal and acquires a reflection signal is hereinafter referred to as “scanning”.
- the detection device 110 detects the line shape of the convex portion formed by the lump-cut grass G by scanning. Then, based on the distance detected by the scan and the scan angle of the detection device 110, the ground height of the convex portion is calculated by the decoding unit 114. Thereby, it is comprised so that the ground after mowing and lump cutting grass G can be distinguished.
- the target line calculation unit 112 recognizes the lump cut grass G detected by the scanning of the detection device 110, and calculates a target line LB. That is, the target line calculation unit 112 calculates the target line LB based on the line shape of the lump cut grass G with the lump cut grass G as a target object. In addition, when lump cutting grass G is arrange
- the present embodiment first, mowing travel is performed in the manual traveling mode in the mowing target area, and the ground after mowing is secured. Next, teaching traveling is performed while mowing traveling, and lump cutting grass G (1) is arranged linearly or in a dotted manner on the ground after cutting. As a result, lump cut grass G (1) is arranged in a line on the ground after cutting, and each lump cut grass G (1) is used as a target for setting the target line LB (1) by the target line calculation unit 112. Become.
- the lump-cut grass G (1) is arranged in a dot shape, and a line of line shape is intermittently formed, but the block-cut grass G (1) is arranged in a line, and the line shape of the line is It may be formed continuously.
- the discharge mechanism 104 is provided on the side of the traveling airframe 101 on which the ground is located after harvesting. For this reason, even after the teaching travel is completed, the discharge mechanism 104 has to carry out mowing travel so that the lump-cut grass G can always be discharged from the side where the ground is located after the cutting. From this, it is necessary to carry out mowing travel in which the traveling vehicle body 101 is not turned so that the discharge mechanism 104 does not go to the side where the uncut area GNB is positioned. That is, mowing travel is performed while repeating the switchback of the traveling airframe 101, that is, forward and backward movement of the traveling airframe 101.
- the end point of the massive cut grass G (1) disposed on the ground after cutting by teaching travel is the start point of the target line LB calculated by the target line calculation unit 112 It becomes. Further, among the massive cut grass G (1), the start end of the massive cut grass G (1) disposed on the ground after cutting by teaching traveling is the end point of the target line LB calculated by the target line calculation unit 112.
- the detection device 110 periodically continues scanning and captures the lump cut grass G (1) discharged during teaching travel, and calculates the target line
- the unit 112 continues the calculation of the target line LB (1) based on the approximate line of the massive cut grass G (1) captured by the detection device 110. That is, the target line calculation unit 112 continues updating the target line LB (1) by continuing the calculation of the target line LB (1).
- the target line calculation unit 112 may be configured to calculate the target line LB (1) based on the moving average of the approximation lines periodically calculated in the past.
- the automatic travel control device 113 calculates the distance between the target line LB (1) and the traveling vehicle body 101 based on the scanning of the detection device 110. Then, the automatic travel control device 113 controls the travel control motor 115, the forward / reverse motor 116, and the first steering so that the traveling vehicle body 101 holds the distance Pd set in advance with respect to the target line LB (1). Control signals are output to the motor 109A and the second steering motor 109B.
- the traveling machine body 101 is located on the opposite side to the side where the lump-cut grass G (1) is located, adjacent to the traveling locus of the mowing travel during teaching traveling.
- the distance Pd is set such that the center of the working width in the mowing apparatus 103 and the target line LB (1) are about 1.5 times the working width of mowing travel.
- the work width of mowing travel along the target line LB (1) and the operation width of mowing travel at the time of teaching traveling partially overlap so that there is no leftover by mowing traveling before and after the completion of teaching traveling. You may. That is, the distance Pd can be changed as appropriate.
- new lump-cut grass G (2) is discharged from the outlet 104a, and new lump-cut grass G (2) is continuously or intermittently applied to the ground after cutting.
- the target line calculation unit 112 becomes a new target for calculating the next target line LB (2).
- the new lump-cut grass G (2) is displaced from the lump-cut grass G (1) discharged during teaching, on the side where the traveling machine body 101 is positioned.
- a new line of line shape is formed on the ground after cutting due to the convex portion of.
- the target line calculation unit 112 executes the next operation based on the approximate line of the massive mowing grass G (2).
- the target line LB (2) is continuously calculated.
- the automatic travel mode may be continued or switched to the manual travel mode.
- the forward movement direction of the traveling vehicle body 101 is reversed by the switching operation of the forward / reverse switching mechanism 122, and the automatic traveling control device 113 performs automatic traveling along the next target line LB (2).
- the detection device 110 periodically continues scanning and captures the lump-cut grass G (2) discharged during the teaching travel, and the target line calculation unit 112 detects the lump-cut grass G (2) captured by the detection device 110.
- the calculation of the target line LB (2) is continued based on the approximate line. That is, the target line calculation unit 112 continues updating the target line LB (2) by continuing the calculation of the target line LB (2) as in the case of the automatic travel along the target line LB (1).
- the automatic travel control device 113 calculates the distance between the target line LB (2) and the traveling vehicle body 101 based on the scanning of the detection device 110. Then, the automatic travel control device 113 controls the travel control motor 115, the forward / reverse motor 116, and the first steering so that the traveling vehicle body 101 holds the distance Pd set in advance with respect to the target line LB (2). Control signals are output to the motor 109A and the second steering motor 109B.
- new lump-cut grass G (3) is discharged from the outlet 104a, and new lump-cut grass G (3) is continuously or intermittently applied to the ground after cutting. Be placed. That is, new lump cut grass G (3) is discharged in a state adjacent to lump cut grass G (2), and a new line of line shape is formed on the ground after cutting.
- the lump cut grass G (3) becomes a new target for the target line calculation unit 112 to calculate the next target line LB (3).
- the automatic traveling mowing machine is configured to calculate the target line LB as a route of the automatic traveling based on the lump-cut grass G arranged in a linear shape.
- the transmitter 107 can display the target line LB and the positional deviation of the traveling vehicle body 101 on the display screen through the communication unit 117. It may be configured.
- the target line calculation unit 112 is configured to calculate the target line LB based on the lump-cut grass G discharged in a line in a row on the ground after cutting. It is not limited to the embodiment described above. For example, as shown in FIG. 19, there may be a case where the lump-cut grass G (1) does not necessarily line up in a row because any lump-cut grass G (1) is displaced or broken by wind or the like. . Even in this case, the target line calculation unit 112 may be configured to calculate the target line LB (1) based on the approximate straight line of each of the lump-cut grass G (1).
- the target line calculation unit 112 calculates a target line based on the moving average of the approximation straight lines periodically calculated in the past. It may be configured to calculate LB.
- the discharge mode of the lump cut grass G by the discharge mechanism 104 can be changed as appropriate.
- lump-cut grass G is discharged so as to be arranged in a grid, and the target line calculation unit 112 calculates the target line LBH in the horizontal direction and the target line LBV in the vertical direction. , May be calculated.
- the automatic travel control device 113 can automatically travel the traveling vehicle body 101 along either of the two target lines LBH and LBV.
- the detection device 110 is provided on the upper portion of the traveling machine body 101.
- the detection device 110 may be provided on the side of the traveling machine body 101.
- the detection device 110 is provided on the side of the traveling airframe 101 where the discharge mechanism 104 is located, that is, the side where the ground after clipping is located. It may be a configuration. With this configuration, even if the grass is present immediately below the detection device 110, the detection device 110 can detect the grass. Therefore, the detection device 110 can capture the lump-cut grass G immediately after being discharged from the discharge mechanism 104.
- the target line calculation unit 112 is configured to calculate the linear target line LB based on the lump-cut grass G discharged linearly in a line, but the embodiment described above It is not limited to.
- the traveling machine body 101 travels in an arc shape
- the lump-cut grass G (1) to G (3) is discharged in an arc shape, and is captured by the detection device 110
- Each lump cutting grass G becomes an arc shape
- the target line calculation unit 112 is configured to calculate curved target lines LB (1) to LB (3) based on the approximate curve of each lump cutting grass G. It is good.
- the target line calculation unit 112 is configured to use the lump-cut grass G discharged from the discharge mechanism 104 in teaching traveling for calculating the first target line LB, but It is not limited to the embodiment.
- the target line calculation unit 112 may be configured to use a target provided in advance on the ground or the like for calculation of the first target line LB, instead of the lump-cut grass G.
- the target object for example, it is a rope, a block fence, an earth retaining or retaining wall, a fence or a guardrail, a road cone arranged in a row, or between the road cones. It may be a corn bar that spans
- trees and the like planted at equal intervals are also illustrated as the target.
- the detection device 110 periodically continues scanning to capture a row of lump-cut grass G discharged during teaching travel, and the target line calculation unit 112 is captured by the detection device 110.
- the target line calculation unit 112 may be configured to calculate the target line LB only once based on the approximate line of the row of lumps of cut grass G.
- travel control may be performed based on, for example, an inertial sensor (not shown) so that the traveling vehicle body 101 travels along an azimuth ranging from the start end to the end of the target line LB.
- the opening and closing mechanism 141 is provided in the discharging mechanism 104, but the opening and closing mechanism 141 is not necessarily required, and the opening and closing mechanism 141 may not be provided in the discharging mechanism 104.
- the detection device 110 in the embodiment described above may not be LRF, and may be, for example, an image sensor such as a camera.
- the automatic traveling mowing machine is described as traveling automatically while mowing the grass, but it is also possible to use the automatic traveling mowing machine as another working vehicle such as a drug sprayer.
- FIG. 23 the mowing machine exemplified in the present embodiment is provided with a traveling body 201, a first wheel 202A, a second wheel 202B, and a mowing device 203.
- the first wheels 202 ⁇ / b> A are provided on the one end side in the longitudinal direction of the traveling body 201 as a left-right pair.
- the second wheels 202 ⁇ / b> B are provided on the other end side in the longitudinal direction of the traveling body 201 as a pair of left and right.
- the mowing device 203 is provided between the first wheel 202A and the second wheel 202B at the lower part of the traveling body 201.
- An antenna 208 capable of communicating with the transmitter 207 is erected above the traveling body 201.
- the transmitter 207 is configured such that the operator can manually operate the mowing machine while carrying it.
- the transmitter 207 may be, for example, an operation by a proportional type controller operated by an operator at hand, or an operation by a portable terminal device having a touch panel type display screen.
- the traveling body 201 is provided with a transmission mechanism that transmits the power of the engine EC to the first wheel 202A and the second wheel 202B and also transmits the power to the mowing device 203.
- the transmission mechanism is configured to be able to interrupt power transmission to the first wheel 202A, the second wheel 202B, and the mowing apparatus 203.
- the power of the engine EC is transmitted to the first wheel 202A, the second wheel 202B, and the mowing apparatus 203, so that mowing work can be performed while the vehicle is traveling.
- a first steering motor 209A is provided on the first wheel 202A, and the first wheel 202A is configured to swing around a longitudinal axis center by the driving force of the first steering motor 209A so that steering operation is possible.
- the second steering motor 209B is provided on the second wheel 202B, and the second wheel 202B is configured to swing around the longitudinal axis center by the driving force of the second steering motor 209B so that steering operation is possible.
- the first wheel 202A and the second wheel 202B can be changed in direction to a straight advance posture, a rightward swing posture, and a left swing posture, respectively.
- a distance sensor 210 is provided on the front upper or rear upper portion of the traveling vehicle body 201.
- the distance sensor 210 is, for example, an LRF (Laser Range Finder), and transmits, for example, an air-propagating signal such as a laser beam or an ultrasonic wave as a detection signal.
- LRF Laser Range Finder
- the detection signal is irradiated to the detection target, the detection signal is reflected on the surface of the detection target.
- the distance sensor 210 acquires a detection signal reflected on the surface of the detection target as a reflection signal. That is, the distance sensor 210 transmits a detection signal toward the detection range of the distance sensor 210, and acquires a reflection signal with respect to the detection signal.
- the distance sensor 210 is configured to calculate the distance between the distance sensor 210 and the detection target based on the time from the transmission of the detection signal to the acquisition of the reflection signal.
- the processing in which the distance sensor 210 transmits a detection signal and acquires a reflection signal is hereinafter referred to as “scanning”.
- the inclination angle detection unit 211 is provided in the traveling body 201, and the inclination angle detection unit 211 is, for example, an IMU (Inertial Measurement Unit) which is an example of an inertial sensor, detects the inclination of the traveling body 201, and detects a detected inclination angle ImC.
- IMU Inertial Measurement Unit
- a control unit UC for enabling automatic travel of the mower is provided in the mower, for example, in a state of being incorporated in a microcomputer.
- the control unit UC includes a decode control unit 212, a traveling mode determination unit 213, an object detection unit 214, a target distance calculation unit 215, and a traveling instruction unit 216.
- the decoding control unit 212 determines the horizontal distance between the distance sensor 210 in the lateral direction of the machine and the distance sensor 210 in the vertical direction based on the distance calculated by scanning of the distance sensor 210 and the scanning angle at the time of calculation. The vertical distance is calculated as coordinate position information.
- the control unit UC is configured to be able to switch between an automatic travel mode and a manual travel mode, and the determination of the travel mode determination unit 213 determines which of the automatic travel mode and the manual travel mode.
- a ground reference line LG representing the ground after cutting with an approximate straight line based on coordinate position information
- a grass reference line LK representing the grass line before cutting with an approximate straight line
- the object detection unit 214 is provided with a storage unit 214a, and the storage unit 214a is, for example, a random access memory (RAM), and temporally stores coordinate position information calculated by the decode control unit 212.
- Generation of the ground reference line LG and the grass reference line LK is performed by using coordinate position information stored in the storage unit 214a.
- the target distance calculation unit 215 calculates the distance between the grass reference line LK and the distance sensor 210. In addition, the target distance calculation unit 215 calculates a target distance LM for appropriately mowing traveling while the portion where the distance sensor 210 is positioned in the traveling machine body 201 is separated from the grass reference line LK. Then, the travel instruction unit 216 outputs a control signal so as to hold the separation distance between the grass reference line LK and the distance sensor 210 at the target distance LM.
- the traveling unit 201 is provided with a communication unit 217 capable of receiving an operation signal wirelessly transmitted from the transmitter 207 via the antenna 208. Information received by the communication unit 217 is input to the control unit UC. In the manual travel mode, mowing travel or the like is performed based on an artificial operation of the transmitter 207. For this reason, although the travel instruction unit 216 is invalidated in the manual travel mode, the object detection unit 214 and the target distance calculation unit 215 may be invalidated in conjunction with the travel instruction unit 216. .
- the output target of the traveling instruction unit 216 is the traveling control unit C, and the traveling control unit C includes the traveling control motor 218, the back and forth motor 219, the first steering motor 209A, and the second steering motor 209B. It is equipped.
- the travel control motor 218 operates an accelerator 220 that adjusts the amount of fuel supplied to the engine EC, and a brake 221 that brakes the first wheel 202A and the second wheel 202B.
- the forward / reverse motor 219 switches the forward / reverse switching mechanism 222.
- the forward / reverse switching mechanism 222 is provided in a transmission that transmits the power of the engine EC to the first wheel 202A and the second wheel 202B, and switches the power of the engine EC between forward and reverse directions. Gear mechanism.
- the first steering motor 209A steers the first wheel 202A
- the second steering motor 209B steers the second wheel 202B.
- Each of the traveling control motor 218 and the forward and reverse motor 219 may be an electric motor or an electromagnetic switch.
- the traveling control unit C When the traveling mode is the automatic traveling mode, the traveling control unit C performs control based on an instruction signal of the traveling instruction unit 216.
- the traveling mode is the manual traveling mode, an operation signal based on an artificial operation of the transmitter 207 is input to the traveling control unit C via the communication unit 217 and the traveling mode determination unit 213, and the traveling control unit C receives the operation signal. Control based on
- the state of the mowing machine can be transmitted from the communication unit 217 to a device outside the machine, and it is also possible to display, for example, the current position or state of the mowing machine on the display screen of the portable terminal device.
- the state of the mowing machine may be, for example, the vehicle speed of mowing travel, the remaining amount of fuel, or may indicate a malfunction of various devices mounted on the mowing machine.
- the distance sensor 210 scans while rotating around the longitudinal axis of the traveling machine body 201, and scans the ground and uncut grass ( The separation distance to the distance sensor 210 of the region indicated by GNC in FIG. 27 is acquired.
- the scan by the distance sensor 210 is performed in the scan angle range of 270 degrees over the scan angle Ss and the scan angle Sf by the counterclockwise rotation shown in FIG.
- the scan angle Sf is inclined 45 degrees to the left and right with respect to the upper side of the airframe, respectively.
- the inclination angles of the scanning angle Ss and the scanning angle Sf can be changed as appropriate, and may not be the same inclination angle.
- the decoding control unit 212 converts the scanning angle and distance information into a horizontal distance to the distance sensor 210 in the lateral direction of the machine and a vertical distance to the distance sensor 210 in the vertical direction of the machine by a method using, for example, a trigonometric function. Do. Thereby, the distance information acquired by the temporal scanning of the distance sensor 210 is sequentially converted into two-dimensional coordinate position information, and the set of the coordinate position information is stored in the storage unit 214a provided in the object detection unit 214. Be done.
- a set of two-dimensional coordinate position information is represented as a waveform as shown in FIG. 28, and this waveform is a digital waveform that is plotted based on the set of coordinate position information.
- the center of the coordinates is the rotation axis center of the scanning angle of the distance sensor 210.
- a waveform along the horizontal direction below the coordinates is a ground line G1 indicating the ground after cutting, and a waveform along the vertical direction on the right of the coordinates is an uncut grass line G2 indicating uncut grass. Thereby, the ground height data to ground line G1 of uncut grass line G2 is obtained.
- uncut grass line G2 is located in the state which left
- the distance sensor 210 is positioned at the front end of the traveling vehicle body 201, it is conceivable that the uncut grass line G2 is positioned in an overlapping manner with the vehicle because uncut grass exists in front of the vehicle.
- the distance sensor 210 is located at the rear end of the traveling vehicle body 201, it is conceivable that the uncut grass line G2 is located in contact with the lateral side of the vehicle.
- the scan by the distance sensor 210 is started from the scan angle Ss (step # 1).
- the scanning is continued while the scanning angle of the distance sensor 210 is rotated (step # 2), and the distance information acquired by the scanning is linked with the scanning angle at the time the scanning is performed. It is sequentially converted into coordinate position information of a dimension (step # 3).
- the process of step # 2 and the process of step # 3 continue until the scan angle of the distance sensor 210 reaches the scan angle Sf.
- ground reference line LG is generated as an approximate straight line based on coordinate information corresponding between the scanning angle Sg1 of the distance sensor 210 and the scanning angle Sg2 of the distance sensor 210. Coordinate position information within a range of distances d1 and d2 in the vertical direction from the ground reference line LG is determined as coordinate position information (ground data) of the ground.
- the scan angle Sg1 and the scan angle Sg2 are symmetrical in the left-right direction with respect to the scan angle Sb in which the distance sensor 210 is directed to the traveling aircraft body 201 downward in the vertical direction.
- the scan angle Sg1 and the scan angle Sg2 are configured to be inclined by 10 degrees to the left and right with respect to the scan angle Sb, but this tilt angle can be changed appropriately. It may be a tilt angle across the width. Further, the scanning angle Sg1 and the scanning angle Sg2 may not be symmetrical with respect to the scanning angle Sb.
- the distances d1 and d2 in the vertical direction from the ground reference line LG are set, for example, to 10 centimeters, respectively, but this value can be changed as appropriate. Further, the distances d1 and d2 may not be the same value.
- the object detection unit 214 calculates the calculated inclination angle ⁇ 2 of the uncut grass relative to the ground after cutting (step # 6).
- the inclination angle ⁇ 1 of the ground after cutting is calculated based on the detected inclination angle ImC output by the inclination angle detection unit 211.
- the inclination angle ⁇ 1 may be an instantaneous measurement value of the detection inclination angle ImC, or may be an average value of a plurality of past detected inclination angles ImC periodically output. As shown in FIG. 31, it is generally known that uncut grass grows upward along the vertical direction even on slopes, and the calculated inclination angle ⁇ 2 of uncut grass with respect to the ground after cutting is , It is calculated by the following equation.
- the scan of the distance sensor 210 continues, and the object detection unit 214 determines whether the coordinate position information based on the scan of the distance sensor 210 is grass coordinate position information (grass data) (step # 7).
- the coordinate position information based on the scan of the distance sensor 210 is grass coordinate position information (grass data) (step # 7).
- coordinate position information within the range of the distances d1 and d2 in the vertical direction from the ground reference line LG is determined as ground data. Therefore, the object detection unit 214 determines coordinate position information deviated from the ranges of the distances d1 and d2 as grass data.
- step # 8 it is determined by the object detection unit 214 whether or not grass data is continuously detected over a preset number of pieces. If the grass data is continuously detected over the preset number (Step # 8: Yes), the object detection unit 214 generates a grass candidate line Lc based on the grass data (Step # 9). ). The continuously detected number for determining whether or not to generate the grass candidate line Lc can be appropriately changed according to the weather, the season, and the type of uncut grass. The object detection unit 214 generates a plurality of grass candidate lines Lc until the scanning angle of the distance sensor 210 reaches the scanning angle Sf. In FIG.
- the candidate grass line Lc is from the candidate grass line Lc (1) closest to the side on which the ground reference line LG is located to the candidate grass line Lc (4) farthest from the side on which the ground reference line LG is located, A state in which four grass candidate lines Lc are generated is shown.
- the number of object detection units 214 that generate the grass candidate line Lc can be changed as appropriate.
- step # 10 When the scan angle of the distance sensor 210 reaches the scan angle Sg2 (step # 10: Yes), the scan of the distance sensor 210 is completed. Thereafter, the object detection unit 214 repeats the process of step # 10 and the process of step # 11. That is, the inclination angle (hereinafter referred to as “relative angle ⁇ ”) of each of the grass candidate lines Lc with respect to the ground reference line LG is calculated (step # 11). Then, the object detection unit 214 compares the relative angle ⁇ with the calculated inclination angle ⁇ 2 (step # 12).
- the object detection unit 214 determines the corresponding grass candidate line Lc as the grass reference line LK (step S12). Step # 13).
- a grass reference line LK based on the grass candidate line Lc (2) is shown.
- the object detection unit 214 determines that the relative angle ⁇ of the grass candidate line Lc (2) with respect to the ground reference line LG falls within the range set in advance from the calculated inclination angle ⁇ 2, and the grass candidate line Lc is determined by the grass reference line LK.
- the object detection unit 214 selects one of the plurality of grass candidate lines Lc, the grass candidate line Lc which is first determined that the relative angle ⁇ falls within the range set in advance from the calculated inclination angle ⁇ 2. It may be configured to be determined by the grass reference line LK. Further, the object detection unit 214 calculates the relative angle ⁇ of all the grass candidate lines Lc to the ground reference line LG, and the grass candidate line Lc having the relative angle ⁇ most approximate to the calculated inclination angle ⁇ 2 is the grass reference line LK. It may be configured to be determined.
- the target distance calculation unit 215 calculates an intersection point S between the ground reference line LG and the grass reference line LK. Then, the separation distance between the intersection point S and the distance sensor 210 is calculated, and among the separation distances between the intersection point S and the traveling body 201, a target distance LM suitable for mowing travel of the traveling body 201 is calculated (step # 14).
- the target distance LM suitable for mowing the traveling body 201 can be determined based on the inclination angle of the ground, the type and height of uncut grass, the mounting position of the distance sensor 210 on the traveling body 201, the forward direction of the traveling body 201, etc. .
- the target distance LM may be configured to calculate the target distance LM based on a moving average of a plurality of target distances periodically calculated in the past, in order to suppress variations at each time.
- the object detection unit 214 is configured to generate a plurality of grass candidate lines Lc until the scanning angle of the distance sensor 210 reaches the scanning angle Sf, but the embodiment described above It is not limited to.
- the object detection unit 214 is configured not to generate the grass candidate line Lc based on the grass data. Also good. Since the upper end portion of the uncut grass is easily shaken by wind or the like, this configuration can prevent erroneous detection of grass due to disturbance such as wind.
- the object detection unit 214 is configured to generate the grass candidate line Lc based on grass data, but is not limited to the embodiment described above.
- the object detection unit 214 when the grass data is continuously detected over a preset number of objects, the object detection unit 214 generates the grass reference line LK for the grass data.
- a plurality of candidate data Kc may be stored. That is, the candidate data Kc is a set of two-dimensional coordinate position information, and a plurality of candidate data Kc of the grass reference line LK are stored until the scanning angle of the distance sensor 210 reaches the scanning angle Sf.
- availability of storage of candidate data Kc can be suitably changed according to the weather, the season, and the kind of uncut grass.
- the grass candidate line Lc which is an approximate straight line may be generated based on a combination of a plurality of candidate data Kc.
- candidate data Kc (1) to Kc (6) are stored.
- the grass candidate line Lc (1) is generated based on the combination of the candidate data Kc (1) and the candidate data Kc (2).
- the grass candidate line Lc (2) is generated based on the combination of the candidate data Kc (2) and the candidate data Kc (3).
- the grass candidate lines Lc (3) to Lc (5) are also generated in the same pattern as the grass candidate line Lc (1) and the grass candidate line Lc (2).
- the relative angle ⁇ with respect to the ground reference line LG is calculated in each of the candidate grass lines Lc, and if the relative angle ⁇ is within the range preset from the calculated inclination angle ⁇ 2, the relevant grass candidate line Lc is used as the grass reference line LK.
- the combination of candidate data Kc can be appropriately changed in generation of the grass candidate line Lc. For example, if the relative angle ⁇ is not within the range preset from the calculated inclination angle ⁇ 2, the combination of a plurality of candidate data Kc is redone The grass candidate line Lc may be generated based on the new combination.
- the distance sensor 210 is provided on the front upper or rear upper portion of the traveling body 201, but is not limited to the above-described embodiment.
- the distance sensor 210 is provided at two places of a distance sensor 210a provided on the front upper part of the traveling machine body 201 and a distance sensor 210b provided on the rear upper part of the traveling vehicle body 201. May be configured.
- GNC in FIG. 35 is uncut grass.
- the distance sensor 210 a and the distance sensor 210 b may be provided at the lateral end of the traveling body 201. The ground before the mowing travel and the uncut grass GNC are scanned by the distance sensor 210 a provided at the front of the traveling airframe 201.
- the ground after the mowing travel and the uncut grass GNC are scanned by the distance sensor 210 b provided at the rear of the traveling body 201.
- different target distances LM can be independently calculated before and after the traveling vehicle body 201, so the instruction signal output by the traveling instruction unit 216 can be made more suitable.
- measures such as stopping the rotation of the mowing apparatus 203 can be taken.
- the target distance LM is calculated by the procedure from step # 1 to step # 14 shown in FIG. 29, but it is not limited to the embodiment described above.
- a scan ranging from 270 degrees from scan angle Ss to scan angle Sf is performed (steps # 1 to # 3)
- generation of ground reference line LG step # 5
- calculation of calculated inclination angle ⁇ 2 steps
- step # 6 is performed
- generation of the grass candidate line Lc based on the detection of grass data (steps # 7 to # 9) and calculation of the relative angle ⁇ (step # 11) are used to calculate the target distance LM.
- the configuration may be such that the processing up to (step # 14) is performed. This configuration is also applicable to, for example, the case where the scan angle rotates in the reverse direction from the scan angle Sf toward the scan angle Ss.
- the ground reference line LG, the grass candidate line Lc, and the grass reference line LK are respectively approximate straight lines, but the present invention is not limited to the embodiment described above.
- the ground reference line LG, the grass candidate line Lc, and the grass reference line LK may be approximate curves.
- the mowing machine travels automatically while mowing, but it may be, for example, a mowing machine that assists steering operation of mowing travel by manual operation. Besides the mower, it may be a mower or mower.
- the automatic traveling system for mowing machines according to the present embodiment is provided with an object detection unit 301, a mounting jig 302, and a mowing machine 303.
- the object detection unit 301 is installed at the upper end of the slope and configured to detect the position of the mowing machine 303 traveling on the slope.
- the object detection unit 301 is attached to the attachment jig 302 and used.
- the object detection unit 301 is provided with a distance sensor 311, a rotation control mechanism 312, and an attachment portion 313. Inside the object detection unit 301, for example, a control unit is provided in a state of being incorporated in a microcomputer.
- the distance sensor 311 is provided above the object detection unit 301.
- the rotation control mechanism 312 is rotatable with multiple degrees of freedom, and is provided below the object detection unit 301.
- the attachment portion 313 is provided at the lower end of the rotation control mechanism 312 and is an attachment portion for attaching the object detection unit 301 to the attachment jig 302.
- the mounting jig 302 is installed, for example, in a state of being fixed to the uppermost end of the slope.
- the mounting portion 313 of the object detection unit 301 is detachably engaged with the upper end portion of the mounting jig 302 so that the object detection unit 301 is mounted on the mounting jig 302 and fixed at a fixed position.
- the attachment / detachment structure and attachment or detachment method of the attaching part 313 can select a well-known structure and method suitably.
- a storage unit 321 such as an RFID (Radio Frequency Identifier) tag is provided in the mounting jig 302, and area information for the mowing machine 303 to mowing by communication with a control unit provided in the object detection unit 301. Work history information and the like of the mower 303 are stored in the storage unit 321.
- RFID Radio Frequency Identifier
- the object detection unit 301 accesses the storage unit 321 of the mounting jig 302, and confirms whether the storage unit 321 has area information or work history information. If the storage unit 321 has area information and work history information, the area information and the work history information are read into, for example, a random access memory (RAM) (not shown) provided in the object detection unit 301. Further, when the area information and the work history information at the time of the automatic mowing travel are updated, the updated information is stored in the storage unit 321 from the RAM of the object detection unit 301. Thereby, even when the object detection unit 301 is not the same at the next automatic mowing travel, the latest area information and work history information can be read out to the different object detection unit 301.
- RAM random access memory
- the mower 303 travels while automatically cutting uncut grass GN along a line travel route LD as a travel route preset on the slope based on the instruction signal Tc transmitted from the object detection unit 301. It is configured to
- the mowing machine 303 is provided with a traveling body 331, a first wheel 332A, a second wheel 332B, a mowing device 333 and a reflecting portion 334.
- the first wheels 332 ⁇ / b> A are provided on the one end side in the longitudinal direction of the traveling body 331 in a left-right pair.
- the second wheels 332 ⁇ / b> B are provided on the other end side in the longitudinal direction of the traveling body 331 in a left-right pair.
- the mowing device 333 is provided between the first wheel 332A and the second wheel 332B in the lower part of the traveling body 331.
- an antenna 335 capable of communicating with the transmitter 304 (see FIG. 39) and the object detection unit 301 is provided upright.
- the traveling body 331 is provided with a transmission mechanism for transmitting the power of the engine ED to the first wheel 332A and the second wheel 332B and transmitting the power to the mowing apparatus 333.
- the transmission mechanism is configured to be able to interrupt power transmission to the first wheel 332A, the second wheel 332B, and the mowing device 333.
- the power of the engine ED is transmitted to the first wheel 332A, the second wheel 332B, and the mowing apparatus 333 so that mowing work can be performed while the vehicle is traveling.
- the first steering motor 32C is provided on the first wheel 332A, and the first wheel 332A is configured to swing around the longitudinal axis center by the driving force of the first steering motor 32C and to be steerable.
- the second steering motor 332D is provided on the second wheel 332B, and the second wheel 332B is configured to swing around the longitudinal axis center by the driving force of the second steering motor 332D so that steering operation is possible.
- the first wheel 332A and the second wheel 332B can be changed in direction to a straight advance posture, a rightward swing posture, and a left swing posture, respectively.
- the distance sensor 311 is, for example, a laser range finder (LRF) or a light detection and ranging (LIDAR), and transmits, for example, a signal propagating in the air such as a laser beam, an ultrasonic wave, or a radio wave as a detection signal TW.
- LRF laser range finder
- LIDAR light detection and ranging
- the distance sensor 311 is configured to calculate the distance between the distance sensor 311 and the object to be detected based on the time from the transmission of the detection signal TW to the acquisition of the reflection signal RW.
- the process in which the distance sensor 311 transmits the detection signal TW and acquires the reflection signal RW is hereinafter referred to as “scanning”.
- the distance sensor 311 is configured to be able to scan at a scan angle of, for example, 270 degrees in a range of a radius over several tens of meters in plan view. From this, when a plurality of mounting jigs 302 are installed, they are installed at intervals corresponding to the scanning range of the distance sensor 311.
- the reflection unit 334 is a detection target that reflects the detection signal TW emitted by the distance sensor 311.
- the reflection unit 334 is configured to reflect the reflection signal RW in the same direction as the direction in which the detection signal TW enters. That is, the reflection unit 334 is configured to reflect the reflection signal RW toward the distance sensor 311 regardless of which angle the detection signal TW of the distance sensor 311 is received. For this reason, the reflection part 334 is provided in the side surface by which the distance sensor 311 is located among the left and right side surfaces of the mowing machine 303, and the reflection part 334 and the distance sensor 311 always oppose. With this configuration, the reflecting unit 334 is configured to reflect the reflected signal RW to the distance sensor 311 with a stronger intensity than other objects.
- the distance sensor 311 is configured to detect the reflection unit 334 by detecting the reflection signal RW whose intensity is higher than a preset intensity threshold.
- the reflecting portion 334 may be provided not only on one side of the left and right lateral sides of the mowing machine 303 but also on both sides.
- a control unit of the object detection unit 301 is provided with a communication unit 315, a travel route setting unit 316, and a control instruction unit 317.
- the communication unit 315 is a communication device for accessing data to the storage unit 321 of the attachment jig 302 and exchanging data and signals with the mowing machine 303.
- the travel route setting unit 316 sets a line travel route LD as a travel route for the mowing machine 303 to automatically travel.
- the control instruction unit 317 outputs an instruction signal Tc so that the mowing machine 303 travels along the line traveling route LD, and the instruction signal Tc is transmitted to the mowing machine 303 via the communication unit 315.
- the communication unit 315 includes a long-distance communication unit 315a and a short-distance communication unit 315b.
- the long-distance communication unit 315a is, for example, a communication device capable of communicating in a range of about one hundred meters. Further, the long-distance communication unit 315a can transmit the instruction signal Tc described above to the mowing machine 303, and can receive from the mowing machine 303 the state of the machine, the progress of mowing, and the like.
- the short distance communication unit 315 b is a communication device that can communicate, for example, in a range of several tens of centimeters.
- the short distance communication unit 315b reads the data of the area information and the work history information from the storage unit 321, and transmits the area information and the work history to the storage unit 321. It is possible to write updated data etc. of information.
- a control unit of the mowing machine 303 is provided with a communication unit 336 and a traveling control unit 337.
- the communication unit 336 is a communication device for exchanging data and signals with the communication unit 315 of the object detection unit 301. Further, the communication unit 336 can exchange data and signals with the transmitter 304.
- the traveling control unit 337 performs the automatic mowing traveling of the mowing machine 303 based on the instruction signal Tc output by the control instruction unit 317 of the object detection unit 301.
- the traveling control unit 337 is configured to be switchable between an automatic traveling mode and a manual traveling mode, and in the automatic traveling mode, the automatic mowing traveling is performed.
- the traveling control unit 337 In the case of the manual traveling mode, the traveling control unit 337 outputs an instruction signal based on a manual operation of the transmitter 304 to the traveling control unit 337 via the communication unit 336, and the traveling control unit 337 performs control based on the instruction signal. I do.
- the mowing machine 303 is provided with the inclination sensor 338, and the inclination angle ID detected by the inclination sensor 338 is transmitted to the object detection unit 301 via the communication unit 336.
- the inclination sensor 338 is, for example, an IMU (Inertial Measurement Unit) which is an example of an inertial sensor, but may be a pendulum type or float type inclination angle detector, a gyro sensor, or an acceleration sensor. good.
- IMU Inertial Measurement Unit
- the transmitter 304 is configured such that the operator can operate the mowing machine 303 while carrying it.
- the transmitter 304 may be, for example, an operation by a proportional type controller operated by the operator at hand or an operation by a portable terminal device having a touch panel type display screen.
- the distance sensor 311 provided in the object detection unit 301 is provided with a signal output unit 311 a, a signal input unit 311 b, and a decoding unit 311 c.
- the signal output unit 311a outputs the detection signal TW, and the detection signal TW is reflected as the reflection signal RW by the reflection unit 334 of the mowing machine 303, and the reflection signal RW is received by the signal input unit 311b.
- Distance measurement data is obtained by scanning of the distance sensor 311, and the decoding unit 311c converts the distance measurement data into position information N indicating coordinates at which the mowing machine 303 is located, based on the distance measurement data and the scanning angle.
- the position information N may be two-dimensional coordinates or three-dimensional coordinates.
- the position information N converted by the decoding unit 311 c is output to the control instruction unit 317.
- the control instruction unit 317 outputs an instruction signal Tc so that the error between the line traveling route LD and the traveling locus based on the position
- a tilt correction control unit 318 is provided in the object detection unit 301.
- the inclination correction control unit 318 calculates the correction amount ⁇ based on the inclination angle ID of the mowing machine 303, and the rotation control mechanism 312 rotates based on the correction amount ⁇ , whereby the object detection unit 301 is obtained. Incline.
- the distance sensor 311 is also inclined in an interlocking manner, and the mowing machine 303 traveling on the slope can be suitably followed.
- the line travel route LD for the mowing machine 303 to perform the automatic mowing travel is set in advance by the travel route setting unit 316.
- a plurality of linear line traveling routes LD are set as traveling routes for performing automatic traveling on a slope.
- the mounting jig 302 is fixed to the upper end portion of the slope, and the object detection unit 301 is mounted to the mounting jig 302 in a detachable manner. In this state, the object detection unit 301 is configured to be able to scan from the upper end of the slope to the left and right.
- each line traveling route LD is generated by the traveling route setting unit 316 in the following procedure.
- teaching traveling is performed in the manual traveling mode along the upper end edge of the slope.
- the teaching travel is performed based on an artificial operation by the operation of the transmitter 304 by the operator.
- the operator performs the start point setting operation by the transmitter 304 in a state where the mowing machine 303 is positioned at the start point position TDs.
- the operator causes the mowing machine 303 to travel along the linear shape from the start position TDs to the end position TDf, and the operator performs the end point setting operation with the transmitter 304 in a state where the mowing machine 303 is positioned at the start position TDs.
- the teaching process is performed.
- the position information N of the mowing machine 303 during teaching travel is sequentially acquired by the object detection unit 301 by scanning of the distance sensor 311. At this time, the position information N may be stored in the RAM (not shown) of the object detection unit 301.
- the teaching travel locus TD of the mower 303 can be obtained from a set of position information N across the starting point position TDs of the teaching traveling and the end point position TDf of the teaching traveling. This configuration is particularly useful when the travel path of teaching travel is curvilinear.
- a plurality of line travel routes LD are generated at equal intervals toward the lower side of the slope as a travel route parallel to the teaching travel trajectory TD.
- line traveling routes LD (1) to LD (10) along the teaching traveling trajectory TD are generated at equal intervals on the lower side of the teaching traveling trajectory TD on the slope.
- the respective line travel routes LD are set in a state where the work widths slightly overlap so as not to cause uncut.
- the start point position LDs and the end point position LDf are assigned to the respective line travel routes LD (1) to LD (10), and the direction from the start point position LDs to the end point position LDf is the traveling direction of the mowing machine 303.
- the respective line travel routes LD (1) to LD (10) are configured.
- a route is established for the mowing machine 303 to travel the line traveling routes LD (1) to LD (10) in order, and in the present embodiment, mowing is performed while turning from the upper side to the lower side of the slope.
- a route in which the machine 303 repeats linear reciprocating travel is set.
- the line travel route LD is set such that the starting point positions LDs of) are adjacent to each other.
- the mowing machine 303 travels automatically while mowing along the line traveling route LD. For example, when the mower 303 reaches the end position LDf of one line travel route LD (1), the mower 303 moves to the start position LDs of the line travel route LD (2) to which the next route is assigned. . At this time, for example, it is preferable that the switchback traveling is performed such that the first wheel 332A and the second wheel 332B of the mowing machine 303 repeat forward rotation and reverse rotation. In the case of the switchback traveling, the direction of the mowing machine 303 does not change, and the reflecting unit 334 and the distance sensor 311 always face each other, so the object detection unit 301 can preferably follow the reflecting unit 334 of the mowing machine 303.
- the movement from the end point position LDf to the next start point position LDs may be performed by the automatic travel mode or may be performed by the manual travel mode.
- the switching from the manual traveling mode to the automatic traveling mode may be performed by human operation or may be performed automatically. .
- the mowing machine 303 When the mower 303 reaches the start position LDs of the line travel route LD (2) and the traveling direction of the mowing machine 303 is along the traveling direction of the line travel route LD (2), the mowing machine 303 2) Automatic mowing along the road. Furthermore, the mowing machine has the line traveling route LD (3), L (4), L (5), L (6), L (7), L (8), L (9), LD (10) in this order. 303 automatic mowing is performed.
- each of the line travel routes LD (1) to LD (10) is configured to be set in order from the upper side to the lower side of the slope, the cutting is always performed between the object detection unit 301 and the mower 303 It becomes the back ground, and the distance sensor 311 can preferably follow the reflection part 334 of the mower 303 without being disturbed by the uncut grass GN (see FIG. 36).
- the teaching travel locus TD and the respective line travel routes LD are stored in the storage unit 321 as work history information.
- the travel route setting unit 316 is configured to be able to reproduce the teaching travel trajectory TD and the respective line travel routes LD based on the work history information in the storage unit 321, and teaching at the next automatic mowing travel. Automatic mowing can be performed without traveling. Thereby, even if the object detection unit 301 used at the time of the next automatic mowing travel is not the same, the teaching travel path TD and the line travel path LD can be reproduced.
- control instruction unit 317 is configured to be able to predict in advance, for example, a change in the tilt angle of the mowing machine 303 from the past work history information stored in the storage unit 321.
- the control instruction unit 317 outputs a deceleration instruction at a point where the mowing machine 303 is greatly inclined in the past. As a result, automatic mowing can be performed more stably than past automatic mowing.
- the mowing machine 303 is configured to perform automatic mowing travel in order from the upper side to the lower side of the slope. Since the distance sensor 311 is configured to scan in a wide range from the upper end of the slope to the left and right, if the scanning range in the vertical direction is enlarged, it takes time for the detection of the reflecting portion 334 by the distance sensor 311 The output of the instruction signal Tc by 317 may impair the real time property. In order to avoid this problem, the scanning range in the vertical direction tends to be a narrow scanning angle of, for example, about 10 degrees.
- the distance sensor 311 may not be able to follow the reflecting portion 334 of the mowing machine 303. From this, as shown in FIG. 43, in the present embodiment, the distance sensor 311 is configured to be inclined according to the inclination angle of the slope. Thereby, the distance sensor 311 and the reflecting portion 334 preferably face each other.
- the distance sensor 311 is configured to be inclined by the inclination correction control unit 318. Note that the distance sensor 311 may be inclined when the object detection unit 301 is entirely inclined, or only the distance sensor 311 may be inclined among the object detection unit 301.
- the inclination of the distance sensor 311 by the inclination correction control unit 318 is performed in the following procedure.
- the inclination sensor 338 provided in the mowing machine 303 detects the inclination angle ID of the mowing machine 303 during teaching traveling with time, and the communication unit 336 of the mowing machine 303 and the object detection unit 301 It is transmitted to the inclination correction control unit 318 via the communication unit 315.
- the average value (or median value) of the tilt angles ID during teaching travel is used as the reference tilt angle of the slope, and the tilt correction control unit 318 calculates the correction amount ⁇ based on the tilt angle ID, and the rotation control mechanism 312
- the correction amount ⁇ is output to
- the rotation control mechanism 312 rotates on the basis of the correction amount ⁇ , and the distance sensor 311 inclines in parallel with the slope of the slope.
- the distance sensor 311 can scan over the entire range of the slope according to the slope of the slope.
- the inclination correction control unit 318 calculates the correction amount ⁇ in consideration of the inclination angle read from the storage unit 321. It may be When the object detection unit 301 includes an IMU, the tilt correction control unit 318 may be configured to calculate the correction amount ⁇ in consideration of the tilt angle detected by the IMU of the object detection unit 301. . The inclination correction control unit 318 is configured to calculate the correction amount ⁇ based on the inclination angle ID as necessary even after the start of the automatic mowing travel.
- the object detection unit 301 After the automatic mowing travel is started, the object detection unit 301 outputs an instruction signal Tc so that the mowing machine 303 performs the automatic mowing traveling along the line traveling route LD, and the distance sensor 311 scans the mowing machine 303.
- the reflector 334 is followed.
- the angle of the slope may not be uniform, and unevenness may exist on the slope. In this case, there is a possibility that the object detection unit 301 may lose sight of the mower 303 when the mower 303 is sharply inclined. is there. For this reason, even if the mower 303 is sharply inclined, the reflection part 334 is configured as follows in order to allow the object detection part 301 to follow the mower 303 firmly.
- the reflecting portion 334 is provided with a plurality of reflecting sheets 339, and horizontal rod-shaped reflecting sheets 339a, 339b, 339c, 339d, 339e are vertically arranged from the upper end side of the reflecting portion 334 in order. It is equipped in line.
- Each of the reflection sheets 339 is configured to reflect the reflection signal RW in the same direction as the direction in which the detection signal TW entered.
- the respective reflection sheets 339 are configured such that the lengths in the longitudinal direction of the respective reflection sheets 339 are different, with the longitudinal direction of the mowing machine 303 as the longitudinal direction.
- the length in the longitudinal direction of the reflective sheet 339 is configured to be longer as the reflective sheet 339 located on the lower side.
- the longitudinal length of the uppermost reflective sheet 339 a is the shortest in the reflective sheet 339
- the longitudinal length of the lowermost reflective sheet 339 e is the longest in the reflective sheet 339. .
- the distance sensor 311 acquires a plurality of reflection signals RW from the reflection sheet 339 by scanning while changing the scanning angle by ⁇ .
- An approximate value of the length in the longitudinal direction of the reflection sheet 339 can be calculated by a trigonometric function or the like based on the plurality of reflection signals RW and the scanning angle. Therefore, the difference in the length in the longitudinal direction of each of the reflection sheets 339a, 339b, 339c, 339d, and 339e can be calculated by the decoding unit 311c. That is, the inclination correction control unit 318 is configured to be able to identify the respective reflection sheets 339a, 339b, 339c, 339d, and 339e.
- the length of the reflective sheet 339a located on the uppermost side and the length of the reflective sheet 339e located on the lowermost side are most different. For this reason, the inclination correction control unit 318 can easily determine which one of the upper side and the lower side of the reflection unit 334 is following, and the possibility of an erroneous determination can be reduced.
- the inclination correction control unit 318 identifies which of the reflection sheets 339 a, 339 b, 339 c, 339 d, and 339 e the reflection sheet 339 is based on the length of the reflection sheet 339 calculated by the decoding unit 311 c. In the present embodiment, since the reflective sheet 339 c is positioned at the center in the vertical direction, the location where the reflective sheet 339 c is positioned is the target position in the vertical direction. When the reflective sheet 339a or the reflective sheet 339b is identified, it is determined by the tilt correction control unit 318 that the scanning range in the vertical direction of the distance sensor 311 is closer to the upper side of the mowing machine 303.
- the tilt correction control unit 318 outputs the correction amount ⁇ to the rotation control mechanism 312 so that the distance sensor 311 tilts further downward.
- the inclination correction control unit 318 determines that the scanning range in the vertical direction of the distance sensor 311 is closer to the lower side of the mowing machine 303.
- the tilt correction control unit 318 outputs the correction amount ⁇ to the rotation control mechanism 312 so that the distance sensor 311 tilts more upward.
- the inclination correction control unit 318 identifies the difference in the length in the longitudinal direction of each of the reflection sheets 339a, 339b, 339c, 339d, and 339e, so that the central position of scanning in the vertical direction becomes the reflection sheet 339c. Then, the correction amount ⁇ is calculated.
- the distance sensor 311 can always scan the vertical center of the reflecting portion 334, and the object detection unit 301 can preferably follow the mowing machine 303 even when the mowing machine 303 is sharply inclined.
- the inclination correction control unit 318 is configured to be able to predict in advance the fluctuation of the inclination angle of the mowing machine 303 and the like from the past work history information stored in the storage unit 321. For example, the inclination correction control unit 318 performs bias addition or bias subtraction on the correction amount ⁇ at a position where the reflection unit 334 largely shakes up and down in the past. As a result, the object detection unit 301 can follow the reflection unit 334 more suitably than the past automatic mowing travel.
- one reflecting portion 334 is provided on the side surface of the mowing machine 303, but two or more reflecting portions 334 may be provided on the side surface of the mowing machine 303 .
- the reflecting portions 334 may be provided on the front and rear ends of the side surface of the mowing machine 303, respectively.
- the reflecting portion 334 is provided on the side surface of the mowing machine 303.
- the reflecting portion 334 may be provided on the front surface or the rear surface of the reflecting portion 334.
- the reflecting portion 334 may be provided on the front and rear surfaces and both left and right side surfaces.
- the mowing machine 303 is configured to automatically mow the slope, but for example, the mowing machine 303 is configured to automatically mow the flat ground below the slope. It may be.
- the storage unit 321 is provided in the mounting jig 302, and in a state in which the object detection unit 301 is fixed to the mounting jig 302, the object detection unit 301 receives area information from the storage unit 321 and
- work history information can be read out, it is not limited to the embodiment described above.
- the storage unit 321 may be provided in a management computer (not shown), and the object detection unit 301 may be configured to be able to read area information and work history information via a WAN or the like. This configuration facilitates centralized management of area information.
- the storage unit 321 is not limited to the RFID tag, and may be a semiconductor storage device, a magnetic storage device, or an optical storage device.
- each reflection sheet 339 is longer as it is located on the lower side of the machine, but the present invention is not limited to the embodiment described above, for example, each reflection sheet 339 may have a configuration in which the length in the longitudinal direction is longer as it is located on the upper side of the airframe.
- each line travel route LD is set based on a linear teaching travel trajectory TD, but may be set based on a curvilinear teaching travel trajectory TD. For example, as shown in FIG. 46, even if curved line traveling routes LD parallel to the teaching traveling trajectory TD are set at equal intervals based on the curved teaching traveling trajectory TD. good.
- the reflecting portion 334 is provided with a plurality of horizontally long reflecting sheets 339, but the invention is not limited to the embodiment described above.
- the reflecting portion 334 may be formed in a conical shape in a state where it protrudes from the side surface of the mowing machine 303 on which the object detecting portion 301 is located.
- the conical reflectors 334 have different cross-sectional diameters in the vertical direction in the horizontal direction of the vehicle, and the cross-sectional diameters of the conical reflectors 334 increase in the lower side of the vehicle. From this, when the distance sensor 311 scans in the horizontal direction of the vehicle body, the cross-sectional diameter at the scanned portion of the conical reflecting portion 334 may be detected.
- the present invention is applicable to an automatic traveling work machine capable of traveling on sloped terrain such as a slope.
- the present invention is applicable to an automatic traveling mowing machine provided with a discharge mechanism that discharges cut grass after cutting and a detection device that detects cut grass.
- the present invention is applicable to a mowing machine that mowing the mowing target area.
- the present invention is applicable to an automatic traveling system of a mowing machine that automatically mows and travels in a traveling area preset on a slope.
- Second Embodiment 101 traveling vehicle body 103: mowing device 104: discharge mechanism 104a: discharge port 104b: discharge path 110: detection device 111: target line calculation unit 112: automatic travel control device 141: opening / closing mechanism 142: pressure sensor (pressure detection means) G: Mass cut grass LB: Target line
- Third Embodiment 201 traveling vehicle body 210: distance sensor 212: decoding control unit 213: traveling mode determination unit 214: object detection unit 215: target distance calculation unit 216: traveling instruction unit C: traveling control unit ImC: detection inclination angle LG: ground reference line Lc: Grass candidate line LK: Grass reference line LM: Target distance ⁇ : Relative angle (tilt angle) ⁇ 2: Calculated inclination angle
- Fourth Embodiment Reference numeral 301 object detection unit 302: mounting jig 303: mowing machine 315: communication unit 316: traveling route setting unit 317: control instruction unit 318: tilt correction control unit 321: storage unit 334: reflection unit 336: communication unit 338: tilt Sensor 339: Reflective sheet ID: Inclination angle LD: Line travel route (travel route) TD: Teaching travel locus TW: Detection signal RW: Reflection signal
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Life Sciences & Earth Sciences (AREA)
- General Physics & Mathematics (AREA)
- Physics & Mathematics (AREA)
- Environmental Sciences (AREA)
- Aviation & Aerospace Engineering (AREA)
- Automation & Control Theory (AREA)
- Computer Networks & Wireless Communication (AREA)
- Signal Processing (AREA)
- Mechanical Engineering (AREA)
- Soil Sciences (AREA)
- Guiding Agricultural Machines (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Harvester Elements (AREA)
Abstract
【課題】傾斜した法面であっても、航法衛星から測位信号を精度よく受信し、走行経路を逸脱せずに自動走行が可能な自動走行作業機を提供する。 【解決手段】走行機体1と、航法衛星から測位信号を受信する測位受信機4と、測位信号に基づいて、走行経路に沿って自動走行する自動走行制御装置と、走行機体1の傾きを検出して傾斜角情報を出力する傾斜検出部と、傾斜角情報に基づいて傾斜角度を決定する傾斜角度決定部と、測位受信機4を一以上の自由度で回転する回転制御機構5と、が備えられ、回転制御機構5は、傾斜角度に基づいて測位受信機4を水平に保持する。
Description
本発明は、走行機体と、航法衛星から測位信号を受信する測位受信機と、前記測位信号に基づいて、走行経路に沿って自動走行する自動走行制御装置と、が備えられた自動走行作業機に関する。
また、本発明は、草刈走行を行う走行機体と、刈取後の刈草を排出口から刈取後の地面に排出する排出機構と、が備えられた自動走行草刈機に関する。
また、本発明は、草刈走行を行う走行機体と、走行機体を制御する走行制御部と、距離センサと、が備えられた草刈機に関する。
また、本発明は、法面上に予め設定された走行エリア内を自動草刈走行する草刈機の自動走行システムに関する。
また、本発明は、草刈走行を行う走行機体と、刈取後の刈草を排出口から刈取後の地面に排出する排出機構と、が備えられた自動走行草刈機に関する。
また、本発明は、草刈走行を行う走行機体と、走行機体を制御する走行制御部と、距離センサと、が備えられた草刈機に関する。
また、本発明は、法面上に予め設定された走行エリア内を自動草刈走行する草刈機の自動走行システムに関する。
[背景技術1]
例えば、特許文献1に、走行機体(文献では「フレーム1-5」)と、草刈機の位置情報を得る測位受信機(文献では「GPS装置4」)と、位置情報に基づいて予め記憶された走行順路に倣って走行及び草刈り作業を行う自動走行制御装置(文献では「制御装置3」)と、が備えられた遠隔操作式草刈機が開示されている。
例えば、特許文献1に、走行機体(文献では「フレーム1-5」)と、草刈機の位置情報を得る測位受信機(文献では「GPS装置4」)と、位置情報に基づいて予め記憶された走行順路に倣って走行及び草刈り作業を行う自動走行制御装置(文献では「制御装置3」)と、が備えられた遠隔操作式草刈機が開示されている。
[背景技術2]
例えば特許文献2に、草刈走行を行う走行機体(文献では「車体3」)と、作業領域の範囲に存在する物体を検出する検出装置(文献では「物体検出部11」)と、検出装置により検出された物体に基づいて目標ラインを算出する目標ライン算出部(文献では「基準線設定部13」)と、目標ライン算出部に基づく目標ライン(文献では「基準線SL」)に沿って走行機体を自動走行させる自動走行制御装置(文献では「走行制御部16」)と、が備えられている自動草刈機が開示されている。特許文献2の自動草刈機では、果樹園内の二つ以上の果樹を目標物として目標ラインが算出される。
例えば特許文献2に、草刈走行を行う走行機体(文献では「車体3」)と、作業領域の範囲に存在する物体を検出する検出装置(文献では「物体検出部11」)と、検出装置により検出された物体に基づいて目標ラインを算出する目標ライン算出部(文献では「基準線設定部13」)と、目標ライン算出部に基づく目標ライン(文献では「基準線SL」)に沿って走行機体を自動走行させる自動走行制御装置(文献では「走行制御部16」)と、が備えられている自動草刈機が開示されている。特許文献2の自動草刈機では、果樹園内の二つ以上の果樹を目標物として目標ラインが算出される。
[背景技術3]
例えば特許文献2に、草刈走行を行う走行機体(文献では「車体3」)と、作業領域の範囲に存在する物体を検出する検出装置(文献では「物体検出部11」)と、検出装置により検出された物体に基づいて算出された基準線(文献では符号「SL」)から走行機体までの離間距離を演算する距離算出部(文献では「距離演算部14」)と、基準線から走行機体までの距離が予め設定された範囲内に収まるように走行制御する走行制御部(文献では符号「16」)と、が備えられている自動草刈機が開示されている。特許文献2の自動草刈機では、果樹園内の二つ以上の果樹を目標物として基準線が生成される。
例えば特許文献2に、草刈走行を行う走行機体(文献では「車体3」)と、作業領域の範囲に存在する物体を検出する検出装置(文献では「物体検出部11」)と、検出装置により検出された物体に基づいて算出された基準線(文献では符号「SL」)から走行機体までの離間距離を演算する距離算出部(文献では「距離演算部14」)と、基準線から走行機体までの距離が予め設定された範囲内に収まるように走行制御する走行制御部(文献では符号「16」)と、が備えられている自動草刈機が開示されている。特許文献2の自動草刈機では、果樹園内の二つ以上の果樹を目標物として基準線が生成される。
[背景技術4]
例えば特許文献3に、機体の進行方向前面に備えられた物体検出部(文献では「距離検出手段12」)と、走行用の各種パラメータ(目的地を含む)及び走行領域の地図を記憶する記憶部(文献では「記憶手段11」)と、記憶部に記憶された情報に基づいて走行するための経路を設定する走行経路設定部(文献では「経路生成手段14」)と、走行経路設定部の設定した経路に基づいて目的地まで走行する制御指示部(文献では「走行制御手段16」)と、が備えられた自律移動装置が開示されている。物体検出部は、壁や塀、フェンス、種々の設置物などの物体によって構成される境界線(文献では符号「3」)を検出し、走行経路設定部は、境界線に基づいて物体を回避するように経路を設定ことによって、制御指示部による制御が可能となる。
例えば特許文献3に、機体の進行方向前面に備えられた物体検出部(文献では「距離検出手段12」)と、走行用の各種パラメータ(目的地を含む)及び走行領域の地図を記憶する記憶部(文献では「記憶手段11」)と、記憶部に記憶された情報に基づいて走行するための経路を設定する走行経路設定部(文献では「経路生成手段14」)と、走行経路設定部の設定した経路に基づいて目的地まで走行する制御指示部(文献では「走行制御手段16」)と、が備えられた自律移動装置が開示されている。物体検出部は、壁や塀、フェンス、種々の設置物などの物体によって構成される境界線(文献では符号「3」)を検出し、走行経路設定部は、境界線に基づいて物体を回避するように経路を設定ことによって、制御指示部による制御が可能となる。
[課題1]
[背景技術1]に対する課題は、以下の通りである。
走行機体が傾斜法面を走行する場合、測位受信機が傾くことによって、測位受信機が補足可能な航法衛星の数が減少し、測位受信機の測位精度が低下する虞がある。また、傾斜法面の下手方向に川や水田が存在する場合、航法衛星から送信される測位信号が川や水田で乱反射することによって、測位受信機がマルチパスの影響を受けやすくなって、測位精度が低下する虞がある。
[背景技術1]に対する課題は、以下の通りである。
走行機体が傾斜法面を走行する場合、測位受信機が傾くことによって、測位受信機が補足可能な航法衛星の数が減少し、測位受信機の測位精度が低下する虞がある。また、傾斜法面の下手方向に川や水田が存在する場合、航法衛星から送信される測位信号が川や水田で乱反射することによって、測位受信機がマルチパスの影響を受けやすくなって、測位精度が低下する虞がある。
上述した実情に鑑みて、本発明の目的は、傾斜した法面であっても、航法衛星から測位信号を精度よく受信し、走行経路を逸脱せずに自動走行が可能な自動走行作業機を提供することにある。
本発明は、アシスト器具において、アーム部から下側に延出された索状体の延出端をハンド部に揺動自在に接続する場合、索状体の延出端がハンド部に揺動自在に適切に接続されるようにすることを目的としている。
[課題2]
[背景技術2]に対する課題は、以下の通りである。
特許文献2に記載の発明では、果樹の幹が地面から立ち上がるため、目標ライン算出部は、果樹を目標物として容易に目標ラインを算出できる。しかし、例えば法面等では地面から立ち上がる幹等が存在しない場合があり、目標物の設定ができずに目標ラインの算出ができない虞がある。
[背景技術2]に対する課題は、以下の通りである。
特許文献2に記載の発明では、果樹の幹が地面から立ち上がるため、目標ライン算出部は、果樹を目標物として容易に目標ラインを算出できる。しかし、例えば法面等では地面から立ち上がる幹等が存在しない場合があり、目標物の設定ができずに目標ラインの算出ができない虞がある。
上述した実情に鑑みて、本発明の目的は、草刈対象領域に目標物が無い場合であっても、目標ラインを算定し、目標ラインに基づく自動走行が可能な自動走行草刈機を提供することにある。
[課題3]
[背景技術3]に対する課題は、以下の通りである。
特許文献2に記載の発明では、果樹の幹が地面から立ち上がって果樹と地面とを容易に区別可能であるため、距離算出部は、果樹を目標物とする基準線と、走行機体と、の離間距離を演算できる。しかし、例えば法面等では地面から立ち上がる幹等が存在しない場合があり、目標物の設定ができずに基準線の生成ができない虞がある。
[背景技術3]に対する課題は、以下の通りである。
特許文献2に記載の発明では、果樹の幹が地面から立ち上がって果樹と地面とを容易に区別可能であるため、距離算出部は、果樹を目標物とする基準線と、走行機体と、の離間距離を演算できる。しかし、例えば法面等では地面から立ち上がる幹等が存在しない場合があり、目標物の設定ができずに基準線の生成ができない虞がある。
上述した実情に鑑みて、本発明の目的は、草刈対象領域に目標物が無い場合であっても、刈取前の草と刈取後の地面とを精度良く判別して自動走行が可能な草刈機を提供することにある。
[課題4]
[背景技術4]に対する課題は、以下の通りである。
例えば走行対象領域が、例えば圃場の法面等のように、物体検出部が検出可能な物体が存在しない場合がある。このような場合、例えば走行対象領域の周囲に囲枠や反射板等の物体を設置する必要があり、更に走行後にこれらの物体を撤去する場合も考えられ、物体の設置及び撤去に労力を要する。また、同一の法面であっても、法面上の傾斜角度が一様でなかったり、法面上に凹凸があったりする場合、機体の急激な傾き等によって物体検出部が物体を見失う虞がある。
[背景技術4]に対する課題は、以下の通りである。
例えば走行対象領域が、例えば圃場の法面等のように、物体検出部が検出可能な物体が存在しない場合がある。このような場合、例えば走行対象領域の周囲に囲枠や反射板等の物体を設置する必要があり、更に走行後にこれらの物体を撤去する場合も考えられ、物体の設置及び撤去に労力を要する。また、同一の法面であっても、法面上の傾斜角度が一様でなかったり、法面上に凹凸があったりする場合、機体の急激な傾き等によって物体検出部が物体を見失う虞がある。
上述の実情に鑑みて、本発明の目的は、同一法面において、法面上の傾斜角度が一様でなかったり、法面上に凹凸があったりする場合であっても、物体検出部が精度良く物体を追従可能な草刈機自動走行システムを提供することにある。
[課題1]に対応する解決手段は、以下の通りである。
本発明による自動走行作業機は、走行機体と、航法衛星から測位信号を受信する測位受信機と、前記測位信号に基づいて、走行経路に沿って自動走行する自動走行制御装置と、前記走行機体の傾きを検出して傾斜角情報を出力する傾斜検出部と、前記傾斜角情報に基づいて傾斜角度を決定する傾斜角度決定部と、前記測位受信機を一以上の自由度で回転する回転制御機構と、が備えられ、前記回転制御機構は、前記傾斜角度に基づいて前記測位受信機を水平に保持することを特徴とする。
本発明による自動走行作業機は、走行機体と、航法衛星から測位信号を受信する測位受信機と、前記測位信号に基づいて、走行経路に沿って自動走行する自動走行制御装置と、前記走行機体の傾きを検出して傾斜角情報を出力する傾斜検出部と、前記傾斜角情報に基づいて傾斜角度を決定する傾斜角度決定部と、前記測位受信機を一以上の自由度で回転する回転制御機構と、が備えられ、前記回転制御機構は、前記傾斜角度に基づいて前記測位受信機を水平に保持することを特徴とする。
本発明では、測位受信機を水平に保持する回転制御機構が備えられているため、走行機体が傾斜法面を走行する場合であっても、測位受信機が回転制御機構によって水平に保持されるため、測位受信機が傾くことが無い。これにより、測位受信機が十分な数の航法衛星を精度良く補足可能になると共に、マルチパスの影響を受け難くなる。その結果、傾斜した法面であっても、航法衛星から測位信号を精度よく受信し、走行経路を逸脱せずに自動走行が可能な自動走行作業機が実現される。
本構成において、前記回転制御機構は、前記測位受信機の真下に設けられていると好適である。
本構成であれば、回転制御機構が測位受信機の上方や側方に設けられる構成と比較して、航法衛星から送信される測位信号が回転制御機構によって妨げられることなく、測位受信機が十分な数の航法衛星を精度良く補足可能になる。
本構成において、前記測位受信機の下方を覆うと共に、前記測位信号の伝播を遮断する遮断板が設けられていると好適である。
本構成であれば、航法衛星から送信される測位信号が川や水田で乱反射する場合であっても、乱反射した測位信号が遮断板によって妨げられる。これにより、測位受信機がマルチパスの影響を受け難くなる。
本構成において、前記走行機体の走行経路を予め設定する走行経路設定部が備えられ、前記走行経路設定部は、前記走行機体の人為操作によるティーチング走行軌跡に基づいて、前記ティーチング走行軌跡に平行な複数のライン走行経路を生成すると好適である。
本構成によると、ライン走行経路がティーチング走行軌跡に基づいて複数生成される。このため、自動走行作業機の作業対象において、一部の作業対象領域のみの人為操作によって、ライン走行経路が生成され、ライン走行経路に基づく自動走行が可能となる。
本構成において、前記傾斜角度決定部は、前記ティーチング走行軌跡に亘って検出される前記傾斜角情報に基づいて前記傾斜角度を決定し、前記回転制御機構は、前記ライン走行経路における自動走行開始前のタイミングで、前記測位受信機を回転すると好適である。
自動走行中に測位受信機が回転動作すると、測位受信機が補足する航法衛星の数が変化し易くなり、測位受信機の測位精度が安定しなくなる虞がある。本構成であれば、自動走行開始前のタイミングで測位受信機を回転するため、自動走行中に測位受信機が回転動作する構成と比較して、測位受信機の測位精度が安定し易くなる。
本構成において、前記傾斜角度決定部は、一つの前記ライン走行経路に亘って検出される前記傾斜角情報に基づいて前記傾斜角度を更新し、前記回転制御機構は、次の前記ライン走行経路における自動走行開始前のタイミングで、前記測位受信機を回転すると好適である。
法面の傾斜角度は必ずしも一定ではなく、法面の上手側と下手側とでは傾斜角度が異なる場合がある。しかし、隣接する二つのライン走行経路における法面の傾斜角度の差は、隣接せずに離れている二つのライン走行経路における法面の傾斜角度の差よりも小さい場合が多い。本構成であれば、例えば、一つ前に走行したライン走行経路に亘って検出される傾斜角情報に基づいて傾斜角度を更新可能なように構成されている。このため、次のライン走行経路における法面の傾斜角度に近い傾斜角度として、一つ前に走行したライン走行経路における法面の傾斜角度を用いることができる。
本構成において、前記傾斜角度を記憶する記憶部が備えられ、前記記憶部に、前記走行経路と、前記走行経路における予め設定された複数の地点ごとの前記傾斜角度と、が記憶され、前記自動走行制御装置は、前記記憶部に記憶された前記走行経路に沿って自動走行し、前記回転制御機構は、前記走行機体が前記地点を通過するタイミングで、前記測位受信機を回転すると好適である。
本構成であれば、法面の傾斜角度を地点毎に記憶できるため、例えば、法面のうち、自動走行の途中で傾斜角度が大きく変化する箇所で回転制御機構を回転させることができる。これにより、自動走行の途中で傾斜角度が大きく変化する箇所があっても、測位受信機を水平に保持することができる。
本構成において、機体外部と情報通信する通信部が備えられ、前記走行経路及び前記傾斜角度は、前記通信部を介して外部端末に送信されて当該外部端末に表示可能であると好適である。
本構成であれば、走行経路及び傾斜角度が外部端末に表示されることによって、傾斜角度の変化を操作者に報知することができる。これにより、傾斜角度の変化の度合い等を操作者が確認し、操作者が自動走行作業機の自動走行と手動走行とを切換えることができる。
[課題2]に対応する解決手段は、以下の通りである。
本発明による自動走行草刈機は、草刈走行を行う走行機体と、刈取後の刈草を排出口から刈取後の地面に排出する排出機構と、前記排出機構によって排出された前記刈草を検出する検出装置と、前記刈草の検出に基づいて目標ラインを算出する目標ライン算出部と、前記目標ライン算出部に基づく目標ラインと前記走行機体との距離が、予め設定された距離に保持されるように前記走行機体を自動走行させる自動走行制御装置と、が備えられていることを特徴とする。
本発明による自動走行草刈機は、草刈走行を行う走行機体と、刈取後の刈草を排出口から刈取後の地面に排出する排出機構と、前記排出機構によって排出された前記刈草を検出する検出装置と、前記刈草の検出に基づいて目標ラインを算出する目標ライン算出部と、前記目標ライン算出部に基づく目標ラインと前記走行機体との距離が、予め設定された距離に保持されるように前記走行機体を自動走行させる自動走行制御装置と、が備えられていることを特徴とする。
本発明によれば、排出機構から刈取後の刈草が排出され、排出後の刈草が検出装置によって検出される構成である。このため、排出後の刈草を目標物にすることによって、目標ラインの算出が可能となる。これにより、草刈対象領域に目標物が無い場合であっても、目標ラインを算定し、目標ラインに基づく自動走行が可能な自動走行草刈機が実現される。
本構成において、前記排出機構は、前記走行機体の走行軌跡に沿って前記刈草を塊状に排出し、塊状の前記刈草が、前記走行機体の走行軌跡に沿って連続的又は断続的な凸部を形成するように構成されていると好適である。
本構成であれば、刈草が塊状に排出されて、刈草に凸部が形成されるため、検出装置が刈草を精度良く検出できる。
本構成において、前記排出機構は、前記走行機体のうち、前記刈取後の地面の位置する側の側部に設けられていると好適である。
刈取後の地面は平坦な状態である場合が多いため、本構成であれば、刈草が排出機構から刈取後の地面に排出され、検出装置が平坦な地面に排出された刈草を精度良く検出できる。
本構成において、前記検出装置は、前記走行機体のうち、前記刈取後の地面の位置する側の側部に設けられていると好適である。
本構成によると、検出装置が走行機体の側部に設けられるため、検出装置の真下に刈草がある場合であっても、検出装置が刈草を検出できる。このため、排出機構から排出された直後の刈草を、検出装置が捕捉可能になる。
本構成において、前記排出機構に、前記走行機体から前記排出口に亘る排出経路が形成され、前記排出経路は、前記排出口の位置する側ほど、断面形状が狭く絞られていると好適である。
本構成であれば、排出口から排出される前の刈草が、排出口の位置する側の絞られた排出経路で圧縮されるため、排出時の刈草が塊状になり易くなる。
本構成において、前記排出機構に、前記排出口を開閉可能な開閉機構と、前記刈草の圧力を検知する圧力検出手段と、が備えられ、前記圧力検出手段が予め設定された圧力以上の圧力を検知したときに、前記開閉機構が開くと好適である。
本構成であれば、排出口から排出される前の刈草を、予め設定された圧力以上の圧力に高めることができる。このため、排出時の刈草を好適に塊状にできる。
[課題3]に対応する解決手段は、以下の通りである。
本発明の草刈機は、草刈走行を行う走行機体と、前記走行機体を制御する走行制御部と、前記走行機体と、機体左右方向に位置する物体と、の距離を、機体左右両方に亘って走査する距離センサと、前記距離センサの走査によって検出された距離及び走査角度に基づいて、機体左右両方に亘る対地高さデータを生成するデコード制御部と、前記対地高さデータに基づく近似線によって、刈取後の地面のラインとして識別される地面基準線と、刈取前の草のラインとして識別される草基準線と、を生成する物体検出部と、前記草基準線と前記走行機体との距離に基づいて目標距離を算出する目標距離算出部と、前記草基準線と前記走行機体との距離が、前記目標距離と一致するように指示信号を出力する走行指示部と、が備えられていることを特徴とする。
本発明の草刈機は、草刈走行を行う走行機体と、前記走行機体を制御する走行制御部と、前記走行機体と、機体左右方向に位置する物体と、の距離を、機体左右両方に亘って走査する距離センサと、前記距離センサの走査によって検出された距離及び走査角度に基づいて、機体左右両方に亘る対地高さデータを生成するデコード制御部と、前記対地高さデータに基づく近似線によって、刈取後の地面のラインとして識別される地面基準線と、刈取前の草のラインとして識別される草基準線と、を生成する物体検出部と、前記草基準線と前記走行機体との距離に基づいて目標距離を算出する目標距離算出部と、前記草基準線と前記走行機体との距離が、前記目標距離と一致するように指示信号を出力する走行指示部と、が備えられていることを特徴とする。
例えば樹木等の目立った目標物が無い草刈対象領域であっても、草刈の対象となる草は存在する。本発明によると、距離センサが走行機体の左右方向を操作することによって、刈取後の地面と刈取前の草とを識別し、草の識別に基づく草基準線と、走行機体と、が予め設定された距離を保持するように、走行機体が制御される。このことから、草刈機は、刈取後の地面と刈取前の草との境界に沿って、草刈走行を自動的に行うことが可能となる。その結果、草刈対象領域に目標物が無い場合であっても、刈取前の草と刈取後の地面とを精度良く判別して自動走行が可能な草刈機が実現される。
本構成において、前記走行機体の走行モードを判定する走行モード判定部が備えられ、前記走行モードは、手動制御モードと、自動制御モードと、を有し、前記走行モードが前記手動制御モードの場合、前記走行制御部は手動制御の操作信号に基づいて前記走行機体を制御し、前記走行モードが前記自動制御モードの場合、前記走行制御部は前記走行指示部の指示信号に基づいて前記走行機体を制御すると好適である。
草刈対象領域の状況や走行機体の状況に対応して、草刈機は遠隔操作が可能な方が望ましい。本構成であれば、走行モード判定部による走行モードの判定から、走行制御部が入力する信号を、手動制御モードの場合における操作信号と、自動制御モードの場合における指示信号と、に切換可能となる。
本構成において、前記距離センサは、機体前後方向を軸芯に回転することによって走査するように構成されていると好適である。
本構成であれば、距離センサの走査角度が前後方向を軸芯に回転するため、距離センサは、刈取後の地面のうち、走行機体の下方近傍の地面を走査できる。これにより、距離センサが刈取後の地面と刈取前の草とを精度良く走査可能となる。
前記距離センサは、前記走行機体の前部又は後部の何れか一方に設けられていると好適である。
本構成であれば、距離センサが走行機体の前後中央部に設けられる構成と比較して、距離センサは、距離センサの真下の地面を走査可能となる。これにより、距離センサが刈取後の地面と刈取前の草とを精度良く走査可能となる。
本構成において、前記距離センサは、前記走行機体の前部及び後部の両方に設けられていると好適である。
本構成であれば、走行機体の前部に設けられた距離センサによって草刈走行が行われる前の地面及び草を走査できると共に、走行機体の後部に設けられた距離センサによって草刈走行が行われた後の地面及び草を走査できる。これにより、草刈機は、刈取後の地面と刈取前の草との境界に精度良く沿うことが可能となる。
本構成において、前記物体検出部は、前記対地高さデータのうち、前記距離センサの機体鉛直下方から予め設定された機体左右方向の範囲内のデータから近似線を算出することによって、前記地面基準線を生成するように構成されていると好適である。
本構成であれば、近似線に基づいて地面基準線が生成される構成であるため、対地高さデータから刈取後の地面と草刈前の草とを効率よく判別できる。
本構成において、前記物体検出部は、前記対地高さデータのうち、前記地面基準線から一定値以上の高さを有するデータが一定範囲以上に亘って連続する箇所のデータから近似線を算出することによって、草候補線を生成するように構成されていると好適である。
本構成であれば、草候補線として生成される対地高さデータは、データが一定範囲以上に亘って連続する箇所のデータに限定される。このため、一定範囲に亘って連続しないデータが、草候補線のデータから排除され、草を誤検出する虞が低減される。また、近似線に基づいて草候補線が生成される構成であるため、対地高さデータから刈取後の地面と草刈前の草とを効率よく判別できる。
本構成において、前記草候補線は、複数生成され、前記走行機体に、前記走行機体の傾斜角度を検出する慣性センサが備えられ、前記物体検出部は、前記草候補線のうち、前記草候補線の前記地面基準線に対する傾斜角度と、前記慣性センサによって検出された傾斜角度から算出された算出傾斜角度と、が予め定められた基準範囲内である一つの前記草候補線を、前記草基準線と特定するように構成されるように構成されていると好適である。
一般的に、草は傾斜地であっても特定方向(例えば鉛直方向)に沿って上方に生える場合が多い。本構成であると、慣性センサの傾斜角度に基づいて当該特定方向の算出が可能である。このため、複数の草候補線のうち、当該特定方向に沿う草候補線を草基準線と特定することによって、草の判別精度が向上する。
本構成において、前記草基準線は、前記地面基準線から予め設定された高さの範囲内に限定されると好適である。
草の上部は風で揺れる場合が多いため、本構成であれば、風等の外乱による草の誤検出を防止できる。
本構成において、前記草基準線と前記走行機体との距離は、現在と過去複数回とに亘って算出された複数の値が記憶され、前記目標距離は、前記複数の値の移動平均値に基づいて算出されると好適である。
草刈走行において、草と走行機体との距離が一定範囲内に保持されている場合であっても、地面の石や杭等の検知によって草基準線と走行機体との距離が急激に大きく変化する場合も考えられる。本構成であれば、目標距離が移動平均値であるため、草基準線と走行機体との距離が急激に大きく変化する場合であっても、目標距離の変化は、草基準線と走行機体との距離の変化よりも小さなものとなり、走行指示部における指示信号が安定する。
[課題4]に対応する解決手段は、以下の通りである。
本発明の草刈機自動走行システムは、法面上に予め設定された走行エリア内を自動草刈走行する草刈機の自動走行システムであって、法面の最上端に設けられ、検出信号を送信し、前記検出信号に対する反射信号を取得して物体を検出する物体検出部と、前記草刈機における前記物体検出部の位置する側の側面に設けられ、前記物体検出部により検出される反射部と、前記物体検出部と前記草刈機との夫々に設けられた通信部と、前記走行エリアのエリア情報と、前記草刈機の作業履歴情報と、を記憶する記憶部と、前記草刈機の走行経路を設定する走行経路設定部と、前記草刈機に指示信号を送信する制御指示部と、が備えられ、前記物体検出部は、前記反射部を追従するように構成され、前記制御指示部は、前記物体検出部が取得した反射信号に基づいて前記草刈機の走行軌跡を算出して前記草刈機の走行軌跡と前記走行経路との誤差を算出し、前記誤差を減少させるように前記指示信号を生成し、前記草刈機は、前記指示信号によって前記走行経路に沿って自動草刈走行するように構成されていることを特徴とする。
本発明の草刈機自動走行システムは、法面上に予め設定された走行エリア内を自動草刈走行する草刈機の自動走行システムであって、法面の最上端に設けられ、検出信号を送信し、前記検出信号に対する反射信号を取得して物体を検出する物体検出部と、前記草刈機における前記物体検出部の位置する側の側面に設けられ、前記物体検出部により検出される反射部と、前記物体検出部と前記草刈機との夫々に設けられた通信部と、前記走行エリアのエリア情報と、前記草刈機の作業履歴情報と、を記憶する記憶部と、前記草刈機の走行経路を設定する走行経路設定部と、前記草刈機に指示信号を送信する制御指示部と、が備えられ、前記物体検出部は、前記反射部を追従するように構成され、前記制御指示部は、前記物体検出部が取得した反射信号に基づいて前記草刈機の走行軌跡を算出して前記草刈機の走行軌跡と前記走行経路との誤差を算出し、前記誤差を減少させるように前記指示信号を生成し、前記草刈機は、前記指示信号によって前記走行経路に沿って自動草刈走行するように構成されていることを特徴とする。
本発明によれば、物体検出部が法面の最上端に設けられ、草刈機の側面に反射部が設けられる構成となっている。物体検出部は定点位置に固定され、物体検出部の検出目標物を草刈機とすることができるため、物体検出部が草刈機に設けられる構成と比較して、物体検出部が安定した状態で草刈機の反射部を検出可能となる。このことから、法面上の凹凸等によって草刈機が急激に傾く場合であっても、物体検出部は、法面上の凹凸等の影響を受けることなく草刈機の反射部を検出可能となる。これにより、同一法面において、法面上の傾斜角度が一様でなかったり、法面上に凹凸があったりする場合であっても、物体検出部が精度良く物体を追従可能な草刈機自動走行システムが実現される。
本構成において、前記草刈機に、前記草刈機の傾斜角度を検出する傾斜センサが備えられ、前記物体検出部に、前記傾斜センサが検出した傾斜角度と一致するように、前記物体検出部の角度調整を行う傾斜補正制御部が備えられていると好適である。
草刈機の傾斜センサによって検出される傾斜角度は、法面の傾斜角度に沿う場合が多い、このことから、本構成であれば、物体検出部が、傾斜補正制御部によって法面の傾斜角度に沿って傾斜する。これにより、異なる法面毎に人為操作による物体検出部の傾斜調整作業をする必要が無くなり、物体検出部が、多種多様な法面角度に対応して、草刈機の反射部を追従し易くなる。
本構成において、前記反射部に、横長の反射シートが上下に並ぶ状態で複数備えられ、
夫々の前記反射シートは、互いに長手方向の長さが異なると好適である。
夫々の前記反射シートは、互いに長手方向の長さが異なると好適である。
本構成であれば、物体検出部が横方向に沿って走査するときに、物体検出部は横長の反射シートの長さを検出可能である。複数の反射シートで夫々長さが異なる構成であるため、物体検出部は、反射シートの長さに基づいて、反射部の上側寄り又は下側寄りの何れを追従しているかを判定可能となる。これにより、物体検出部は反射部の上下中央箇所を追従することが可能となり、法面上の凹凸等によって草刈機が急激に上下に動く場合であっても、物体検出部は反射部を好適に追従できる。
本構成において、夫々の前記反射シートは、機体下側に位置するほど長手方向の長さが長いと好適である。
本構成であれば、複数の反射シートのうち、最も上側に位置する反射シートの長さと、最も下側に位置する反射シートの長さと、が最も大きく異なる。このため、物体検出部は、反射部の上側寄り又は下側寄りの何れを追従しているかを判定し易くなり、誤判定の虞を軽減できる。
本構成において、法面の最上端に前記物体検出部を固定する取付治具が設けられ、前記物体検出部は、前記取付治具に着脱可能なように構成されていると好適である。
本構成であれば、法面の最上端に取付治具を固定し、物体検出部は持ち運び可能なように構成できるため、全ての走行エリアに物体検出部を設置固定する必要が無い。このため、全ての走行エリアに物体検出部を設置固定する構成と比較して、草刈機自動走行システムを安価に構築できる。
本構成において、前記記憶部は、前記取付治具に設けられ、前記物体検出部が前記取付治具に固定された状態で、前記エリア情報及び前記作業履歴情報が、前記記憶部から前記物体検出部に読み出し可能なように構成されていると好適である。
本構成であれば、自動草刈走行するための必要な情報が記憶部に記憶され、物体検出部を取付治具に装着するだけで、エリア情報及び作業履歴情報が、物体検出部に読み出し可能なように構成されている。このため、物体検出部は、自動草刈走行するための必要な情報を取得するために、例えば遠隔地の管理コンピュータに接続する必要も無ければ、WAN(Wide Area Network)等に接続する必要も無い。その結果、異なる法面毎に、エリア情報及び作業履歴情報を、物体検出部に容易に読み出すことができる。
本構成において、前記エリア情報及び前記作業履歴情報が、前記物体検出部から前記記憶部に記憶可能なように構成されていると好適である。
本構成であれば、自動草刈走行時のエリア情報及び作業履歴情報が更新されたとき、これらの更新された情報が記憶部に記憶されるため、次回の自動草刈走行時に、同一の物体検出部でなくても、最新のエリア情報及び作業履歴情報が読み出し可能となる。また、自動草刈走行時の作業履歴情報に基づいて、次回の自動草刈走行時に角度の変動等を事前に予測できるため、過去の自動草刈走行よりも安定した自動草刈走行が可能となる。
本構成において、前記走行経路設定部は、前記草刈機の人為操作によるティーチング走行軌跡に基づいて、前記ティーチング走行軌跡に平行な複数のライン走行経路を生成すると好適である。
本構成によると、ライン走行経路がティーチング走行軌跡に基づいて複数生成される。
このため、自動草刈走行の作業対象において、一部の作業対象領域のみの人為操作によって、ライン走行経路が生成され、ライン走行経路に基づく自動走行が可能となる。
このため、自動草刈走行の作業対象において、一部の作業対象領域のみの人為操作によって、ライン走行経路が生成され、ライン走行経路に基づく自動走行が可能となる。
本構成において、前記複数のライン走行経路は、前記ティーチング走行軌跡よりも法面の下方側に、平行に並んだ状態で位置すると好適である。
物体検出部は法面の上端に設けられることから、本構成であれば、法面の上手側から下手側に向かって順番に自動草刈走行が行われる。このため、物体検出部と草刈機との間は、常に刈取後の地面となり、物体検出部は未刈草に邪魔されることなく好適に草刈機の反射部を追従できる。
本構成において、前記ティーチング走行軌跡及び前記複数のライン走行経路は、前記記憶部に前記作業履歴情報として記憶され、前記走行経路設定部は、前記作業履歴情報に基づいて前記ティーチング走行軌跡を前記ライン走行経路として再現可能であり、かつ、前記複数のライン走行経路を再現可能であると好適である。
本構成であれば、同一の法面における次回の自動草刈走行では、ティーチング走行を行う必要が無く、人為操作の労力を軽減できる。
[第1実施形態]
以下、本発明の第1実施形態を図面の記載に基づいて説明する。
〔自動走行作業機の基本構成〕
本発明による自動走行作業機について、その実施形態を図面に基づいて説明する。
図1に示されているように、本実施形態に例示される自動走行作業機としての自動走行草刈機に、走行機体1と、第一車輪2Aと、第二車輪2Bと、草刈装置3と、測位受信機4と、回転制御機構5と、が備えられている。第一車輪2Aは、走行機体1における長手方向の一端側に左右一対で設けられている。第二車輪2Bは、走行機体1における長手方向の他端側に左右一対で設けられている。草刈装置3は、走行機体1の下部における第一車輪2Aと第二車輪2Bとの間に設けられている。測位受信機4は走行機体1の上に設けられている。回転制御機構5は多自由度で回動可能であり、測位受信機4と走行機体1との間に設けられている。測位受信機4は、航法衛星からの電波を受信して機体の位置を検出する衛星測位用システム(GNSS:Global Navigation Satellite System)の一例として、周知の技術であるGPS(Global Positioning System)を利用して測位信号を受信するように構成されている。なお、測位受信機4は、GPSに限らず、マルチGNSSに対応する構成であっても良い。測位受信機4と回転制御機構5との間に、遮断板6が設けられている。遮断板6は、測位受信機4の真下に位置する状態で設けられている。
以下、本発明の第1実施形態を図面の記載に基づいて説明する。
〔自動走行作業機の基本構成〕
本発明による自動走行作業機について、その実施形態を図面に基づいて説明する。
図1に示されているように、本実施形態に例示される自動走行作業機としての自動走行草刈機に、走行機体1と、第一車輪2Aと、第二車輪2Bと、草刈装置3と、測位受信機4と、回転制御機構5と、が備えられている。第一車輪2Aは、走行機体1における長手方向の一端側に左右一対で設けられている。第二車輪2Bは、走行機体1における長手方向の他端側に左右一対で設けられている。草刈装置3は、走行機体1の下部における第一車輪2Aと第二車輪2Bとの間に設けられている。測位受信機4は走行機体1の上に設けられている。回転制御機構5は多自由度で回動可能であり、測位受信機4と走行機体1との間に設けられている。測位受信機4は、航法衛星からの電波を受信して機体の位置を検出する衛星測位用システム(GNSS:Global Navigation Satellite System)の一例として、周知の技術であるGPS(Global Positioning System)を利用して測位信号を受信するように構成されている。なお、測位受信機4は、GPSに限らず、マルチGNSSに対応する構成であっても良い。測位受信機4と回転制御機構5との間に、遮断板6が設けられている。遮断板6は、測位受信機4の真下に位置する状態で設けられている。
走行機体1の上方に、送信機7(図4参照)と通信可能なアンテナ8が設けられている。送信機7は、操作者が持ち運びしながら自動走行作業機を人為操作可能なように構成されている。送信機7は、例えば作業者が手元で操作するプロポーショナル方式の送信機による操作であったり、タッチパネル方式の表示画面を有する携帯端末機器による操作であったりしても良い。
図示はしないが、走行機体1に、エンジンEAの動力を、第一車輪2Aと第二車輪2Bに伝達すると共に、草刈装置3に伝達する伝動機構が備えられている。伝動機構は、第一車輪2A及び第二車輪2Bと、草刈装置3と、に対する動力伝達を断続できるように構成されている。エンジンEAの動力が、第一車輪2A及び第二車輪2Bと、草刈装置3と、に伝達されることで、機体を走行させながら草刈作業を行うことができる。第一車輪2Aに第一操向モータ9Aが設けられ、第一車輪2Aは第一操向モータ9Aの駆動力により縦軸芯周りで揺動してステアリング操作自在なように構成されている。また、第二車輪2Bに第二操向モータ9Bが設けられ、第二車輪2Bは第二操向モータ9Bの駆動力により縦軸芯周りで揺動してステアリング操作自在なように構成されている。図2及び図3に示されているように、第一車輪2A及び第二車輪2Bは夫々、直進用姿勢、右向き揺動姿勢、並びに、左向き揺動姿勢の夫々に向き変更操作可能である。
〔自動走行制御装置〕
図4に示されているように、予め設定された走行経路に沿って自動走行草刈機の自動走行を可能にするための制御ユニットUAが、例えばマイクロコンピュータに組み込まれた状態で、自動走行草刈機に備えられている。制御ユニットUAに、走行モード判定部10と、記憶部11と、走行経路設定部12と、自動走行制御装置13と、が備えられている。記憶部11は、測位受信機4が受信する測位信号に基づく位置情報を記憶可能なように構成されている。走行経路設定部12は、走行機体1が自動走行を行うための走行経路を設定する。自動走行制御装置13は、走行経路設定部12が設定する走行経路に沿って走行機体1が走行するように構成されている。また、制御ユニットUAは、走行モード判定部10の判定によって、自動走行モードと手動走行モードとに切替可能なように構成されている。手動走行モードでは、送信機7の人為操作に基づいて自動走行作業機が草刈走行等を行うため、自動走行制御装置13は無効化されるが、自動走行制御装置13と連動して走行経路設定部12も無効化される構成であっても良い。
図4に示されているように、予め設定された走行経路に沿って自動走行草刈機の自動走行を可能にするための制御ユニットUAが、例えばマイクロコンピュータに組み込まれた状態で、自動走行草刈機に備えられている。制御ユニットUAに、走行モード判定部10と、記憶部11と、走行経路設定部12と、自動走行制御装置13と、が備えられている。記憶部11は、測位受信機4が受信する測位信号に基づく位置情報を記憶可能なように構成されている。走行経路設定部12は、走行機体1が自動走行を行うための走行経路を設定する。自動走行制御装置13は、走行経路設定部12が設定する走行経路に沿って走行機体1が走行するように構成されている。また、制御ユニットUAは、走行モード判定部10の判定によって、自動走行モードと手動走行モードとに切替可能なように構成されている。手動走行モードでは、送信機7の人為操作に基づいて自動走行作業機が草刈走行等を行うため、自動走行制御装置13は無効化されるが、自動走行制御装置13と連動して走行経路設定部12も無効化される構成であっても良い。
自動走行制御装置13の出力対象は、走行制御モータ15と、前後進モータ16と、第一操向モータ9Aと、第二操向モータ9Bと、である。走行制御モータ15は、エンジンEAに対する燃料供給量を調整するアクセル20と、第一車輪2A及び第二車輪2Bを制動するブレーキ21と、を操作する。前後進モータ16は、正逆転切換機構22を切り換え操作する。図示はしないが、正逆転切換機構22は、第一車輪2A及び第二車輪2BにエンジンEAの動力を伝達する伝動装置に備えられ、エンジンEAの動力を正転方向と逆転方向とに切換えるためのギア機構である。第一操向モータ9Aは第一車輪2Aを操向操作し、第二操向モータ9Bは第二車輪2Bを操向操作する。走行制御モータ15と、前後進モータ16と、の夫々は、電動モータであっても良いし、電磁スイッチであっても良い。
自動走行制御装置13は、測位受信機4によって受信された測位信号から走行機体1の位置及び方位を特定する。そして、走行制御モータ15と、前後進モータ16と、第一操向モータ9Aと、第二操向モータ9Bと、に制御信号を出力することによって、後述する走行経路に沿って走行機体1が走行するように、自動走行制御装置13は構成されている。また、自動走行制御装置13は、自動走行制御装置13の制御信号に基づく自動走行モードと、人為操作による制御信号に基づく手動走行モードと、に切替可能なように構成されている。
走行機体1に、送信機7から無線送信される操作信号を、アンテナ8を介して受信可能な通信部17が備えられている。通信部17の受信情報は制御ユニットUAに入力される。
自動走行草刈機の状態は、通信部17から機体外部の機器に送信可能であり、例えば携帯端末機器の表示画面に、自動走行草刈機の現在位置や状態を表示することも可能である。自動走行草刈機の状態は、例えば、草刈走行の車速であったり、燃料の残量であったり、自動走行草刈機に搭載された各種機器の不具合を示すものであったりしても良い。
〔走行経路設定部〕
図4に示されているように、制御ユニットUAに走行経路設定部12が備えられている。走行機体1が自動走行を行うための走行経路は、走行経路設定部12によって予め設定される。図5に示されているように、法面上で自動走行を行うための走行経路として、直線状のライン走行経路LAが複数設定されている。本実施形態では、夫々のライン走行経路LAは、走行経路設定部12によって、以下の手順で生成される。
図4に示されているように、制御ユニットUAに走行経路設定部12が備えられている。走行機体1が自動走行を行うための走行経路は、走行経路設定部12によって予め設定される。図5に示されているように、法面上で自動走行を行うための走行経路として、直線状のライン走行経路LAが複数設定されている。本実施形態では、夫々のライン走行経路LAは、走行経路設定部12によって、以下の手順で生成される。
まず、法面の上端縁部に沿って、手動走行モードでティーチング走行が行われる。ティーチング走行は、送信機7を操作者が操作することによる人為操作に基づいて行われる。本実施形態では、始点位置TAsに走行機体1が位置する状態で、操作者が送信機7で始点設定操作を行う。そして、操作者が始点位置TAsから終点位置TAfまで直線形状に沿って走行機体1を走行させ、始点位置TAsに走行機体1が位置する状態で、操作者が送信機7で終点設定操作を行う。これにより、ティーチング処理が実行される。つまり、始点位置TAsにおいて測位受信機4により取得された測位データに基づく位置座標と、終点位置TAfにおいて測位受信機4により取得された測位データに基づく位置座標と、から始点位置TAsと終点位置TAfとを結ぶティーチング経路TAが設定される。
ティーチング走行中の走行機体1の位置は、測位受信機4によって逐次測位され、測位信号が記憶部11に記憶される構成であっても良い。ティーチング走行の始点位置TAsとティーチング走行の終点位置TAfとに亘る測位信号の集合から、走行機体1の経時的な位置座標を抽出することによって、ティーチング経路TAが得られる。この構成は、ティーチング経路TAが曲線状である場合に、特に有用である。
ライン走行経路LAは、ティーチング経路TAと平行な走行経路として、法面の下手側に向かって等間隔で複数生成される。本実施形態では、法面のティーチング経路TAよりも下手側に、ティーチング経路TAに沿うライン走行経路LA(1)~LA(10)が、等間隔で生成されている。なお、草刈作業すべき領域の幅と作業車による草刈り作業幅とを考慮し、刈残しが生じないように作業幅が少し重なる状態で、ライン走行経路LAは設定される。
夫々のライン走行経路LA(1)~LA(10)に、始点位置LAsと終点位置LAfとが割り当てられ、始点位置LAsから終点位置LAfに向かう方向が、走行機体1の進行方向となるように、夫々のライン走行経路LA(1)~LA(10)は構成されている。また、走行機体1が夫々のライン走行経路LA(1)~LA(10)を順番に走行するための順路が設定され、本実施形態では、法面の上手側から下手側に折り返しながら、走行機体1が直線往復走行を繰り返す順路が設定されている。つまり、ライン走行経路LA(1)~LA(9)の何れか一つのライン走行経路LA(n)における終点位置LAfの法面下手側に、次の順路が割り当てられたライン走行経路LA(n+1)の始点位置LAsが隣り合って位置するように、走行経路が設定されている。
自動走行草刈機は、ライン走行経路LAに沿って草刈りしながら自動走行する。例えば、走行機体1が、一つのライン走行経路LA(1)の終点位置LAfに到達すると、自動走行制御装置13は、次の順路が割り当てられたライン走行経路LA(2)の始点位置LAsに移動するように制御信号を出力する。このとき、自動走行制御装置13は、走行機体1がUターンをしながら、次のライン走行経路LA(2)の始点位置LAsに移動するように制御信号を出力しても良いし、走行機体1が方向転換せずにスイッチバックを繰り返しながら、次のライン走行経路LA(2)の始点位置LAsに移動するように制御信号を出力しても良い。なお、本実施形態におけるスイッチバックを具体的に説明すると、走行機体1が終点位置LAfに達した際に、正逆転切換機構22の切換え操作によって前後進を繰り返して、走行機体1の位置を当該終点位置LAfの位置から法面下手側にずらすように、始点位置LAsに移動する走行形態である。あるいは、終点位置LAfから次の始点位置LAsへの移動は、手動走行モードによって行われても良い。この場合、走行機体1が次の始点位置LAsに移動した後、手動走行モードから自動走行モードへの切換は、人為操作によって行われても良いし、自動的に行われても良い。
走行機体1がライン走行経路LA(2)の始点位置LAsに到達し、走行機体1の進行方位がライン走行経路LA(2)の進行方向に沿うと、自動走行草刈機は、ライン走行経路LA(2)に沿って草刈りしながら自動走行する。
〔回転制御機構〕
自動走行制御装置13は、測位受信機4によって受信された測位信号から走行機体1の位置及び方位を特定するように構成されているが、本実施形態における自動走行草刈機が傾斜した法面を走行する場合、測位受信機4も法面の傾斜度合いに応じて傾く。測位受信機4が傾くことによって、測位受信機4が補足可能な航法衛星の数が減少する虞がある。また、傾斜法面の下手方向に川や水田が存在する場合、航法衛星から送信される測位信号が川や水田で乱反射することによって、測位受信機4がマルチパスの影響を受けやすくなって、測位精度が低下する虞がある。特に、本実施形態における自動走行草刈機に搭載される測位受信機4では、測位受信機4と地面との距離が近い場合が多く、このような不都合が生じやすい。このことから、測位受信機4の真下に遮断板6が設けられ、遮断板6は、川や水田で乱反射した測位信号を測位受信機4の下方で遮断する。これにより、測位受信機4がマルチパスの影響を受け難くなり、測位精度が低下する恐れが低減される。また、測位受信機4の傾きを軽減するための回転制御機構5が、測位受信機4の下方に備えられている。
自動走行制御装置13は、測位受信機4によって受信された測位信号から走行機体1の位置及び方位を特定するように構成されているが、本実施形態における自動走行草刈機が傾斜した法面を走行する場合、測位受信機4も法面の傾斜度合いに応じて傾く。測位受信機4が傾くことによって、測位受信機4が補足可能な航法衛星の数が減少する虞がある。また、傾斜法面の下手方向に川や水田が存在する場合、航法衛星から送信される測位信号が川や水田で乱反射することによって、測位受信機4がマルチパスの影響を受けやすくなって、測位精度が低下する虞がある。特に、本実施形態における自動走行草刈機に搭載される測位受信機4では、測位受信機4と地面との距離が近い場合が多く、このような不都合が生じやすい。このことから、測位受信機4の真下に遮断板6が設けられ、遮断板6は、川や水田で乱反射した測位信号を測位受信機4の下方で遮断する。これにより、測位受信機4がマルチパスの影響を受け難くなり、測位精度が低下する恐れが低減される。また、測位受信機4の傾きを軽減するための回転制御機構5が、測位受信機4の下方に備えられている。
図6に示されているように、測位受信機4の下方に遮断板6が設けられ、遮断板6の下方に回転制御機構5が設けられる構成となっており、測位受信機4及び遮断板6は、回転制御機構5の回転軸を軸芯に一体的に揺動可能なように構成されている。本実施形態において、回転制御機構5は、二つの自由度で回動するように構成されている。つまり、回転制御機構5は、走行機体1の機体前後方向に沿うロール軸と、走行機体1の機体左右方向に沿うピッチ軸と、の二つの軸を軸芯に回動可能なように構成されている。これにより、測位受信機4は多自由度で回動する。このように、走行機体1が傾斜した法面を走行する場合であっても、測位受信機4を水平姿勢に保持するように、回転制御機構5は回動する。
〔傾斜角度決定部〕
傾斜角度検出部30が走行機体1に備えられ、傾斜角度検出部30は、例えば慣性センサの一例であるIMU(Inertial Measurement Unit)であって、走行機体1の傾きを検出して傾斜角情報ImAを出力する。測位受信機4が水平姿勢を保持するための角度は傾斜角度決定部31によって決定され、傾斜角度決定部31は、傾斜角情報ImAに基づいて、回転制御機構5に出力する傾斜角度IAを決定する。傾斜角度IAに、走行機体1の機体前後方向に沿うロール角度と、走行機体1の機体左右方向に沿うピッチ角度と、が含まれる。決定した傾斜角度IAは回転制御機構5に出力され、回転制御機構5は、入力した傾斜角度IAに基づいて、ロール軸及びピッチ軸の回動角度を調整する。
傾斜角度検出部30が走行機体1に備えられ、傾斜角度検出部30は、例えば慣性センサの一例であるIMU(Inertial Measurement Unit)であって、走行機体1の傾きを検出して傾斜角情報ImAを出力する。測位受信機4が水平姿勢を保持するための角度は傾斜角度決定部31によって決定され、傾斜角度決定部31は、傾斜角情報ImAに基づいて、回転制御機構5に出力する傾斜角度IAを決定する。傾斜角度IAに、走行機体1の機体前後方向に沿うロール角度と、走行機体1の機体左右方向に沿うピッチ角度と、が含まれる。決定した傾斜角度IAは回転制御機構5に出力され、回転制御機構5は、入力した傾斜角度IAに基づいて、ロール軸及びピッチ軸の回動角度を調整する。
傾斜角度決定部31は、傾斜角度検出部30が検出した傾斜角情報ImAを、そのまま傾斜角度IAとして決定し、回転制御機構5に傾斜角度IAをそのまま出力する構成も可能である。更に、回転制御機構5が、入力した傾斜角度IAに基づいて即座に測位受信機4を回動することによって、リアルタイムで測位受信機4を水平保持する構成も可能である。しかし、このような構成である場合、走行機体1の走行途中の地面の凹凸に追従して、測位受信機4が走行機体1に対する回動が継続し、測位受信機4の走行機体1に対する傾斜姿勢が安定しない虞がある。このことに起因して、測位可能な航法衛星の数が走行途中に変化する虞があり、測位精度が安定しなくなる虞も考えられる。このため、測位受信機4が走行機体1に対して回動するタイミング、即ち、回転制御機構5が回動するタイミングは、走行機体1が停止する間であることが望ましい。
図7に示されているように、ティーチング走行が行われているとき、傾斜角度検出部30は、ティーチング走行の始点位置TAsと終点位置TAfとに亘って傾斜角情報ImAの検出を継続し、傾斜角度決定部31に対する傾斜角情報ImAの出力を継続する。そして、傾斜角度決定部31は、始点位置TAsと終点位置TAfとに亘って検出された傾斜角情報ImAの平均値を算出し、この平均値を傾斜角度IA(0)として決定する。
走行機体1が最初のライン走行経路LA(1)を自動走行するとき、測位受信機4が走行機体1に対して傾斜角度IA(0)の傾きを保持するように、回転制御機構5は測位受信機4を位置決め保持する。回転制御機構5が測位受信機4を回動するタイミングは、走行機体1が終点位置TAfから最初のライン走行経路LA(1)の始点位置LAsに移動するまでの間である。
走行機体1が最初のライン走行経路LA(1)に沿って走行しているとき、傾斜角度検出部30は、ライン走行経路LA(1)における始点位置LAsと終点位置LAfとに亘って傾斜角情報ImAの検出を継続し、傾斜角度決定部31に対する傾斜角情報ImAの出力を継続する。そして、傾斜角度決定部31は、最初のライン走行経路LA(1)における始点位置LAsと終点位置LAfとに亘って検出された傾斜角情報ImAの平均値を算出し、この平均値を傾斜角度IA(1)として決定する。つまり、傾斜角度決定部31は、傾斜角度IAを、傾斜角度IA(0)から傾斜角度IA(1)に更新する。走行機体1が最初のライン走行経路LA(1)の終点位置LAfに到達後、次のライン走行経路LA(1)の始点位置LAsに移動するまでの間に、傾斜角度IA(1)に基づいて回転制御機構5は回動する。
走行機体1が最初のライン走行経路LA(2)に沿って走行しているとき、測位受信機4が走行機体1に対して傾斜角度IA(1)の傾きを保持するように、回転制御機構5は測位受信機4を位置決め保持する。また、傾斜角度検出部30は、傾斜角度決定部31が傾斜角度IA(2)を算出するために、ライン走行経路LA(2)における始点位置LAsと終点位置LAfとに亘って傾斜角情報ImAの検出を継続し、傾斜角度決定部31に対する傾斜角情報ImAの出力を継続する。そして、走行機体1がライン走行経路LA(2)の終点位置LAfに到達した時に、傾斜角度決定部31は、傾斜角度IAを傾斜角度IA(1)から傾斜角度IA(2)に更新する。
このように、走行機体1が、ライン走行経路LA(2)~LA(10)の何れか一つのライン走行経路LA(n)に沿って走行しているとき、回転制御機構5は、一つ前のライン走行経路LA(n-1)で決定された傾斜角度IA(n-1)の傾きで、測位受信機4を位置決め保持するように構成されている。隣接するライン走行経路LA(n-1)とライン走行経路LA(n)とにおける法面の傾斜角度の差は、隣接せずに離れている二つのライン走行経路LAにおける法面の傾斜角度の差よりも小さい場合が多い。このため、法面の上手側と下手側とで傾斜度合いが大きく異なる場合であっても、前回のライン走行経路LA(n-1)における傾斜角度IA(n-1)を用いて、測位受信機4の姿勢を、ほぼ水平に保持することができる。
送信機7が、例えば携帯端末機器等であって表示画面を有する場合、送信機7は、通信部17を介して、傾斜角情報ImAや傾斜角度IAを表示画面に表示可能なように構成されている。また、ティーチング走行軌跡やライン走行経路LAを含む走行経路も、当該表示画面に表示可能である。
〔第1実施形態の別実施形態〕
本発明は、上述した実施形態に例示された構成に限定されるものではなく、以下、本発明の代表的な別実施形態を例示する。
本発明は、上述した実施形態に例示された構成に限定されるものではなく、以下、本発明の代表的な別実施形態を例示する。
〔1〕上述した実施形態では、ティーチング走行中に記憶部11に記憶された測位信号に基づくティーチング経路TAからライン走行経路LA(1)~LA(10)が生成される構成となっているが、上述した実施形態に限定されない。例えば、ティーチング経路TA及びライン走行経路LAを含む走行経路が、全て記憶部11に記憶され、自動走行草刈機による次回の自動走行時に、記憶部11に記憶された走行経路に沿って自動走行が行われる構成であっても良い。これにより、次回の自動走行前にティーチング走行を行う必要が無くなり、人為操作の手間を省略することができる。また、夫々の傾斜角度IA(0)~I(9)も、走行経路と同様に、記憶部11に記憶される構成であっても良い。そして、ライン走行経路LA(1)~LA(9)の何れか一つのライン走行経路LA(n)の終点位置LAfから次のライン走行経路LA(n+1)の始点位置LAsに走行機体1が移動する間に、回転制御機構5は、ライン走行経路LA(n+1)に対応する傾斜角度IA(n)に基づいて測位受信機4を回動する構成であっても良い。
また、ティーチング経路TA及びライン走行経路LAと、傾斜角度IAと、は記憶部11に限らず、例えば外部端末に管理される構成であっても良い。この場合、通信部17はWAN(Wide Area Network)等を介して外部端末と通信可能なように構成され、ティーチング経路TA及びライン走行経路LAと、傾斜角度IAと、が通信部17を介して外部端末から読み出されるように構成されていても良いし、ティーチング経路TA及びライン走行経路LAと、傾斜角度IAと、が通信部17を介して外部端末に記憶されるように構成されていても良い。
〔2〕上述した実施形態では、傾斜角度決定部31は、夫々のライン走行経路LAの終点位置LAfに到達した時に、傾斜角度IAを更新するように構成されているが、上述した実施形態に限定されない。例えば、傾斜角度IAが、測位受信機4によって受信された測位信号に基づく位置情報と紐付けられた状態で記憶部11に記憶され、走行機体1が特定の位置を通過するときに回転制御機構5が回動し、測位受信機4が水平に保持される構成であっても良い。例えば、図8に示されているように、ライン走行経路LA(1)~LA(5)に沿って、位置P1~P11の位置情報が記憶部11に記憶され、位置P1~P11の位置情報の夫々に対応する傾斜角度IA(P1)~I(P11)が記憶部11に記憶される構成であっても良い。走行機体1が、位置P1~P11を通過する毎に、傾斜角度決定部31は位置P1~P11の位置情報の夫々に対応する傾斜角度IA(P1)~I(P11)を読み出し、回転制御機構5は測位受信機4を回動する。これにより、例えばすり鉢状の土地で、自動走行の途中で傾斜角度が大きく変化する箇所があっても、測位受信機を水平に保持することができる。
〔3〕上述した実施形態では、夫々のライン走行経路LAは、直線状のティーチング経路TAに基づいて設定されているが、曲線状のティーチング経路TAに基づいて設定されても良い。例えば図9に示されているように、曲線状のティーチング経路TAに基づいて、ティーチング経路TAと平行な曲線状のライン走行経路LAが、等間隔に夫々設定される構成であっても良い。
〔4〕上述した実施形態では、傾斜角度決定部31は、夫々のライン走行経路LAの終点位置LAfに到達した時に、傾斜角度IAを更新するように構成されているが、上述した実施形態に限定されない。例えば、傾斜角度決定部31は、ティーチング走行の始点位置TAsと終点位置TAfとに亘って検出された傾斜角情報ImAの平均値を算出し、この平均値を傾斜角度IAとして決定し、その後は傾斜角度IAを更新しない構成であっても良い。
〔5〕上述した傾斜角度検出部30として、IMUが例示されているが、上述した実施形態に限定されない。例えば、傾斜角度検出部30として、振り子式やフロート式の傾斜角検出器であっても良い。また、慣性センサは、ジャイロセンサであったり、加速度センサであったりしても良い。
〔6〕上述した実施形態に例示された測位受信機4と回転制御機構5とは、一体的な形状で構成されていても良い。
〔7〕上記実施形態では、自動走行草刈機が草刈りを行いながら自動走行するとして説明したが、自動走行草刈機を例えば薬剤散布車など他の作業車両として用いることも可能である。
[第2実施形態]
以下、本発明の第2実施形態を図面の記載に基づいて説明する。
〔自動走行作業機の基本構成〕
本発明による自動走行作業機について、その実施形態を図面に基づいて説明する。
図10に示されているように、本実施形態に例示される自動走行作業機としての自動走行草刈機に、走行機体101と、第一車輪102Aと、第二車輪102Bと、草刈装置103と、が備えられている。第一車輪102Aは、走行機体101における長手方向の一端側に左右一対で設けられている。第二車輪102Bは、走行機体101における長手方向の他端側に左右一対で設けられている。草刈装置103は、走行機体101の下部における第一車輪102Aと第二車輪102Bとの間に設けられている。また、走行機体101の一端側部に排出機構104(図13及び図14参照)が備えられ、排出機構104は、草刈装置103によって刈り取られた刈草を排出する。更に、走行機体101の上部に検出装置110が設けられている。検出装置110については後述する。
以下、本発明の第2実施形態を図面の記載に基づいて説明する。
〔自動走行作業機の基本構成〕
本発明による自動走行作業機について、その実施形態を図面に基づいて説明する。
図10に示されているように、本実施形態に例示される自動走行作業機としての自動走行草刈機に、走行機体101と、第一車輪102Aと、第二車輪102Bと、草刈装置103と、が備えられている。第一車輪102Aは、走行機体101における長手方向の一端側に左右一対で設けられている。第二車輪102Bは、走行機体101における長手方向の他端側に左右一対で設けられている。草刈装置103は、走行機体101の下部における第一車輪102Aと第二車輪102Bとの間に設けられている。また、走行機体101の一端側部に排出機構104(図13及び図14参照)が備えられ、排出機構104は、草刈装置103によって刈り取られた刈草を排出する。更に、走行機体101の上部に検出装置110が設けられている。検出装置110については後述する。
走行機体101の上部に、送信機107(図13参照)と通信可能なアンテナ108が立設されている。送信機107は、操作者が持ち運びしながら自動走行作業機を人為操作可能なように構成されている。送信機107は、例えば作業者が手元で操作するプロポーショナル方式の送信機による操作であったり、タッチパネル方式の表示画面を有する携帯端末機器による操作であったりしても良い。
図示はしないが、走行機体101に、エンジンEBの動力を、第一車輪102Aと第二車輪102Bに伝達すると共に、草刈装置103に伝達する伝動機構が備えられている。伝動機構は、第一車輪102A及び第二車輪102Bと、草刈装置103と、に対する動力伝達を断続できるように構成されている。エンジンEBの動力が、第一車輪102A及び第二車輪102Bと、草刈装置103と、に伝達されることで、機体を走行させながら草刈作業を行うことができる。第一車輪102Aに第一操向モータ109Aが設けられ、第一車輪102Aは第一操向モータ109Aの駆動力により縦軸芯周りで揺動してステアリング操作自在なように構成されている。また、第二車輪102Bに第二操向モータ109Bが設けられ、第二車輪102Bは第二操向モータ109Bの駆動力により縦軸芯周りで揺動してステアリング操作自在なように構成されている。図11及び図12に示されているように、第一車輪102A及び第二車輪102Bは夫々、直進用姿勢、右向き揺動姿勢、並びに、左向き揺動姿勢の夫々に向き変更操作可能である。
〔排出機構〕
図13及び図14に示されているように、排出機構104は、走行機体101の左右何れかの側部に突出する状態で設けられている。なお、図13において、点描化された領域GNBは、草刈対象領域のうち、未刈領域を示している。後述する図16乃至図22において示された領域GNBも同様である。本実施形態では、排出機構104は、走行機体101のうち、刈取後の地面の位置する側に設けられている。排出機構104の突出先端部は開口して排出口104aが形成されている。また、排出機構104に、走行機体101の排出口101bと、排出機構104の排出口104aと、に亘って排出経路104bが形成されている。排出経路104bは、排出口104aの位置する側に位置するほど、断面形状が狭く絞られる先絞り形状に形成されている。この形状によって、草刈装置103で切断された刈草が、排出口101bから排出経路104bに入り込み、排出口104aの位置する側の箇所で圧縮されて塊状刈草Gとなる。
図13及び図14に示されているように、排出機構104は、走行機体101の左右何れかの側部に突出する状態で設けられている。なお、図13において、点描化された領域GNBは、草刈対象領域のうち、未刈領域を示している。後述する図16乃至図22において示された領域GNBも同様である。本実施形態では、排出機構104は、走行機体101のうち、刈取後の地面の位置する側に設けられている。排出機構104の突出先端部は開口して排出口104aが形成されている。また、排出機構104に、走行機体101の排出口101bと、排出機構104の排出口104aと、に亘って排出経路104bが形成されている。排出経路104bは、排出口104aの位置する側に位置するほど、断面形状が狭く絞られる先絞り形状に形成されている。この形状によって、草刈装置103で切断された刈草が、排出口101bから排出経路104bに入り込み、排出口104aの位置する側の箇所で圧縮されて塊状刈草Gとなる。
排出口104aに、排出口104aを開閉する開閉機構141が設けられている。また、排出機構104のうち、排出口104aの位置する側の箇所に、刈草の圧縮度合いを測定する圧力センサ142(圧力検出手段)が設けられている。開閉機構141は、排出口104aを開放する開放状態と、排出口104aを閉塞する閉塞状態と、に切替自在なように構成されている。圧力センサ142は、例えば予め設定された圧力以上の圧力を受けた時に作動するスイッチであり、圧力センサ142が作動する間、開閉機構141は開放状態となるように構成されている。これにより、先絞り形状に形成された排出経路104bを通過する刈草が、排出口104aから排出される前段階で、更に塊状に圧縮される。なお、開閉機構141は、電動モータによって開閉する構成であっても良いし、電磁スイッチによって開閉する構成であっても良い。また、圧力センサ142は、ロードセルであっても良いし、刈草の圧力が付勢力に抗することによって作動するバネ式のスイッチであっても良い。
本実施形態では、排出機構104は、走行機体101のうち、刈取後の地面の位置する側に設けられている。このため、走行機体101が草刈走行する状態で、刈草は、排出口104aから刈取後の地面に塊状で排出されることによって、刈取後の地面に塊状刈草Gが線形状に配置される。つまり、塊状刈草Gによって、刈取後の地面に対して、走行機体101の走行軌跡に沿う凸部が連続的に形成される。塊状刈草Gは、開閉機構141における開放状態と閉塞状態との切替えによって、刈取後の地面に断続的に配置される場合もある。この場合、走行機体101の走行軌跡に沿う凸部も、断続的に形成される。このように、刈取後の地面に対して、塊状刈草Gの凸部による一列の線形状が、連続的又は断続的に形成される。
〔自動走行制御装置〕
図15に示されているように、予め設定された走行経路に沿って自動走行草刈機の自動走行を可能にするための制御ユニットUBが、例えばマイクロコンピュータに組み込まれた状態で、自動走行草刈機に備えられている。制御ユニットUBに、走行モード判定部1111と、目標ライン算出部112と、自動走行制御装置113と、デコード部114と、が備えられている。目標ライン算出部112は、走行機体101が自動走行を行うための目標ラインLBを設定する。自動走行制御装置113は、目標ライン算出部112が設定する目標ラインLBと平行に走行機体101が走行するように構成されている。デコード部114は、検出装置110によって検出される検出信号を、目標ライン算出部112が目標ラインLBを算出するためのデータに変換する。また、制御ユニットUBは、走行モード判定部111の判定によって、自動走行モードと手動走行モードとに切替可能なように構成されている。手動走行モードでは、送信機107の人為操作に基づいて自動走行作業機が草刈走行等を行うため、自動走行制御装置113は無効化されるが、自動走行制御装置113と連動して目標ライン算出部112も無効化される構成であっても良い。
図15に示されているように、予め設定された走行経路に沿って自動走行草刈機の自動走行を可能にするための制御ユニットUBが、例えばマイクロコンピュータに組み込まれた状態で、自動走行草刈機に備えられている。制御ユニットUBに、走行モード判定部1111と、目標ライン算出部112と、自動走行制御装置113と、デコード部114と、が備えられている。目標ライン算出部112は、走行機体101が自動走行を行うための目標ラインLBを設定する。自動走行制御装置113は、目標ライン算出部112が設定する目標ラインLBと平行に走行機体101が走行するように構成されている。デコード部114は、検出装置110によって検出される検出信号を、目標ライン算出部112が目標ラインLBを算出するためのデータに変換する。また、制御ユニットUBは、走行モード判定部111の判定によって、自動走行モードと手動走行モードとに切替可能なように構成されている。手動走行モードでは、送信機107の人為操作に基づいて自動走行作業機が草刈走行等を行うため、自動走行制御装置113は無効化されるが、自動走行制御装置113と連動して目標ライン算出部112も無効化される構成であっても良い。
自動走行制御装置113の出力対象は、走行制御モータ115と、前後進モータ116と、第一操向モータ109Aと、第二操向モータ109Bと、である。走行制御モータ115は、エンジンEBに対する燃料供給量を調整するアクセル120と、第一車輪102A及び第二車輪102Bを制動するブレーキ121と、を操作する。前後進モータ116は、正逆転切換機構122を切り換え操作する。図示はしないが、正逆転切換機構122は、第一車輪102A及び第二車輪102BにエンジンEBの動力を伝達する伝動装置に備えられ、エンジンEBの動力を正転方向と逆転方向とに切換えるためのギア機構である。第一操向モータ109Aは第一車輪102Aを操向操作し、第二操向モータ109Bは第二車輪102Bを操向操作する。走行制御モータ115と、前後進モータ116と、の夫々は、電動モータであっても良いし、電磁スイッチであっても良い。
走行機体101に、送信機107から無線送信される操作信号を、アンテナ108を介して受信可能な通信部117が備えられている。通信部117の受信情報は制御ユニットUBに入力される。
自動走行草刈機の状態は、通信部117から機体外部の機器に送信可能であり、例えば携帯端末機器の表示画面に、自動走行草刈機の現在位置や状態を表示することも可能である。自動走行草刈機の状態は、例えば、草刈走行の車速であったり、燃料の残量であったり、自動走行草刈機に搭載された各種機器の不具合を示すものであったりしても良い。
例えば図14に示されているように、検出装置110は、走行機体101の上部に設けられている。検出装置110は、例えば、LRF(Laser Range Finder)であって、例えばレーザー光のような空中伝搬する信号を検出信号として送信する。検出信号が検出対象物に照射されると、検出信号は検出対象物の表面で反射する。そして、検出装置110は、検出対象物の表面で反射した検出信号を、反射信号として取得する。つまり、検出装置110は、検出装置110の検出用範囲に向けて検出信号を送信し、かつ、検出信号に対する反射信号を取得する。そして、検出装置110は、検出信号を送信してから反射信号を取得するまでの時間に基づいて、検出装置110と検出対象物との距離を算出するように構成されている。検出装置110が検出信号を送信し、かつ、反射信号を取得する処理を、以下「走査」と称する。
検出装置110は、塊状刈草Gによって形成された凸部の線形状を走査によって検出する。そして、走査によって検出された距離と、検出装置110の走査角度と、に基づいて、凸部の対地高さがデコード部114によって演算される。これにより、刈取後の地面と塊状刈草Gとを判別可能なように構成されている。
目標ライン算出部112は、検出装置110の走査によって検出された塊状刈草Gを認識し、目標ラインLBを算出する。つまり、目標ライン算出部112は、塊状刈草Gを目標物とし、塊状刈草Gの線形状に基づいて目標ラインLBを算出する。なお、塊状刈草Gが断続的に配置され、塊状刈草Gの線形状が断続的である場合、目標ライン算出部112は、断続的な線形状を近似線で線形補完することによって、目標ラインLBを算出する。
図16に示されているように、本実施形態では、まず、草刈対象領域において、手動走行モードで草刈走行を行い、刈取後の地面を確保する。次に、草刈走行を行いながらティーチング走行を行って刈取後の地面に塊状刈草G(1)を線状又は点状に配置する。これにより、刈取後の地面に塊状刈草G(1)が一列に配置され、夫々の塊状刈草G(1)は、目標ライン算出部112が目標ラインLB(1)を設定するための目標物となる。そして、塊状刈草G(1)によって一列の線形状が形成され、検出装置110が夫々の塊状刈草G(1)を走査によって検出可能になると共に、目標ライン算出部112による目標ラインLB(1)の算出が可能になる。本実施形態は、塊状刈草G(1)が点状に配置され、一列の線形状が断続的に形成されているが、塊状刈草G(1)が線状に配置され、一列の線形状が連続的に形成されていても良い。
排出機構104は、走行機体101のうち、刈取後の地面の位置する側の側部に設けられている。このため、ティーチング走行の完了後も、排出機構104が、刈取後の地面の位置する側から、塊状刈草Gを常に排出可能なように草刈走行する必要がある。このことから、排出機構104が未刈の領域GNBの位置する側に向かないように、走行機体101を旋回させない草刈走行を行う必要がある。即ち、草刈走行は、走行機体101のスイッチバック、即ち、走行機体101の前後進を繰り返しながら行われる。このことから、塊状刈草G(1)のうち、ティーチング走行によって刈取後の地面に配置された塊状刈草G(1)の終端箇所が、目標ライン算出部112によって算出される目標ラインLBの開始点となる。また、塊状刈草G(1)のうち、ティーチング走行によって刈取後の地面に配置された塊状刈草G(1)の始端が、目標ライン算出部112によって算出される目標ラインLBの終了点となる。
ティーチング走行の完了後、自動走行モードに切換えることにより、草刈走行が自動的に行われるが、手動走行モードから自動走行モードへの切換は、人為操作によって行われても良いし、自動的に行われても良い。自動走行モードへの切替後、図17に示されているように、検出装置110は、周期的に走査を継続してティーチング走行時に排出された塊状刈草G(1)を捕捉し、目標ライン算出部112は、検出装置110によって捕捉された塊状刈草G(1)の近似線に基づいて目標ラインLB(1)の算出を継続する。つまり、目標ライン算出部112は、目標ラインLB(1)の算出を継続することによって目標ラインLB(1)の更新を継続する。このとき、目標ライン算出部112は、周期的に算出された過去分の近似線の移動平均に基づいて目標ラインLB(1)を算出するように構成されていても良い。
自動走行制御装置113は、検出装置110の走査に基づいて、目標ラインLB(1)と走行機体101との距離を算出する。そして、走行機体101が目標ラインLB(1)に対して予め設定された距離Pdを保持するように、自動走行制御装置113は、走行制御モータ115と、前後進モータ116と、第一操向モータ109Aと、第二操向モータ109Bと、に制御信号を出力する。走行機体101は、ティーチング走行時の草刈走行の走行軌跡に隣接する状態で、塊状刈草G(1)の位置する側と反対側に位置する。このことから、距離Pdは、草刈装置103における作業幅の中心と、目標ラインLB(1)と、が草刈走行の作業幅の1.5倍程度となるように設定される。なお、ティーチング走行の完了前後の草刈走行で刈残しが生じないように、目標ラインLB(1)に沿う草刈走行の作業幅と、ティーチング走行時の草刈走行の作業幅と、が部分的に重複しても良い。つまり、距離Pdは適宜変更可能である。
目標ラインLB(1)に沿う草刈走行の間、排出口104aから新たな塊状刈草G(2)が排出され、新たな塊状刈草G(2)が、刈取後の地面に連続的又は断続的に配置されて、目標ライン算出部112が次の目標ラインLB(2)を算出するための新たな目標物となる。新たな塊状刈草G(2)は、ティーチング走行時に排出された塊状刈草G(1)よりも、走行機体101の位置する側に位置ずれして配置されるため、新たな塊状刈草G(2)の凸部によって、新たな一列の線形状が刈取後の地面に形成される。
図18に示されているように、走行機体101が、目標ラインLB(1)に沿う草刈走行を完了すると、目標ライン算出部112は、塊状刈草G(2)の近似線に基づいて次の目標ラインLB(2)を継続的に算出する。このとき、自動走行モードは継続されても良いし、手動走行モードに切換えられても良い。そして、正逆転切換機構122の切換え操作によって走行機体101の前進方向は反転し、次の目標ラインLB(2)沿って自動走行制御装置113による自動走行が行われる。検出装置110は、周期的に走査を継続してティーチング走行時に排出された塊状刈草G(2)を捕捉し、目標ライン算出部112は、検出装置110によって捕捉された塊状刈草G(2)の近似線に基づいて目標ラインLB(2)の算出を継続する。つまり、目標ライン算出部112は、目標ラインLB(1)に沿う自動走行の場合と同様に、目標ラインLB(2)の算出を継続することによって目標ラインLB(2)の更新を継続する。
自動走行制御装置113は、検出装置110の走査に基づいて、目標ラインLB(2)と走行機体101との距離を算出する。そして、走行機体101が目標ラインLB(2)に対して予め設定された距離Pdを保持するように、自動走行制御装置113は、走行制御モータ115と、前後進モータ116と、第一操向モータ109Aと、第二操向モータ109Bと、に制御信号を出力する。
目標ラインLB(2)に沿う草刈走行の間、排出口104aから新たな塊状刈草G(3)が排出され、新たな塊状刈草G(3)が、刈取後の地面に連続的又は断続的に配置される。つまり、塊状刈草G(2)に隣接する状態で、新たな塊状刈草G(3)が排出され、新たな一列の線形状が刈取後の地面に形成される。塊状刈草G(3)は、目標ライン算出部112が次の目標ラインLB(3)を算出するための新たな目標物となる。このように、自動走行草刈機は、線形状に配置された塊状刈草Gを基準に、自動走行の経路としての目標ラインLBを算出するように構成されている。
送信機107が、例えば携帯端末機器等であって表示画面を有する場合、送信機107は、通信部117を介して、目標ラインLBや走行機体101の位置ずれを表示画面に表示可能なように構成されていても良い。
〔第2実施形態の別実施形態〕
本発明は、上記の実施形態に例示された構成に限定されるものではなく、以下、本発明の代表的な別実施形態を例示する。
本発明は、上記の実施形態に例示された構成に限定されるものではなく、以下、本発明の代表的な別実施形態を例示する。
〔1〕上述した実施形態において、目標ライン算出部112は、刈取後の地面に一列に並ぶ状態で排出された塊状刈草Gに基づいて目標ラインLBを算出されるように構成されているが、上述した実施形態に限定されない。例えば、図19に示されているように、何れかの塊状刈草G(1)が風等によって位置ずれしたり、崩れたりして、塊状刈草G(1)が必ずしも一列に並ばない場合がある。この場合であっても、目標ライン算出部112は、夫々の塊状刈草G(1)の近似直線に基づいて目標ラインLB(1)を算出するように構成されていても良い。また、塊状刈草G(1)の当該位置ずれが経時的に変化する場合も考慮して、目標ライン算出部112は、周期的に算出された過去分の近似直線の移動平均に基づいて目標ラインLBを算出するように構成されていても良い。
〔2〕排出機構104による塊状刈草Gの排出の態様は、適宜変更可能である。例えば、図20に示されているように、塊状刈草Gが、グリッド状に配置されるように排出され、目標ライン算出部112は、水平方向の目標ラインLBHと、縦方向の目標ラインLBVと、を算出する構成であっても良い。この構成によって、自動走行制御装置113は、二方向の目標ラインLBH,LBVの何れかに沿って走行機体101を自動走行させることができる。
〔3〕上述した実施形態において、走行機体101の上部に検出装置110が設けられているが、走行機体101の側部に検出装置110が設けられる構成であっても良い。例えば、図21に示されているように、検出装置110は、走行機体101のうち、排出機構104の位置する側の側部、即ち、刈取後の地面の位置する側の側部に設けられる構成であっても良い。この構成であれば、検出装置110の真下に刈草がある場合であっても、検出装置110が刈草を検出できる。このため、排出機構104から排出された直後の塊状刈草Gを、検出装置110が捕捉可能になる。
〔4〕上述した実施形態において、目標ライン算出部112は直線状に一列に排出された塊状刈草Gに基づいて直線状の目標ラインLBを算出するように構成されているが、上述した実施形態に限定されない。例えば、図22に示されているように、ティーチング走行において走行機体101が円弧状に走行して塊状刈草G(1)~G(3)が円弧状に排出され、検出装置110によって捕捉される夫々の塊状刈草Gが円弧状となり、目標ライン算出部112が、夫々の塊状刈草Gの近似曲線に基づいて曲線状の目標ラインLB(1)~LB(3)を算出するように構成されていても良い。
〔5〕上述した実施形態において、目標ライン算出部112は、最初の目標ラインLBの算出に、ティーチング走行において排出機構104から排出された塊状刈草Gを用いるように構成されているが、上述した実施形態に限定されない。例えば、目標ライン算出部112は、塊状刈草Gに代えて、地面等に予め設けられた目標物を、最初の目標ラインLBの算出に用いる構成であっても良い。当該目標物として、例えば、ロープであったり、ブロック塀であったり、土留めや擁壁であったり、フェンスやガードレールであったり、一列に配置されたロードコーンであったり、当該ロードコーンの間に亘るコーンバーであったりしても良い。また、等間隔に植えられた樹木等も、当該目標物として例示される。
〔6〕上述した実施形態において、検出装置110は、周期的に走査を継続してティーチング走行時に排出された一列の塊状刈草Gを捕捉し、目標ライン算出部112は、検出装置110によって捕捉された一列の塊状刈草Gの近似線に基づいて目標ラインLBの算出を継続するように構成されているが、上述した実施形態に限定されない。例えば、目標ライン算出部112は、一列の塊状刈草Gの近似線に基づいて目標ラインLBの算出を一度だけ行う構成であっても良い。この場合、目標ラインLBの始端から終端に亘る方位に沿って走行機体101が走行するように、例えば慣性センサ(不図示)に基づいて走行制御される構成であっても良い。
〔7〕上述した実施形態において、排出機構104に開閉機構141が設けられているが、開閉機構141は必ずしも必要ではなく、排出機構104に開閉機構141が設けられない構成であっても良い。
〔8〕上述した実施形態における検出装置110は、LRFでなくても良く、例えばカメラ等の画像センサであっても良い。
〔9〕上記実施形態では、自動走行草刈機が草刈りを行いながら自動走行するとして説明したが、自動走行草刈機を例えば薬剤散布車など他の作業車両として用いることも可能である。
[第3実施形態]
以下、本発明の第3実施形態を図面の記載に基づいて説明する。
〔草刈機の基本構成〕
本発明による草刈機について、その実施形態を図面に基づいて説明する。
図23に示されているように、本実施形態に例示される草刈機に、走行機体201と、第一車輪202Aと、第二車輪202Bと、草刈装置203と、が備えられている。第一車輪202Aは、走行機体201における長手方向の一端側に左右一対で設けられている。第二車輪202Bは、走行機体201における長手方向の他端側に左右一対で設けられている。草刈装置203は、走行機体201の下部における第一車輪202Aと第二車輪202Bとの間に設けられている。
以下、本発明の第3実施形態を図面の記載に基づいて説明する。
〔草刈機の基本構成〕
本発明による草刈機について、その実施形態を図面に基づいて説明する。
図23に示されているように、本実施形態に例示される草刈機に、走行機体201と、第一車輪202Aと、第二車輪202Bと、草刈装置203と、が備えられている。第一車輪202Aは、走行機体201における長手方向の一端側に左右一対で設けられている。第二車輪202Bは、走行機体201における長手方向の他端側に左右一対で設けられている。草刈装置203は、走行機体201の下部における第一車輪202Aと第二車輪202Bとの間に設けられている。
走行機体201の上部に、送信機207(図26参照)と通信可能なアンテナ208が立設されている。送信機207は、操作者が持ち運びしながら草刈機を人為操作可能なように構成されている。送信機207は、例えば作業者が手元で操作するプロポーショナル方式のコントローラによる操作であったり、タッチパネル方式の表示画面を有する携帯端末機器による操作であったりしても良い。
図示はしないが、走行機体201に、エンジンECの動力を、第一車輪202Aと第二車輪202Bに伝達すると共に、草刈装置203に伝達する伝動機構が備えられている。伝動機構は、第一車輪202A及び第二車輪202Bと、草刈装置203と、に対する動力伝達を断続できるように構成されている。エンジンECの動力が、第一車輪202A及び第二車輪202Bと、草刈装置203と、に伝達されることで、機体を走行させながら草刈作業を行うことができる。第一車輪202Aに第一操向モータ209Aが設けられ、第一車輪202Aは第一操向モータ209Aの駆動力により縦軸芯周りで揺動してステアリング操作自在なように構成されている。また、第二車輪202Bに第二操向モータ209Bが設けられ、第二車輪202Bは第二操向モータ209Bの駆動力により縦軸芯周りで揺動してステアリング操作自在なように構成されている。図24及び図25に示されているように、第一車輪202A及び第二車輪202Bは夫々、直進用姿勢、右向き揺動姿勢、並びに、左向き揺動姿勢の夫々に向き変更操作可能である。
走行機体201の前上部又は後上部に距離センサ210が備えられている。距離センサ210は、例えば、LRF(Laser Range Finder)であって、例えばレーザー光や超音波のような空中伝搬する信号を検出信号として送信する。検出信号が検出対象物に照射されると、検出信号は検出対象物の表面で反射する。そして、距離センサ210は、検出対象物の表面で反射した検出信号を、反射信号として取得する。つまり、距離センサ210は、距離センサ210の検出用範囲に向けて検出信号を送信し、かつ、検出信号に対する反射信号を取得する。そして、距離センサ210は、検出信号を送信してから反射信号を取得するまでの時間に基づいて、距離センサ210と検出対象物との距離を算出するように構成されている。距離センサ210が検出信号を送信し、かつ、反射信号を取得する処理を、以下「走査」と称する。
傾斜角度検出部211が走行機体201に備えられ、傾斜角度検出部211は、例えば慣性センサの一例であるIMU(Inertial Measurement Unit)であって、走行機体201の傾きを検出して検出傾斜角度ImCを出力する。
〔制御構成について〕
図26に示されているように、草刈機の自動走行を可能にするための制御ユニットUCが、例えばマイクロコンピュータに組み込まれた状態で、草刈機に備えられている。制御ユニットUCに、デコード制御部212と、走行モード判定部213と、物体検出部214と、目標距離算出部215と、走行指示部216と、が備えられている。デコード制御部212は、距離センサ210の走査によって算出された距離と、当該算出時の走査角度と、に基づいて、距離センサ210に対する機体左右方向の水平距離と、距離センサ210に対する機体上下方向の垂直距離と、を座標位置情報として算出する。制御ユニットUCは、自動走行モードと手動走行モードとに切替可能なように構成され、走行モード判定部213の判定によって、自動走行モードと手動走行モードとの何れであるかが判定される。
図26に示されているように、草刈機の自動走行を可能にするための制御ユニットUCが、例えばマイクロコンピュータに組み込まれた状態で、草刈機に備えられている。制御ユニットUCに、デコード制御部212と、走行モード判定部213と、物体検出部214と、目標距離算出部215と、走行指示部216と、が備えられている。デコード制御部212は、距離センサ210の走査によって算出された距離と、当該算出時の走査角度と、に基づいて、距離センサ210に対する機体左右方向の水平距離と、距離センサ210に対する機体上下方向の垂直距離と、を座標位置情報として算出する。制御ユニットUCは、自動走行モードと手動走行モードとに切替可能なように構成され、走行モード判定部213の判定によって、自動走行モードと手動走行モードとの何れであるかが判定される。
物体検出部214は、詳細について後述するが、座標位置情報に基づいて刈取後の地面を近似直線で表す地面基準線LGと、刈取前の草のラインを近似直線で表す草基準線LKと、を生成する。物体検出部214に記憶部214aが備えられ、記憶部214aは、例えばRAM(Random Access Memory)であって、デコード制御部212によって算出された座標位置情報を経時的に記憶する。地面基準線LG及び草基準線LKの生成は、記憶部214aに記憶された座標位置情報を用いることによって行われる。
目標距離算出部215は、草基準線LKと距離センサ210との離間距離を算出する。また、目標距離算出部215は、走行機体201のうち、距離センサ210の位置する箇所が草基準線LKと離間しながら好適に草刈走行するための目標距離LMを算出する。そして、走行指示部216は、草基準線LKと距離センサ210との離間距離を、目標距離LMに保持するように制御信号を出力する。
走行機体201に、送信機207から無線送信される操作信号を、アンテナ208を介して受信可能な通信部217が備えられている。通信部217の受信情報は制御ユニットUCに入力される。手動走行モードでは、送信機207の人為操作に基づいて草刈走行等が行われる。このため、手動走行モードの状態で、走行指示部216は無効化されるが、走行指示部216と連動して物体検出部214及び目標距離算出部215も無効化される構成であっても良い。
走行指示部216の出力対象は走行制御部Cであり、走行制御部Cに、走行制御モータ218と、前後進モータ219と、第一操向モータ209Aと、第二操向モータ209Bと、が備えられている。走行制御モータ218は、エンジンECに対する燃料供給量を調整するアクセル220と、第一車輪202A及び第二車輪202Bを制動するブレーキ221と、を操作する。前後進モータ219は、正逆転切換機構222を切り換え操作する。図示はしないが、正逆転切換機構222は、第一車輪202A及び第二車輪202BにエンジンECの動力を伝達する伝動装置に備えられ、エンジンECの動力を正転方向と逆転方向とに切換えるためのギア機構である。第一操向モータ209Aは第一車輪202Aを操向操作し、第二操向モータ209Bは第二車輪202Bを操向操作する。走行制御モータ218と、前後進モータ219と、の夫々は、電動モータであっても良いし、電磁スイッチであっても良い。
走行モードが自動走行モードの場合、走行制御部Cは、走行指示部216の指示信号に基づく制御を行う。走行モードが手動走行モードの場合、送信機207の人為操作に基づく操作信号が、通信部217及び走行モード判定部213を介して走行制御部Cに入力され、走行制御部Cは、当該操作信号に基づく制御を行う。
草刈機の状態は、通信部217から機体外部の機器に送信可能であり、例えば携帯端末機器の表示画面に、草刈機の現在位置や状態を表示することも可能である。草刈機の状態は、例えば、草刈走行の車速であったり、燃料の残量であったり、草刈機に搭載された各種機器の不具合を示すものであったりしても良い。
〔未刈草の検出処理〕
図27に示されているように、草刈機が自動走行を伴って草刈作業を行うとき、距離センサ210は走行機体201の前後方向を軸芯に回転しながら走査を行い、地面及び未刈草(図27のGNCで示された領域)の距離センサ210に対する離間距離を取得する。本実施形態では、距離センサ210による走査は、図27で示された反時計回りの回転で、走査角度Ssと走査角度Sfとに亘って270度の走査角度範囲で行われ、走査角度Ss及び走査角度Sfは、機体の真上に対して左右に夫々45度傾斜する。なお、走査角度Ss及び走査角度Sfの傾斜角度は、適宜変更可能であり、夫々同じ傾斜角度でなくても良い。
図27に示されているように、草刈機が自動走行を伴って草刈作業を行うとき、距離センサ210は走行機体201の前後方向を軸芯に回転しながら走査を行い、地面及び未刈草(図27のGNCで示された領域)の距離センサ210に対する離間距離を取得する。本実施形態では、距離センサ210による走査は、図27で示された反時計回りの回転で、走査角度Ssと走査角度Sfとに亘って270度の走査角度範囲で行われ、走査角度Ss及び走査角度Sfは、機体の真上に対して左右に夫々45度傾斜する。なお、走査角度Ss及び走査角度Sfの傾斜角度は、適宜変更可能であり、夫々同じ傾斜角度でなくても良い。
距離センサ210の走査によって、距離センサ210の走査角度毎に、反射信号に基づく距離情報が取得される。デコード制御部212は、例えば三角関数を用いる等の方法によって、この走査角度及び距離情報を、距離センサ210に対する機体左右方向の水平距離と、距離センサ210に対する機体上下方向の垂直距離と、に変換する。これにより、距離センサ210の経時的な走査によって取得された距離情報は、二次元の座標位置情報に逐次変換され、当該座標位置情報の集合は、物体検出部214に備えられる記憶部214aに記憶される。
二次元の座標位置情報の集合は、図28に示されるような波形として表され、この波形は、当該座標位置情報の集合に基づいてプロットされるデジタルの波形である。座標の中心は、距離センサ210の走査角度の回転軸中心である。座標の下側において左右方向に沿う波形は、刈取後の地面を示す地面ラインG1であり、座標の右側において上下方向に沿う波形は、未刈草を示す未刈草ラインG2である。これにより、未刈草ラインG2の地面ラインG1に対する対地高さデータが得られる。
なお、図28では未刈草ラインG2が機体の側部よりも離れた状態で位置しているが、これは例示である。例えば、距離センサ210が走行機体201の前端部に位置する場合、機体前方に未刈草が存在することから、未刈草ラインG2が機体と重複する状態で位置することが考えられる。また、例えば距離センサ210が走行機体201の後端部に位置する場合、未刈草ラインG2が機体の横側部と接する状態で位置することが考えられる。
次に、未刈草を検知するための具体的な手順の例を図29に基づいて説明する。この手順では、走査角度Ssから走査が開始され、地面の走査を経て走査角度Ssで走査が完了するまでの一周期の走査の例を示しており、走査角度Ssから走査角度Ssまでの走査が繰り返し行われる。
距離センサ210による走査が走査角度Ssから開始される(ステップ#1)。距離センサ210の走査角度が回転しながら走査が継続され(ステップ#2)、走査によって取得された距離情報は、走査が行われた時点の走査角度と紐付けられて、デコード制御部212によって二次元の座標位置情報に逐次変換される(ステップ#3)。ステップ#2の処理とステップ#3の処理とは、距離センサ210の走査角度が走査角度Sfに到達するまで継続する。
距離センサ210の走査角度が、刈取後の地面を判定するタイミングの走査角度Sg2(図30参照)に到達し、かつ、地面基準線LGが生成されていない状態であると(ステップ#4:Yes)、刈取後の地面のラインとして識別される地面基準線LGが、物体検出部214によって生成される(ステップ#5)。図30に示されているように、距離センサ210の走査角度Sg1と、距離センサ210の走査角度Sg2との間で対応する座標情報に基づく近似直線として、地面基準線LGが生成される。地面基準線LGから上下方向の距離d1,d2の範囲内にある座標位置情報は地面の座標位置情報(地面データ)として判別される。
走査角度Sg1及び走査角度Sg2は、距離センサ210が走行機体201に対して機体垂直下方を向く走査角度Sbに対して左右対称に傾斜する。本実施形態では、走査角度Sg1及び走査角度Sg2は、走査角度Sbに対して左右に夫々10度傾くように構成されているが、この傾斜角度は適宜変更可能であり、例えば走行機体201の左右幅に亘る傾斜角度であっても良い。また、走査角度Sg1及び走査角度Sg2は、走査角度Sbに対して左右対称でなくても良い。
地面基準線LGから上下方向の距離d1,d2は、例えば夫々十センチメートルに設定されているが、この値は適宜変更可能である。また、距離d1,d2は、同じ値でなくても良い。
地面基準線LGの生成が完了すると、刈取後の地面に対する未刈草の算出傾斜角度θ2が物体検出部214によって算出される(ステップ#6)。刈取後の地面の傾斜角度θ1は、傾斜角度検出部211によって出力される検出傾斜角度ImCに基づいて算出される。傾斜角度θ1は、検出傾斜角度ImCの瞬時測定値であっても良いし、周期的に出力された過去複数個の検出傾斜角度ImCの平均値であっても良い。図31に示されているように、一般的に、未刈草は傾斜地であっても鉛直方向に沿って上方に生えることが知られており、刈取後の地面に対する未刈草の算出傾斜角度θ2は、下記の式で算出される。
算出傾斜角度θ2=90°-θ1
距離センサ210の走査は継続し、物体検出部214は、距離センサ210の走査に基づく座標位置情報が、草の座標位置情報(草データ)であるかどうかを判定する(ステップ#7)。本実施形態では、地面基準線LGから上下方向の距離d1,d2の範囲内にある座標位置情報は、地面データとして判別される。このため、物体検出部214は、距離d1,d2の範囲から外れた座標位置情報を、草データとして判定する。
誤検出を防止するため、草データが予め設定された個数に亘って、連続して検出されるかどうかが、物体検出部214によって判定される(ステップ#8)。草データが予め設定された個数に亘って、連続して検出されると(ステップ#8:Yes)、物体検出部214は、当該草データに基づいて草候補線Lcを生成する(ステップ#9)。草候補線Lcの生成の可否を判定する連続検出個数は、天候や季節や未刈草の種類に対応して適宜変更可能である。距離センサ210の走査角度が走査角度Sfに到達するまで、物体検出部214は、草候補線Lcを複数生成する。図32において、草候補線Lcは、地面基準線LGの位置する側に最も近い草候補線Lc(1)から、地面基準線LGの位置する側から最も遠い草候補線Lc(4)まで、四個の草候補線Lcが生成された状態が示されている。物体検出部214が草候補線Lcを生成する個数は、適宜変更可能である。
距離センサ210の走査角度が走査角度Sg2に到達すると(ステップ#10:Yes)、距離センサ210の走査が完了する。その後、物体検出部214は、ステップ#10の処理とステップ#11との処理を繰り返す。つまり、夫々の草候補線Lcの、地面基準線LGに対する傾斜角度(以下、「相対角度θ」と称する)を算出する(ステップ#11)。そして、物体検出部214は相対角度θと算出傾斜角度θ2とを比較する(ステップ#12)。相対角度θが、算出傾斜角度θ2から予め設定された範囲内であれば(ステップ#12:一致判定)、物体検出部214は、該当する草候補線Lcを草基準線LKして確定する(ステップ#13)。図33において、草候補線Lc(2)に基づく草基準線LKが示されている。この場合、地面基準線LGに対する草候補線Lc(2)の相対角度θが、算出傾斜角度θ2から予め設定された範囲内に収まっていることが、物体検出部214によって判定され、草候補線Lcが、草基準線LKして確定する。
このとき、物体検出部214は、複数の草候補線Lcのうち、算出傾斜角度θ2から予め設定された範囲内に相対角度θが収まっていることが最初に判定された草候補線Lcを、草基準線LKして確定する構成であっても良い。また、物体検出部214は、全ての草候補線Lcの地面基準線LGに対する相対角度θを算出し、算出傾斜角度θ2に最も近似する相対角度θを有する草候補線Lcを、草基準線LKして確定する構成であっても良い。
草基準線LKの確定後、目標距離算出部215は、地面基準線LGと草基準線LKとの交点Sを算出する。そして、交点Sと距離センサ210との離間距離を算出し、交点Sと走行機体201との離間距離のうち、走行機体201の草刈走行に好適な目標距離LMを算出する(ステップ#14)。走行機体201の草刈走行に好適な目標距離LMは、地面の傾斜角度や未刈草の種類や高さ、走行機体201における距離センサ210の取付位置、走行機体201の前進方向等に基づいて決定できる。
このように、距離センサ210の走査角度が一回転する毎に、ステップ#1乃至ステップ#14の処理が周期的に行われる。また、目標距離LMは、毎回のばらつきを抑制するため、周期的に算出された過去複数個の目標距離の移動平均に基づいて目標距離LMを算出するように構成されていても良い。
〔第3実施形態の別実施形態〕
本発明は、上述の実施形態に例示された構成に限定されるものではなく、以下、本発明の代表的な別実施形態を例示する。
本発明は、上述の実施形態に例示された構成に限定されるものではなく、以下、本発明の代表的な別実施形態を例示する。
〔1〕上述した実施形態において、物体検出部214は、距離センサ210の走査角度が走査角度Sfに到達するまで、草候補線Lcを複数生成するように構成されているが、上述した実施形態に限定されない。例えば、草データの地面基準線LGに対する対地高さが、予め設定された高さよりも高い場合、物体検出部214は、当該草データに基づいて草候補線Lcを生成しないように構成されていても良い。未刈草の上端箇所は、風等に揺れやすいことから、この構成によって、風等の外乱による草の誤検出を防止できる。
〔2〕上述した実施形態において、物体検出部214は、草データに基づいて草候補線Lcを生成するように構成されているが、上述した実施形態に限定されない。例えば、図34に示されているように、草データが予め設定された個数に亘って、連続して検出されると、物体検出部214は、当該草データは草基準線LKを生成するための候補データKcとして複数記憶される構成であっても良い。つまり、候補データKcは二次元の座標位置情報の集合であり、距離センサ210の走査角度が走査角度Sfに到達するまで、草基準線LKの候補データKcが複数記憶される。なお、候補データKcの記憶の可否を判定する連続検出個数は、天候や季節や未刈草の種類に対応して適宜変更可能である。複数の候補データKcの組合せに基づいて、近似直線である草候補線Lcを生成する構成であっても良い。
例えば、図34において、候補データKc(1)~Kc(6)が記憶されている。草候補線Lc(1)は候補データKc(1)及び候補データKc(2)の組合せに基づいて生成されている。草候補線Lc(2)は候補データKc(2)及び候補データKc(3)の組合せに基づいて生成されている。草候補線Lc(3)~Lc(5)も、草候補線Lc(1)及び草候補線Lc(2)と同様のパターンで生成されている。そして、夫々の草候補線Lcにおいて地面基準線LGに対する相対角度θを算出し、相対角度θが算出傾斜角度θ2から予め設定された範囲内であれば、当該草候補線Lcを草基準線LKとして確定する構成であっても良い。草候補線Lcの生成において候補データKcの組合せは適宜変更可能であり、例えば、相対角度θが算出傾斜角度θ2から予め設定された範囲内でなければ、複数の候補データKcの組合せをやり直し、新たな組合せに基づいて草候補線Lcを生成する構成であっても良い。
〔3〕上述した実施形態において、距離センサ210は走行機体201の前上部又は後上部に備えられているが、上述した実施形態に限定されない。例えば、距離センサ210は、図35に示されているように、走行機体201の前上部に設けられる距離センサ210aと、走行機体201の後上部に設けられる距離センサ210bと、の二箇所に備えられる構成であっても良い。図35のGNCは未刈草である。また、距離センサ210a及び距離センサ210bが、走行機体201の左右方向側端部に設けられる構成であっても良い。草刈走行が行われる前の地面と、未刈草GNCと、が走行機体201の前部に設けられた距離センサ210aによって走査される。また、草刈走行が行われた後の地面と、未刈草GNCと、が走行機体201の後部に設けられた距離センサ210bによって走査される。この構成であれば、走行機体201の前後で、夫々異なる目標距離LMを独立して算出可能となるため、走行指示部216が出力する指示信号を、一層好適なものにできる。また、図35における草刈走行のときに、距離センサ210aによって、例えば石や杭が検知された場合、草刈装置203の回転を停止する等の対処が可能になる。
〔4〕上述した実施形態において、図29に示されたステップ#1からステップ#14までの手順で目標距離LMが算出されるように構成されているが、上述した実施形態に限定されない。例えば、走査角度Ssから走査角度Sfまで270度に亘る走査が行われた後に(ステップ#1~ステップ#3)、地面基準線LGの生成(ステップ#5)と算出傾斜角度θ2の算出(ステップ#6)とが行われ、その後に草データの検出に基づく草候補線Lcの生成(ステップ#7~ステップ#9)と、相対角度θの算出処理(ステップ#11)から目標距離LMの算出(ステップ#14)までの処理が行われる構成であっても良い。この構成であれば、例えば走査角度が走査角度Sfから走査角度Ssに向けて逆方向に回転する場合にも適用可能である。
〔5〕上述した実施形態において、地面基準線LGと、草候補線Lcと、草基準線LKと、は夫々近似直線となっているが、上述した実施形態に限定されない。例えば、地面基準線LGと、草候補線Lcと、草基準線LKと、は夫々近似曲線であっても良い。
〔6〕上述の実施形態では、草刈機が草刈りを行いながら自動走行するとして説明したが、例えば、手動操作による草刈走行の操向操作をアシストする草刈機であっても良い。また、草刈機以外に、芝刈機やモアであっても良い。
[第4実施形態]
以下、本発明の第4実施形態を図面の記載に基づいて説明する。
〔草刈機自動走行システムの基本構成〕
本発明による草刈機自動走行システムについて、その実施形態を図面に基づいて説明する。
図36乃至図38に示されているように、本実施形態における草刈機自動走行システムに、物体検出部301と、取付治具302と、草刈機303と、が備えられている。物体検出部301は法面の上端部に設置され、法面を走行する草刈機303の位置を検出するように構成されている。物体検出部301は、取付治具302に取り付けて使用される。物体検出部301に、距離センサ311と、回転制御機構312と、取付部313と、が備えられている。物体検出部301の内部に、例えばマイクロコンピュータに組み込まれた状態で制御ユニットが備えられている。距離センサ311は物体検出部301の上部に設けられている。回転制御機構312は多自由度で回動可能であり、物体検出部301の下部に設けられている。取付部313は回転制御機構312の下端に設けられ、取付治具302に対して物体検出部301を取り付けるための取付箇所である。
以下、本発明の第4実施形態を図面の記載に基づいて説明する。
〔草刈機自動走行システムの基本構成〕
本発明による草刈機自動走行システムについて、その実施形態を図面に基づいて説明する。
図36乃至図38に示されているように、本実施形態における草刈機自動走行システムに、物体検出部301と、取付治具302と、草刈機303と、が備えられている。物体検出部301は法面の上端部に設置され、法面を走行する草刈機303の位置を検出するように構成されている。物体検出部301は、取付治具302に取り付けて使用される。物体検出部301に、距離センサ311と、回転制御機構312と、取付部313と、が備えられている。物体検出部301の内部に、例えばマイクロコンピュータに組み込まれた状態で制御ユニットが備えられている。距離センサ311は物体検出部301の上部に設けられている。回転制御機構312は多自由度で回動可能であり、物体検出部301の下部に設けられている。取付部313は回転制御機構312の下端に設けられ、取付治具302に対して物体検出部301を取り付けるための取付箇所である。
取付治具302は、例えば法面の最上端に固定される状態で設置される。取付治具302の上端部に物体検出部301の取付部313が着脱自在な状態で係止されることにより、取付治具302に物体検出部301が取り付けられて定点位置に固定される。なお、取付部313の着脱構造や着脱方法は公知の構造や方法を適宜選択可能である。取付治具302に、例えばRFID(Radio Frequency Identifier)タグ等の記憶部321が設けられ、物体検出部301に備えられた制御ユニットとデータの通信によって、草刈機303が草刈走行するためのエリア情報や草刈機303の作業履歴情報等が、記憶部321に記憶される。
物体検出部301が取付治具302に装着された時、物体検出部301は取付治具302の記憶部321にアクセスし、記憶部321にエリア情報や作業履歴情報が有るかどうかを確認する。記憶部321にエリア情報や作業履歴情報が有れば、例えば物体検出部301に備えられた不図示のRAM(Random Access Memory)に、当該エリア情報や当該作業履歴情報が読み込まれる。また、自動草刈走行時のエリア情報及び作業履歴情報が更新されたとき、これらの更新された情報が、物体検出部301のRAMから記憶部321に記憶される。これにより、次回の自動草刈走行時に、物体検出部301が同一のものでなくても、最新のエリア情報及び作業履歴情報が、当該異なる物体検出部301に読み出し可能となる。
草刈機303は、物体検出部301から送信される指示信号Tcに基づいて、法面上に予め設定された走行経路としてのライン走行経路LDに沿って、自動的に未刈草GNを刈り取りながら走行するように構成されている。草刈機303に、走行機体331と、第一車輪332Aと、第二車輪332Bと、草刈装置333と、反射部334と、が備えられている。第一車輪332Aは、走行機体331における長手方向の一端側に左右一対で設けられている。第二車輪332Bは、走行機体331における長手方向の他端側に左右一対で設けられている。草刈装置333は、走行機体331の下部における第一車輪332Aと第二車輪332Bとの間に設けられている。草刈機303の上部に、送信機304(図39参照)や物体検出部301と通信可能なアンテナ335が立設されている。
図示はしないが、走行機体331に、エンジンEDの動力を、第一車輪332Aと第二車輪332Bに伝達すると共に、草刈装置333に伝達する伝動機構が備えられている。伝動機構は、第一車輪332A及び第二車輪332Bと、草刈装置333と、に対する動力伝達を断続できるように構成されている。エンジンEDの動力が、第一車輪332A及び第二車輪332Bと、草刈装置333と、に伝達されることで、機体を走行させながら草刈作業を行うことができる。第一車輪332Aに第一操向モータ32Cが設けられ、第一車輪332Aは第一操向モータ32Cの駆動力により縦軸芯周りで揺動してステアリング操作自在なように構成されている。また、第二車輪332Bに第二操向モータ332Dが設けられ、第二車輪332Bは第二操向モータ332Dの駆動力により縦軸芯周りで揺動してステアリング操作自在なように構成されている。図39及び図40に示されているように、第一車輪332A及び第二車輪332Bは夫々、直進用姿勢、右向き揺動姿勢、並びに、左向き揺動姿勢の夫々に向き変更操作可能である。
距離センサ311は、例えば、LRF(Laser Range Finder)やLIDAR(Light Detection and Ranging)であって、例えばレーザー光や超音波や電波のような空中伝搬する信号を検出信号TWとして送信する。検出信号TWが検出対象物に照射されると、検出信号TWは検出対象物の表面で反射する。そして、距離センサ311は、検出対象物の表面で反射した検出信号TWを、反射信号RWとして取得する。つまり、距離センサ311は、距離センサ311の検出用範囲に向けて検出信号TWを送信し、かつ、検出信号TWに対する反射信号RWを取得する。そして、距離センサ311は、検出信号TWを送信してから反射信号RWを取得するまでの時間に基づいて、距離センサ311と検出対象物との距離を算出するように構成されている。距離センサ311が検出信号TWを送信し、かつ、反射信号RWを取得する処理を、以下「走査」と称する。
図36に示されているように、距離センサ311は、平面視で、数十メートルに亘る半径の範囲で、例えば270度の走査角度で走査可能なように構成されている。このことから、取付治具302が複数設置される場合、距離センサ311の走査範囲に対応して間隔を空けて設置される。
反射部334は、距離センサ311によって照射される検出信号TWを反射する被検知体である。反射部334は、検出信号TWが入斜した方向と同じ方向に反射信号RWを反射するように構成されている。つまり、反射部334は、どの角度から距離センサ311の検出信号TWを受けても、距離センサ311に向けて反射信号RWを反射するように構成されている。このため、反射部334は、草刈機303の左右横側面のうち、距離センサ311の位置する側の側面に設けられ、反射部334と距離センサ311とは常に対向する。この構成によって、反射部334は、他の物体よりも強い強度で反射信号RWを距離センサ311に反射するように構成されている。このため、距離センサ311は、予め設定された強度の閾値よりも強い強度の反射信号RWを検知することによって、反射部334を検出するように構成されている。なお、反射部334は、草刈機303の左右横側面の片側のみならず、両側に設けられていても良い。
〔制御構成について〕
図41に示されているように、草刈機303の自動草刈走行は、物体検出部301の制御ユニットと、草刈機303の制御ユニットと、の連係処理に基づいて行われる。物体検出部301の制御ユニットに、通信部315と、走行経路設定部316と、制御指示部317と、が備えられている。通信部315は、取付治具302の記憶部321に対してデータのアクセスを行ったり、草刈機303とデータや信号のやり取りを行ったりするための通信機器である。走行経路設定部316は、草刈機303が自動走行を行うための走行経路としてライン走行経路LDを設定する。制御指示部317は、ライン走行経路LDに沿って草刈機303が走行するように指示信号Tcを出力し、指示信号Tcは通信部315を介して草刈機303に送信される。
図41に示されているように、草刈機303の自動草刈走行は、物体検出部301の制御ユニットと、草刈機303の制御ユニットと、の連係処理に基づいて行われる。物体検出部301の制御ユニットに、通信部315と、走行経路設定部316と、制御指示部317と、が備えられている。通信部315は、取付治具302の記憶部321に対してデータのアクセスを行ったり、草刈機303とデータや信号のやり取りを行ったりするための通信機器である。走行経路設定部316は、草刈機303が自動走行を行うための走行経路としてライン走行経路LDを設定する。制御指示部317は、ライン走行経路LDに沿って草刈機303が走行するように指示信号Tcを出力し、指示信号Tcは通信部315を介して草刈機303に送信される。
通信部315に、遠距離通信部315aと近距離通信部315bとが備えられている。遠距離通信部315aは、例えば百メートル程度の範囲で通信可能な通信機器である。また、遠距離通信部315aは、草刈機303に上述した指示信号Tcを送信したり、草刈機303から機体の状態や草刈の進捗状況等を受信したりすることができる。近距離通信部315bは、例えば数十センチメートル程度の範囲で通信可能な通信機器である。物体検出部301が取付治具302に取り付けられた状態で、近距離通信部315bは、記憶部321からエリア情報や作業履歴情報のデータを読み込んだり、記憶部321に対してエリア情報や作業履歴情報の更新データ等を書き込んだりすることができる。
草刈機303の制御ユニットに、通信部336と、走行制御部337と、が備えられている。通信部336は、物体検出部301の通信部315とデータや信号のやり取りを行うための通信機器である。また、通信部336は、送信機304とデータや信号のやり取りが可能である。走行制御部337は、物体検出部301の制御指示部317が出力する指示信号Tcに基づいて草刈機303の自動草刈走行を行う。また、走行制御部337は、自動走行モードと手動走行モードとに切替可能なように構成され、自動走行モードでは当該自動草刈走行が行われる。手動走行モードの場合、走行制御部337は、送信機304の人為操作に基づく指示信号が、通信部336を介して走行制御部337に出力され、走行制御部337は、当該指示信号に基づく制御を行う。
草刈機303に傾斜センサ338が備えられ、傾斜センサ338で検出される傾斜角度IDが通信部336を介して物体検出部301に送信される。傾斜センサ338は、例えば慣性センサの一例であるIMU(Inertial Measurement Unit)であるが、振り子式やフロート式の傾斜角検出器であったり、ジャイロセンサであったり、加速度センサであったりしても良い。
送信機304は、操作者が持ち運びしながら草刈機303を人為操作可能なように構成されている。送信機304は、例えば操作者が手元で操作するプロポーショナル方式のコントローラによる操作であったり、タッチパネル方式の表示画面を有する携帯端末機器による操作であったりしても良い。
物体検出部301に備えられた距離センサ311に、信号出力部311aと、信号入力部311bと、デコード部311cと、が備えられている。信号出力部311aは検出信号TWを出力し、検出信号TWが、草刈機303の反射部334で反射信号RWとして反射して、反射信号RWが信号入力部311bで受信される。距離センサ311の走査によって測距データが得られ、デコード部311cは、測距データと走査角度とに基づいて、測距データを草刈機303の位置する座標を示す位置情報Nに変換する。なお、位置情報Nは、二次元の座標であっても良いし、三次元の座標であっても良い。デコード部311cによって変換された位置情報Nは制御指示部317に出力される。制御指示部317は、ライン走行経路LDと、位置情報Nに基づく走行軌跡と、の誤差が小さくなるように指示信号Tcを出力する。
回転制御機構312を制御する制御モジュールとして、傾斜補正制御部318が物体検出部301に備えられている。後述するが、傾斜補正制御部318は、草刈機303の傾斜角度IDに基づいて補正量αを算出し、回転制御機構312は、補正量αに基づいて回動することで、物体検出部301を傾斜させる。これにより、距離センサ311も連動して傾斜して、法面を走行する草刈機303を好適に追従可能となる。
〔走行経路〕
草刈機303が自動草刈走行を行うためのライン走行経路LDは、走行経路設定部316によって予め設定される。図42に示されているように、法面上で自動走行を行うための走行経路として、直線状のライン走行経路LDが複数設定されている。本実施形態では、法面の上端部に取付治具302が固定された状態で設定され、取付治具302に対して物体検出部301が着脱自在な状態で取り付けられる。この状態で、物体検出部301は、法面の上端部から左右方向に亘って走査が可能なように構成されている。本実施形態では、夫々のライン走行経路LDは、走行経路設定部316によって、以下の手順で生成される。
草刈機303が自動草刈走行を行うためのライン走行経路LDは、走行経路設定部316によって予め設定される。図42に示されているように、法面上で自動走行を行うための走行経路として、直線状のライン走行経路LDが複数設定されている。本実施形態では、法面の上端部に取付治具302が固定された状態で設定され、取付治具302に対して物体検出部301が着脱自在な状態で取り付けられる。この状態で、物体検出部301は、法面の上端部から左右方向に亘って走査が可能なように構成されている。本実施形態では、夫々のライン走行経路LDは、走行経路設定部316によって、以下の手順で生成される。
まず、法面の上端縁部に沿って、手動走行モードでティーチング走行が行われる。ティーチング走行は、送信機304を操作者が操作することによる人為操作に基づいて行われる。本実施形態では、始点位置TDsに草刈機303が位置する状態で、操作者が送信機304で始点設定操作を行う。そして、操作者が始点位置TDsから終点位置TDfまで直線形状に沿って草刈機303を走行させ、始点位置TDsに草刈機303が位置する状態で、操作者が送信機304で終点設定操作を行う。これにより、ティーチング処理が実行される。つまり、始点位置TDsにおいて距離センサ311の走査によって取得された位置情報Nと、終点位置TDfにおいて距離センサ311の走査によって取得された位置情報Nと、から始点位置TDsと終点位置TDfとを結ぶティーチング走行軌跡TDが設定される。
ティーチング走行中の草刈機303の位置情報Nは、距離センサ311の走査によって、物体検出部301に逐次取得される。このとき、位置情報Nが、物体検出部301のRAM(不図示)に記憶される構成であっても良い。この構成であれば、ティーチング走行の始点位置TDsとティーチング走行の終点位置TDfとに亘る位置情報Nの集合から、草刈機303のティーチング走行軌跡TDが得られる。この構成は、ティーチング走行の走行軌跡が曲線状である場合に、特に有用である。
ライン走行経路LDは、ティーチング走行軌跡TDと平行な走行経路として、法面の下手側に向かって等間隔で複数生成される。本実施形態では、法面のティーチング走行軌跡TDよりも下手側に、ティーチング走行軌跡TDに沿うライン走行経路LD(1)~LD(10)が、等間隔で生成されている。なお、草刈機303による草刈り作業幅を考慮し、刈残しが生じないように作業幅が少し重なる状態で、夫々のライン走行経路LDは設定される。
夫々のライン走行経路LD(1)~LD(10)に、始点位置LDsと終点位置LDfとが割り当てられ、始点位置LDsから終点位置LDfに向かう方向が、草刈機303の進行方向となるように、夫々のライン走行経路LD(1)~LD(10)は構成されている。また、草刈機303が夫々のライン走行経路LD(1)~LD(10)を順番に走行するための順路が設定され、本実施形態では、法面の上手側から下手側に折り返しながら、草刈機303が直線往復走行を繰り返す順路が設定されている。つまり、ライン走行経路LD(1)~L(9)の何れか一つのライン走行経路LD(n)における終点位置LDfの法面下手側に、次の順路が割り当てられたライン走行経路LD(n+1)の始点位置LDsが隣り合って位置するように、ライン走行経路LDが設定されている。
草刈機303は、ライン走行経路LDに沿って草刈りしながら自動走行する。例えば、草刈機303が、一つのライン走行経路LD(1)の終点位置LDfに到達すると、草刈機303は、次の順路が割り当てられたライン走行経路LD(2)の始点位置LDsに移動する。このとき、例えば、草刈機303の第一車輪332A及び第二車輪332Bが正転と逆転とを繰り返すように、スイッチバック走行が行われると好適である。当該スイッチバック走行であれば、草刈機303の向きが変わらず、反射部334と距離センサ311とが常に対向するため、物体検出部301が草刈機303の反射部334を好適に追従できる。
終点位置LDfから次の始点位置LDsへの移動は、自動走行モードによって行われても良いし、手動走行モードによって行われても良い。手動走行モードの場合、草刈機303が次の始点位置LDsに移動した後、手動走行モードから自動走行モードへの切換は、人為操作によって行われても良いし、自動的に行われても良い。
草刈機303がライン走行経路LD(2)の始点位置LDsに到達し、草刈機303の進行方位がライン走行経路LD(2)の進行方向に沿うと、草刈機303は、ライン走行経路LD(2)に沿って草刈自動走行する。更に、ライン走行経路LD(3),L(4),L(5),L(6),L(7),L(8),L(9),LD(10)の順番で、草刈機303の草刈自動走行が行われる。
夫々のライン走行経路LD(1)~LD(10)が、法面の上手側から下手側に順番に設定される構成であるため、物体検出部301と草刈機303との間は、常に刈取後の地面となり、距離センサ311は、未刈草GN(図36参照)に邪魔されることなく草刈機303の反射部334を好適に追従できる。
ティーチング走行軌跡TDと夫々のライン走行経路LDとは、記憶部321に作業履歴情報として記憶される。このため、走行経路設定部316は、記憶部321の作業履歴情報に基づいてティーチング走行軌跡TDと夫々のライン走行経路LDとを再現可能なように構成されており、次回の自動草刈走行時にティーチング走行が行われずに自動草刈走行が可能となる。これにより、次回の自動草刈走行時に使用する物体検出部301が同一のものでなくても、ティーチング走行軌跡TD及びライン走行経路LDを再現できる。また、制御指示部317は、記憶部321に記憶された過去の作業履歴情報から、草刈機303の傾斜角度の変動等を事前に予測可能なように構成されている。例えば、過去に草刈機303が大きく傾斜した個所で、制御指示部317は減速指示を出力する。これにより、過去の自動草刈走行よりも安定した自動草刈走行が可能となる。
〔傾斜補正制御〕
本実施形態では、草刈機303は法面の上手側から下手側に順番に自動草刈走行を行うように構成されている。距離センサ311は、法面の上端から左右方向に亘って広範囲に走査する構成であるため、上下方向の走査範囲を大きくすると、距離センサ311による反射部334の検出に時間が掛かり、制御指示部317による指示信号Tcの出力がリアルタイム性を損なう虞がある。この不都合を回避するため、上下方向の走査範囲は、例えば10度程度の狭い走査角度になりがちとなる。このため、草刈機303が、距離センサ311の走査範囲よりも上方又は下方に移動すると、距離センサ311が草刈機303の反射部334を追従できなくなる虞がある。このことから、図43に示されているように、本実施形態では、法面の傾斜角度に対応して距離センサ311を傾斜させるように構成されている。これにより、距離センサ311と反射部334とが好適に対向する。
本実施形態では、草刈機303は法面の上手側から下手側に順番に自動草刈走行を行うように構成されている。距離センサ311は、法面の上端から左右方向に亘って広範囲に走査する構成であるため、上下方向の走査範囲を大きくすると、距離センサ311による反射部334の検出に時間が掛かり、制御指示部317による指示信号Tcの出力がリアルタイム性を損なう虞がある。この不都合を回避するため、上下方向の走査範囲は、例えば10度程度の狭い走査角度になりがちとなる。このため、草刈機303が、距離センサ311の走査範囲よりも上方又は下方に移動すると、距離センサ311が草刈機303の反射部334を追従できなくなる虞がある。このことから、図43に示されているように、本実施形態では、法面の傾斜角度に対応して距離センサ311を傾斜させるように構成されている。これにより、距離センサ311と反射部334とが好適に対向する。
距離センサ311は、傾斜補正制御部318によって傾斜するように構成されている。なお、物体検出部301が全体的に傾斜することによって距離センサ311が傾斜する構成であっても良いし、物体検出部301のうち、距離センサ311のみが傾斜する構成であっても良い。傾斜補正制御部318による距離センサ311の傾斜は、以下の手順で行われる。
上述したティーチング走行において、草刈機303に設けられた傾斜センサ338によって、ティーチング走行時における草刈機303の傾斜角度IDが経時的に検出され、草刈機303の通信部336と、物体検出部301の通信部315と、を介して傾斜補正制御部318に送信される。ティーチング走行時における傾斜角度IDの平均値(又は中央値)が法面の基準傾斜角度として用いられ、傾斜補正制御部318は、傾斜角度IDに基づいて補正量αを算出し、回転制御機構312に補正量αを出力する。回転制御機構312は、補正量αに基づいて回動し、距離センサ311は法面の傾斜面と平行に傾斜する。これにより、距離センサ311は、法面の傾斜に対応して、法面の全体的な範囲に亘って走査可能となる。
このとき、例えば取付治具302が既に傾いている場合には、物体検出部301も当然に傾くことから、傾斜補正制御部318による補正量αの算出に、物体検出部301の傾きが考慮される。取付治具302の正確な傾き角度が記憶部321に記憶されている場合、傾斜補正制御部318は、記憶部321から読み出された当該傾き角度を考慮して、補正量αを算出する構成であっても良い。また、物体検出部301にIMUが備えられている場合、傾斜補正制御部318は、物体検出部301のIMUによって検出された傾き角度を考慮して補正量αを算出する構成であっても良い。なお、傾斜補正制御部318は、自動草刈走行の開始後においても、必要に応じて傾斜角度IDに基づいて補正量αを算出するように構成されている。
自動草刈走行が開始された後、物体検出部301は、草刈機303がライン走行経路LDに沿って自動草刈走行を行うように指示信号Tcを出力し、距離センサ311の走査によって草刈機303の反射部334を追従する。しかし、法面の角度が一様でなく、法面上に凹凸が存在する場合も考えられ、この場合に草刈機303が急激に傾くことによって、物体検出部301が草刈機303を見失う虞がある。このため、草刈機303が急激に傾く場合であっても、物体検出部301が草刈機303をしっかりと追従可能なようにするために、反射部334は下記のように構成されている。
図44に示されているように、反射部334に複数の反射シート339が備えられ、反射部334の上端側から順に、横棒状の反射シート339a,339b,339c,339d,339eが、上下に並ぶ状態で備えられている。夫々の反射シート339は、検出信号TWが入斜した方向と同じ方向に反射信号RWを反射するように構成されている。夫々の反射シート339は、草刈機303の前後方向を長手方向として、夫々の反射シート339の長手方向の長さが異なるように構成されている。本実施形態では、反射シート339の長手方向の長さは、下側に位置する反射シート339ほど、長くなるように構成されている。最も上側に位置する反射シート339aの長手方向の長さが、反射シート339の中で最も短く、最も下側に位置する反射シート339eの長手方向の長さが、反射シート339の中で最も長い。
図45に示されているように、距離センサ311は、走査角度をΔθずつ変化させながら走査することによって、反射シート339から複数の反射信号RWを取得する。当該複数の反射信号RWと走査角度とに基づいて三角関数等で反射シート339の長手方向の長さの近似値が算出可能である。このため、夫々の反射シート339a,339b,339c,339d,339eにおける長手方向の長さの違いは、デコード部311cによって算出可能なように構成されている。つまり、傾斜補正制御部318は、夫々の反射シート339a,339b,339c,339d,339eを識別可能なように構成されている。
複数の反射シート339のうち、最も上側に位置する反射シート339aの長さと、最も下側に位置する反射シート339eの長さと、が最も大きく異なる。このため、傾斜補正制御部318は、反射部334の上側寄り又は下側寄りの何れを追従しているかを判定し易くなり、誤判定の虞を軽減できる。
傾斜補正制御部318は、デコード部311cによって算出された反射シート339の長さから、夫々の反射シート339a,339b,339c,339d,339eのうち、どの反射シート339であるかを識別する。本実施形態では、反射シート339cが上下方向の中央に位置するため、反射シート339cの位置する箇所が、上下方向の目標位置となる。反射シート339a又は反射シート339bが識別される場合、距離センサ311の上下方向における走査範囲が草刈機303の上方寄りであることが、傾斜補正制御部318によって判定される。このとき、傾斜補正制御部318は、距離センサ311が、より下向きに傾斜するように回転制御機構312に対して補正量αを出力する。反射シート339d又は反射シート339eが識別される場合、距離センサ311の上下方向における走査範囲が草刈機303の下方寄りであることが、傾斜補正制御部318によって判定される。このとき、傾斜補正制御部318は、距離センサ311が、より上向きに傾斜するように回転制御機構312に対して補正量αを出力する。
このように、傾斜補正制御部318は、夫々の反射シート339a,339b,339c,339d,339eにおける長手方向の長さの違いを識別し、上下方向における走査の中心位置が反射シート339cとなるように、補正量αを算出する。これにより、距離センサ311が反射部334の上下方向中心を常に走査可能となり、草刈機303が急激に傾く場合であっても、物体検出部301が草刈機303を好適に追従できる。
また、傾斜補正制御部318は、記憶部321に記憶された過去の作業履歴情報から、草刈機303の傾斜角度の変動等を事前に予測可能なように構成されている。例えば、傾斜補正制御部318は、過去に反射部334が上下に大きく揺れた箇所で、補正量αをバイアス加算又はバイアス減算する。これにより、物体検出部301が、過去の自動草刈走行よりも好適に反射部334を追従できる。
〔第4実施形態の別実施形態〕
本発明は、上述の実施形態に例示された構成に限定されるものではなく、以下、本発明の代表的な別実施形態を例示する。
本発明は、上述の実施形態に例示された構成に限定されるものではなく、以下、本発明の代表的な別実施形態を例示する。
〔1〕上述した実施形態において、反射部334は、草刈機303の側面に一つ設けられているが、反射部334は、草刈機303の側面に二つ以上設けられる構成であっても良い。例えば、草刈機303の側面の前後端に反射部334が夫々設けられる構成であっても良い。この構成であれば、前後夫々の反射部334の位置座標に基づいて機体の進行方向や旋回方向の特定が可能になる。
〔2〕上述した実施形態において、反射部334は、草刈機303の側面に設けられているが、反射部334の前面又は後面に設けられる構成であっても良い。また、反射部334が、前面及び後面と左右両側面とに設けられる構成であっても良い。この構成であれば、草刈機303が何れの方向を向いていても、物体検出部301は草刈機303の反射部334を追従可能になる。
〔3〕上述した実施形態において、草刈機303は法面を自動草刈走行するように構成されているが、例えば、草刈機303は法面の下方の平坦状の地面を自動草刈走行する構成であっても良い。
〔4〕上述した実施形態において、記憶部321は取付治具302に備えられ、物体検出部301が取付治具302に固定された状態で、物体検出部301は、記憶部321からエリア情報及び作業履歴情報を読み出し可能であるが、上述した実施形態に限定されない。例えば、記憶部321は不図示の管理コンピュータに備えられ、物体検出部301が、WAN等を介してエリア情報及び作業履歴情報を読み出し可能な構成であっても良い。この構成によって、エリア情報の一元管理が容易になる。また、記憶部321は、RFIDタグに限定されず、半導体式記憶装置であったり、磁気式記憶装置であったり、光学式記憶装置であったりしても良い。
〔5〕上述した実施形態では、夫々の反射シート339は、機体下側に位置するほど長手方向の長さが長い構成であるが、上述した実施形態に限定されず、例えば、夫々の反射シート339は、機体上側に位置するほど長手方向の長さが長い構成であっても良い。
〔6〕上述した実施形態では、夫々のライン走行経路LDは、直線状のティーチング走行軌跡TDに基づいて設定されているが、曲線状のティーチング走行軌跡TDに基づいて設定されても良い。例えば図46に示されているように、曲線状のティーチング走行軌跡TDに基づいて、ティーチング走行軌跡TDと平行な曲線状のライン走行経路LDが、等間隔に夫々設定される構成であっても良い。
〔7〕上述した実施形態では、反射部334は、横長の反射シート339が複数備えられているが、上述した実施形態に限定されない。例えば、図47に示されているように、反射部334が、草刈機303における物体検出部301の位置する側の側面から突出する状態で、円錐状に形成される構成であっても良い。円錐状の反射部334は、機体水平方向の断面直径が上下方向で異なり、機体下側に位置するほど当該断面直径が大きい。このことから、距離センサ311が機体水平方向に沿って走査したとき、円錐状の反射部334のうち、走査した個所における当該断面直径が検出される構成であって良い。
〔8〕上述の実施形態では、草刈機303が草刈りを行いながら自動走行するものとして説明したが、草刈機303に限定されず、芝刈機やモアであっても良い。
本発明は、法面などの傾斜した地形を走行可能な自動走行作業機に適用可能である。
また、本発明は、刈取後の刈草を排出する排出機構と、刈草を検出する検出装置と、が備えられる自動走行草刈機に適用可能である。
また、本発明は、草刈対象領域を草刈走行する草刈機に適用可能である。
本発明は、法面上に予め設定された走行エリア内を自動草刈走行する草刈機の自動走行システムに適用可能である。
[第1実施形態]
1 :走行機体
2A :第一車輪
2B :第二車輪
3 :草刈装置
4 :測位受信機
5 :回転制御機構
6 :遮断板
10 :記憶部
11 :走行経路設定部
12 :自動走行制御装置
17 :通信部
31 :傾斜角度決定部
EA :エンジン
IA :傾斜角度
ImA :傾斜角情報
TA :ティーチング経路
LA :ライン走行経路
1 :走行機体
2A :第一車輪
2B :第二車輪
3 :草刈装置
4 :測位受信機
5 :回転制御機構
6 :遮断板
10 :記憶部
11 :走行経路設定部
12 :自動走行制御装置
17 :通信部
31 :傾斜角度決定部
EA :エンジン
IA :傾斜角度
ImA :傾斜角情報
TA :ティーチング経路
LA :ライン走行経路
[第2実施形態]
101 :走行機体
103 :草刈装置
104 :排出機構
104a :排出口
104b :排出経路
110 :検出装置
111 :目標ライン算出部
112 :自動走行制御装置
141 :開閉機構
142 :圧力センサ(圧力検出手段)
G :塊状刈草
LB :目標ライン
101 :走行機体
103 :草刈装置
104 :排出機構
104a :排出口
104b :排出経路
110 :検出装置
111 :目標ライン算出部
112 :自動走行制御装置
141 :開閉機構
142 :圧力センサ(圧力検出手段)
G :塊状刈草
LB :目標ライン
[第3実施形態]
201 :走行機体
210 :距離センサ
212 :デコード制御部
213 :走行モード判定部
214 :物体検出部
215 :目標距離算出部
216 :走行指示部
C :走行制御部
ImC :検出傾斜角度
LG :地面基準線
Lc :草候補線
LK :草基準線
LM :目標距離
θ :相対角度(傾斜角度)
θ2 :算出傾斜角度
201 :走行機体
210 :距離センサ
212 :デコード制御部
213 :走行モード判定部
214 :物体検出部
215 :目標距離算出部
216 :走行指示部
C :走行制御部
ImC :検出傾斜角度
LG :地面基準線
Lc :草候補線
LK :草基準線
LM :目標距離
θ :相対角度(傾斜角度)
θ2 :算出傾斜角度
[第4実施形態]
301 :物体検出部
302 :取付治具
303 :草刈機
315 :通信部
316 :走行経路設定部
317 :制御指示部
318 :傾斜補正制御部
321 :記憶部
334 :反射部
336 :通信部
338 :傾斜センサ
339 :反射シート
ID :傾斜角度
LD :ライン走行経路(走行経路)
TD :ティーチング走行軌跡
TW :検出信号
RW :反射信号
301 :物体検出部
302 :取付治具
303 :草刈機
315 :通信部
316 :走行経路設定部
317 :制御指示部
318 :傾斜補正制御部
321 :記憶部
334 :反射部
336 :通信部
338 :傾斜センサ
339 :反射シート
ID :傾斜角度
LD :ライン走行経路(走行経路)
TD :ティーチング走行軌跡
TW :検出信号
RW :反射信号
Claims (34)
- 走行機体と、
航法衛星から測位信号を受信する測位受信機と、
前記測位信号に基づいて、走行経路に沿って自動走行する自動走行制御装置と、
前記走行機体の傾きを検出して傾斜角情報を出力する傾斜検出部と、
前記傾斜角情報に基づいて傾斜角度を決定する傾斜角度決定部と、
前記測位受信機を一以上の自由度で回転する回転制御機構と、
が備えられ、
前記回転制御機構は、前記傾斜角度に基づいて前記測位受信機を水平に保持する自動走行作業機。 - 前記回転制御機構は、前記測位受信機の真下に設けられている請求項1に記載の自動走行作業機。
- 前記測位受信機の下方を覆うと共に、前記測位信号の伝播を遮断する遮断板が設けられている請求項1又は2に記載の自動走行作業機。
- 前記走行機体の走行経路を予め設定する走行経路設定部が備えられ、
前記走行経路設定部は、前記走行機体の人為操作によるティーチング走行軌跡に基づいて、前記ティーチング走行軌跡に平行な複数のライン走行経路を生成する請求項1から3の何れか一項に記載の自動走行作業機。 - 前記傾斜角度決定部は、前記ティーチング走行軌跡に亘って検出される前記傾斜角情報に基づいて前記傾斜角度を決定し、
前記回転制御機構は、前記ライン走行経路における自動走行開始前のタイミングで、前記測位受信機を回転する請求項4に記載の自動走行作業機。 - 前記傾斜角度決定部は、一つの前記ライン走行経路に亘って検出される前記傾斜角情報に基づいて前記傾斜角度を更新し、
前記回転制御機構は、次の前記ライン走行経路における自動走行開始前のタイミングで、前記測位受信機を回転する請求項4又は5に記載の自動走行作業機。 - 前記傾斜角度を記憶する記憶部が備えられ、
前記記憶部に、前記走行経路と、前記走行経路における予め設定された複数の地点ごとの前記傾斜角度と、が記憶され、
前記自動走行制御装置は、前記記憶部に記憶された前記走行経路に沿って自動走行し、
前記回転制御機構は、前記走行機体が前記地点を通過するタイミングで、前記測位受信機を回転する請求項1から6の何れか一項に記載の自動走行作業機。 - 機体外部と情報通信する通信部が備えられ、
前記走行経路及び前記傾斜角度は、前記通信部を介して外部端末に送信されて当該外部端末に表示可能な請求項1から7の何れか一項に記載の自動走行作業機。 - 草刈走行を行う走行機体と、
刈取後の刈草を排出口から刈取後の地面に排出する排出機構と、
前記排出機構によって排出された前記刈草を検出する検出装置と、
前記刈草の検出に基づいて目標ラインを算出する目標ライン算出部と、
前記目標ライン算出部に基づく目標ラインと前記走行機体との距離が、予め設定された距離に保持されるように前記走行機体を自動走行させる自動走行制御装置と、
が備えられている自動走行草刈機。 - 前記排出機構は、前記走行機体の走行軌跡に沿って前記刈草を塊状に排出し、塊状の前記刈草が、前記走行機体の走行軌跡に沿って連続的又は断続的な凸部を形成するように構成されている請求項9に記載の自動走行草刈機。
- 前記排出機構は、前記走行機体のうち、前記刈取後の地面の位置する側の側部に設けられている請求項9又は10に記載の自動走行草刈機。
- 前記検出装置は、前記走行機体のうち、前記刈取後の地面の位置する側の側部に設けられている請求項9から11の何れか一項に記載の自動走行草刈機。
- 前記排出機構に、前記走行機体から前記排出口に亘る排出経路が形成され、
前記排出経路は、前記排出口の位置する側ほど、断面形状が狭く絞られている請求項9から12の何れか一項に記載の自動走行草刈機。 - 前記排出機構に、前記排出口を開閉可能な開閉機構と、前記刈草の圧力を検知する圧力検出手段と、が備えられ、
前記圧力検出手段が予め設定された圧力以上の圧力を検知したときに、前記開閉機構が開く請求項9から13の何れか一項に記載の自動走行草刈機。 - 草刈走行を行う走行機体と、
前記走行機体を制御する走行制御部と、
前記走行機体と、機体左右方向に位置する物体と、の距離を、機体左右両方に亘って走査する距離センサと、
前記距離センサの走査によって検出された距離及び走査角度に基づいて、機体左右両方に亘る対地高さデータを生成するデコード制御部と、
前記対地高さデータに基づく近似線によって、刈取後の地面のラインとして識別される地面基準線と、刈取前の草のラインとして識別される草基準線と、を生成する物体検出部と、
前記草基準線と前記走行機体との距離に基づいて目標距離を算出する目標距離算出部と、
前記草基準線と前記走行機体との距離が、前記目標距離と一致するように指示信号を出力する走行指示部と、
が備えられている草刈機。 - 前記走行機体の走行モードを判定する走行モード判定部が備えられ、
前記走行モードは、手動制御モードと、自動制御モードと、を有し、
前記走行モードが前記手動制御モードの場合、前記走行制御部は手動制御の操作信号に基づいて前記走行機体を制御し、
前記走行モードが前記自動制御モードの場合、前記走行制御部は前記走行指示部の指示信号に基づいて前記走行機体を制御する請求項15に記載の草刈機。 - 前記距離センサは、機体前後方向を軸芯に回転することによって走査するように構成されている請求項15又は16に記載の草刈機。
- 前記距離センサは、前記走行機体の前部又は後部の何れか一方に設けられている請求項15から17の何れか一項に記載の草刈機。
- 前記距離センサは、前記走行機体の前部及び後部の両方に設けられている請求項15から17の何れか一項に記載の草刈機。
- 前記物体検出部は、前記対地高さデータのうち、前記距離センサの機体鉛直下方から予め設定された機体左右方向の範囲内のデータから近似線を算出することによって、前記地面基準線を生成するように構成されている請求項15から19の何れか一項に記載の草刈機。
- 前記物体検出部は、前記対地高さデータのうち、前記地面基準線から一定値以上の高さを有するデータが一定範囲以上に亘って連続する箇所のデータから近似線を算出することによって、草候補線を生成するように構成されている請求項15から20の何れか一項に記載の草刈機。
- 前記草候補線は、複数生成され、
前記走行機体に、前記走行機体の傾斜角度を検出する慣性センサが備えられ、
前記物体検出部は、前記草候補線のうち、前記草候補線の前記地面基準線に対する傾斜角度と、前記慣性センサによって検出された傾斜角度から算出された算出傾斜角度と、が予め定められた基準範囲内である一つの前記草候補線を、前記草基準線と特定するように構成されるように構成されている請求項21に記載の草刈機。 - 前記草基準線は、前記地面基準線から予め設定された高さの範囲内に限定される請求項15から22の何れか一項に記載の草刈機。
- 前記草基準線と前記走行機体との距離は、現在と過去複数回とに亘って算出された複数の値が記憶され、
前記目標距離は、前記複数の値の移動平均値に基づいて算出される請求項15から23の何れか一項に記載の草刈機。 - 法面上に予め設定された走行エリア内を自動草刈走行する草刈機の自動走行システムであって、
法面の最上端に設けられ、検出信号を送信し、前記検出信号に対する反射信号を取得して物体を検出する物体検出部と、
前記草刈機における前記物体検出部の位置する側の側面に設けられ、前記物体検出部により検出される反射部と、
前記物体検出部と前記草刈機との夫々に設けられた通信部と、
前記走行エリアのエリア情報と、前記草刈機の作業履歴情報と、を記憶する記憶部と、
前記草刈機の走行経路を設定する走行経路設定部と、
前記草刈機に指示信号を送信する制御指示部と、が備えられ、
前記物体検出部は、前記反射部を追従するように構成され、
前記制御指示部は、前記物体検出部が取得した反射信号に基づいて前記草刈機の走行軌跡を算出して前記草刈機の走行軌跡と前記走行経路との誤差を算出し、前記誤差を減少させるように前記指示信号を生成し、
前記草刈機は、前記指示信号によって前記走行経路に沿って自動草刈走行するように構成されている草刈機自動走行システム。 - 前記草刈機に、前記草刈機の傾斜角度を検出する傾斜センサが備えられ、
前記物体検出部に、前記傾斜センサが検出した傾斜角度と一致するように、前記物体検出部の角度調整を行う傾斜補正制御部が備えられている請求項25に記載の草刈機自動走行システム。 - 前記反射部に、横長の反射シートが上下に並ぶ状態で複数備えられ、
夫々の前記反射シートは、互いに長手方向の長さが異なる請求項25又は26に記載の草刈機自動走行システム。 - 夫々の前記反射シートは、機体下側に位置するほど長手方向の長さが長い請求項27に記載の草刈機自動走行システム。
- 法面の最上端に前記物体検出部を固定する取付治具が設けられ、
前記物体検出部は、前記取付治具に着脱可能なように構成されている請求項25から28の何れか一項に記載の草刈機自動走行システム。 - 前記記憶部は、前記取付治具に設けられ、
前記物体検出部が前記取付治具に固定された状態で、前記エリア情報及び前記作業履歴情報が、前記記憶部から前記物体検出部に読み出し可能なように構成されている請求項29に記載の草刈機自動走行システム。 - 前記エリア情報及び前記作業履歴情報が、前記物体検出部から前記記憶部に記憶可能なように構成されている請求項30に記載の草刈機自動走行システム。
- 前記走行経路設定部は、前記草刈機の人為操作によるティーチング走行軌跡に基づいて、前記ティーチング走行軌跡に平行な複数のライン走行経路を生成する請求項25から31の何れか一項に記載の草刈機自動走行システム。
- 前記複数のライン走行経路は、前記ティーチング走行軌跡よりも法面の下方側に、平行に並んだ状態で位置する請求項32に記載の草刈機自動走行システム。
- 前記ティーチング走行軌跡及び前記複数のライン走行経路は、前記記憶部に前記作業履歴情報として記憶され、
前記走行経路設定部は、前記作業履歴情報に基づいて前記ティーチング走行軌跡を前記ライン走行経路として再現可能であり、かつ、前記複数のライン走行経路を再現可能である請求項32又は33に記載の草刈機自動走行システム。
Priority Applications (4)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
US16/771,264 US11696525B2 (en) | 2017-12-19 | 2018-12-19 | Automatic travel work machine, automatic travel grass mower, grass mower, and grass mower automatic travel system |
CN201880080844.8A CN111447827B (zh) | 2017-12-19 | 2018-12-19 | 自动行进作业机、自动行进割草机、割草机和割草机自动行进系统 |
EP18893078.8A EP3729937B1 (en) | 2017-12-19 | 2018-12-19 | Autonomous travel work machine |
KR1020207016331A KR102457518B1 (ko) | 2017-12-19 | 2018-12-19 | 자동 주행 작업기, 자동 주행 예초기, 예초기 및 예초기 자동 주행 시스템 |
Applications Claiming Priority (8)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2017-242688 | 2017-12-19 | ||
JP2017-242687 | 2017-12-19 | ||
JP2017-242686 | 2017-12-19 | ||
JP2017242685A JP6858695B2 (ja) | 2017-12-19 | 2017-12-19 | 自動走行作業機 |
JP2017-242685 | 2017-12-19 | ||
JP2017242686A JP6817183B2 (ja) | 2017-12-19 | 2017-12-19 | 自動走行草刈機 |
JP2017242688A JP6824866B2 (ja) | 2017-12-19 | 2017-12-19 | 草刈機自動走行システム |
JP2017242687A JP6877327B2 (ja) | 2017-12-19 | 2017-12-19 | 草刈機 |
Publications (1)
Publication Number | Publication Date |
---|---|
WO2019124463A1 true WO2019124463A1 (ja) | 2019-06-27 |
Family
ID=66992591
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/JP2018/046872 WO2019124463A1 (ja) | 2017-12-19 | 2018-12-19 | 自動走行作業機、自動走行草刈機、草刈機及び草刈機自動走行システム |
Country Status (5)
Country | Link |
---|---|
US (1) | US11696525B2 (ja) |
EP (1) | EP3729937B1 (ja) |
KR (1) | KR102457518B1 (ja) |
CN (1) | CN111447827B (ja) |
WO (1) | WO2019124463A1 (ja) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114281081A (zh) * | 2021-12-24 | 2022-04-05 | 杭州申昊科技股份有限公司 | 地铁车辆巡检机器人的导航系统和导航方法、机器人 |
WO2024181217A1 (ja) * | 2023-02-27 | 2024-09-06 | 株式会社クボタ | 走行支援システム、経路作成方法 |
Families Citing this family (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR102106100B1 (ko) * | 2018-02-02 | 2020-05-06 | 엘지전자 주식회사 | 이동 로봇 |
JP7161976B2 (ja) * | 2019-06-20 | 2022-10-27 | ヤンマーパワーテクノロジー株式会社 | 作業車両用の自動走行システム |
JP7365103B2 (ja) * | 2020-12-24 | 2023-10-19 | 株式会社クボタ | 営農支援システム、位置情報生成方法、コンピュータプログラムおよび処理装置 |
US20220369545A1 (en) * | 2021-05-21 | 2022-11-24 | Scythe Robotics, Inc. | Slope compensation for autonomous lawn mower planner system |
KR102368297B1 (ko) | 2021-07-26 | 2022-02-25 | 김광희 | 차량용 워터젯 예초장치 |
USD980875S1 (en) | 2021-08-10 | 2023-03-14 | Milwaukee Electric Tool Corporation | Lawn mower |
US20230048445A1 (en) * | 2021-08-10 | 2023-02-16 | Milwaukee Electric Tool Corporation | Orientation sensing for a lawnmower |
WO2023018823A1 (en) | 2021-08-10 | 2023-02-16 | Milwaukee Electric Tool Corporation | Lawnmower accessories |
CN113892399B (zh) * | 2021-09-13 | 2023-05-16 | 中国一冶集团有限公司 | 精准定位的喷播植草方法及脉冲压喷播机 |
CN114830911B (zh) * | 2022-05-19 | 2023-08-01 | 苏州大学 | 智能除草方法、装置和存储介质 |
EP4372512A1 (en) * | 2022-11-21 | 2024-05-22 | SMAUT Technology s.r.o. | Robotic mower, system and method for navigating a robotic mower |
US11678604B1 (en) | 2022-12-21 | 2023-06-20 | Sensori Robotics, LLC | Smart lawnmower with development of mowing policy and system and method for use of same |
US12001182B1 (en) | 2022-12-21 | 2024-06-04 | Sensori Robotics, LLC | Smart lawnmower with realization of mowing policy and system and method for use of same |
US20240305400A1 (en) * | 2023-03-09 | 2024-09-12 | Honeywell International Inc. | Antenna steering through gnss jamming, spoofing, and airplane maneuvers |
Citations (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH09107717A (ja) * | 1995-10-24 | 1997-04-28 | Kubota Corp | 作業機械の姿勢制御装置 |
JPH09128043A (ja) * | 1995-11-02 | 1997-05-16 | Hitachi Ltd | 無人移動作業機械の制御方式 |
JPH09128045A (ja) * | 1995-11-02 | 1997-05-16 | Hitachi Ltd | 自動走行機械の経路生成方式 |
JP2000342013A (ja) * | 1999-06-04 | 2000-12-12 | Kubota Corp | 刈取収穫機 |
JP2009110250A (ja) * | 2007-10-30 | 2009-05-21 | Ihi Corp | 自律走行移動体の走行経路決定用地図作成装置及び走行経路決定用地図作成方法 |
JP2009265941A (ja) | 2008-04-24 | 2009-11-12 | Panasonic Electric Works Co Ltd | 自律移動装置 |
JP2011142900A (ja) | 2009-12-15 | 2011-07-28 | Daitsu:Kk | 遠隔操作式草刈機 |
JP2013253928A (ja) * | 2012-06-08 | 2013-12-19 | Furuno Electric Co Ltd | 姿勢情報算出装置、及び姿勢情報算出方法 |
WO2016099386A1 (en) * | 2014-12-16 | 2016-06-23 | Väderstad Holding Ab | Method of controlling an agricultural implement and an agricultural implement |
JP2016189172A (ja) | 2015-03-30 | 2016-11-04 | 株式会社クボタ | 自動走行情報管理システム |
JP2016187978A (ja) * | 2015-03-30 | 2016-11-04 | 株式会社クボタ | 自走車両 |
JP2017182376A (ja) * | 2016-03-30 | 2017-10-05 | ヤンマー株式会社 | 経路生成装置 |
Family Cites Families (18)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE19962491A1 (de) * | 1999-12-23 | 2001-07-05 | Daimler Chrysler Ag | Verfahren zur optischen Überwachung der Umgebung eines sich bewegenden Fahrzeugs |
JP4669413B2 (ja) * | 2006-03-01 | 2011-04-13 | 株式会社クボタ | コンバインの姿勢検出装置及びコンバインの姿勢制御装置 |
JP4840031B2 (ja) * | 2006-08-31 | 2011-12-21 | ソニー株式会社 | ナビゲーション装置、ナビゲーション処理方法及びナビゲーション処理プログラム |
JP5139743B2 (ja) * | 2007-08-06 | 2013-02-06 | 株式会社クボタ | 歩行型草刈機 |
CN202077380U (zh) * | 2011-04-01 | 2011-12-21 | 上海大学 | 一种gps导航割草机器人 |
JP5749081B2 (ja) * | 2011-05-27 | 2015-07-15 | 株式会社小糸製作所 | 車両用灯具の制御装置および車両用灯具システム |
JP2013228821A (ja) * | 2012-04-24 | 2013-11-07 | Mamiya-Op Nequos Co Ltd | 作業機械及びその構成装置、コンピュータプログラム |
US9026299B2 (en) * | 2012-07-09 | 2015-05-05 | Deere & Company | Navigation system and method for autonomous mower |
JP6278682B2 (ja) * | 2013-12-12 | 2018-02-14 | 株式会社クボタ | 圃場作業機 |
KR20160134705A (ko) * | 2014-03-07 | 2016-11-23 | 얀마 가부시키가이샤 | 농작물 수확 장치 |
JP6285261B2 (ja) * | 2014-04-14 | 2018-02-28 | 株式会社小糸製作所 | 車両用灯具の制御装置 |
JP6281436B2 (ja) * | 2014-07-29 | 2018-02-21 | 井関農機株式会社 | 作業車両 |
CN104408771A (zh) * | 2014-11-12 | 2015-03-11 | 东北大学 | 一种基于三维模型的地下矿山斜坡道构建方法 |
JP6294839B2 (ja) * | 2015-01-06 | 2018-03-14 | ヤンマー株式会社 | 圃場管理システム |
JP2017087783A (ja) * | 2015-11-04 | 2017-05-25 | 株式会社筑水キャニコム | 斜面作業用車両 |
JP6635844B2 (ja) * | 2016-03-30 | 2020-01-29 | ヤンマー株式会社 | 経路生成装置 |
JP6705686B2 (ja) * | 2016-03-31 | 2020-06-03 | 株式会社クボタ | 作業車 |
DE202017103346U1 (de) * | 2017-06-02 | 2017-12-15 | Pöttinger Landtechnik Gmbh | Vorrichtung zum Aufzeichnen von Fahrwegdaten eines landwirtschaftlichen Arbeitsgeräts |
-
2018
- 2018-12-19 WO PCT/JP2018/046872 patent/WO2019124463A1/ja unknown
- 2018-12-19 KR KR1020207016331A patent/KR102457518B1/ko active IP Right Grant
- 2018-12-19 CN CN201880080844.8A patent/CN111447827B/zh active Active
- 2018-12-19 US US16/771,264 patent/US11696525B2/en active Active
- 2018-12-19 EP EP18893078.8A patent/EP3729937B1/en active Active
Patent Citations (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH09107717A (ja) * | 1995-10-24 | 1997-04-28 | Kubota Corp | 作業機械の姿勢制御装置 |
JPH09128043A (ja) * | 1995-11-02 | 1997-05-16 | Hitachi Ltd | 無人移動作業機械の制御方式 |
JPH09128045A (ja) * | 1995-11-02 | 1997-05-16 | Hitachi Ltd | 自動走行機械の経路生成方式 |
JP2000342013A (ja) * | 1999-06-04 | 2000-12-12 | Kubota Corp | 刈取収穫機 |
JP2009110250A (ja) * | 2007-10-30 | 2009-05-21 | Ihi Corp | 自律走行移動体の走行経路決定用地図作成装置及び走行経路決定用地図作成方法 |
JP2009265941A (ja) | 2008-04-24 | 2009-11-12 | Panasonic Electric Works Co Ltd | 自律移動装置 |
JP2011142900A (ja) | 2009-12-15 | 2011-07-28 | Daitsu:Kk | 遠隔操作式草刈機 |
JP2013253928A (ja) * | 2012-06-08 | 2013-12-19 | Furuno Electric Co Ltd | 姿勢情報算出装置、及び姿勢情報算出方法 |
WO2016099386A1 (en) * | 2014-12-16 | 2016-06-23 | Väderstad Holding Ab | Method of controlling an agricultural implement and an agricultural implement |
JP2016189172A (ja) | 2015-03-30 | 2016-11-04 | 株式会社クボタ | 自動走行情報管理システム |
JP2016187978A (ja) * | 2015-03-30 | 2016-11-04 | 株式会社クボタ | 自走車両 |
JP2017182376A (ja) * | 2016-03-30 | 2017-10-05 | ヤンマー株式会社 | 経路生成装置 |
Non-Patent Citations (1)
Title |
---|
See also references of EP3729937A4 |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114281081A (zh) * | 2021-12-24 | 2022-04-05 | 杭州申昊科技股份有限公司 | 地铁车辆巡检机器人的导航系统和导航方法、机器人 |
CN114281081B (zh) * | 2021-12-24 | 2023-10-24 | 杭州申昊科技股份有限公司 | 地铁车辆巡检机器人的导航系统和导航方法、机器人 |
WO2024181217A1 (ja) * | 2023-02-27 | 2024-09-06 | 株式会社クボタ | 走行支援システム、経路作成方法 |
Also Published As
Publication number | Publication date |
---|---|
EP3729937A4 (en) | 2021-09-15 |
US11696525B2 (en) | 2023-07-11 |
CN111447827B (zh) | 2022-12-16 |
EP3729937B1 (en) | 2023-07-05 |
EP3729937A1 (en) | 2020-10-28 |
KR20200077593A (ko) | 2020-06-30 |
US20200375095A1 (en) | 2020-12-03 |
CN111447827A (zh) | 2020-07-24 |
KR102457518B1 (ko) | 2022-10-24 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
WO2019124463A1 (ja) | 自動走行作業機、自動走行草刈機、草刈機及び草刈機自動走行システム | |
EP3506042B1 (en) | Three-dimensional information processing unit, apparatus having three-dimensional information processing unit, unmanned aerial vehicle, informing device, method and program for controlling mobile body using three-dimensional information processing unit | |
US7701566B2 (en) | Surveying system | |
US7499155B2 (en) | Local positioning navigation system | |
US7966739B2 (en) | Laser surveying system | |
CN112540380B (zh) | 自主机器人定位 | |
JP4309014B2 (ja) | レーザ基準面による建設機械制御システム | |
US8275506B1 (en) | Boundary sensor | |
US7552539B2 (en) | Method and apparatus for machine element control | |
JP4121642B2 (ja) | 建設機械制御システム | |
EP2068116B1 (en) | Surveying system | |
JP2000002538A (ja) | 回転レーザ装置及び建設機械制御システム | |
JP6824866B2 (ja) | 草刈機自動走行システム | |
JP6817183B2 (ja) | 自動走行草刈機 | |
JP2004008186A (ja) | 農業用作業車 | |
JP2019106939A (ja) | 自動走行作業機 | |
JP6877327B2 (ja) | 草刈機 | |
CN208044406U (zh) | 一种基于植保无人机多重检测的避障系统及无人机 | |
JP4376401B2 (ja) | レーザ基準面形成装置及び建設機械制御システム | |
US20150330054A1 (en) | Optical Sensing a Distance from a Range Sensing Apparatus and Method | |
KR101696325B1 (ko) | 측주형 레이저 검지기 | |
JP6309413B2 (ja) | 自動走行車両 | |
JP6342763B2 (ja) | 自動走行車両 | |
JP2016066203A (ja) | 自動走行車両 | |
JP4376915B2 (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: 18893078 Country of ref document: EP Kind code of ref document: A1 |
|
ENP | Entry into the national phase |
Ref document number: 20207016331 Country of ref document: KR Kind code of ref document: A |
|
NENP | Non-entry into the national phase |
Ref country code: DE |
|
ENP | Entry into the national phase |
Ref document number: 2018893078 Country of ref document: EP Effective date: 20200720 |