WO2020105101A1 - 自律走行作業機の制御装置 - Google Patents
自律走行作業機の制御装置Info
- Publication number
- WO2020105101A1 WO2020105101A1 PCT/JP2018/042745 JP2018042745W WO2020105101A1 WO 2020105101 A1 WO2020105101 A1 WO 2020105101A1 JP 2018042745 W JP2018042745 W JP 2018042745W WO 2020105101 A1 WO2020105101 A1 WO 2020105101A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- travel
- area
- traveling
- information
- work machine
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Ceased
Links
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/0268—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means
- G05D1/0274—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means using mapping information stored in a memory device
-
- 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
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W60/00—Drive control systems specially adapted for autonomous road vehicles
- B60W60/001—Planning or execution of driving tasks
- B60W60/0025—Planning or execution of driving tasks specially adapted for specific operations
-
- 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
-
- 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/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0246—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means
-
- 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/20—Control system inputs
- G05D1/24—Arrangements for determining position or orientation
- G05D1/246—Arrangements for determining position or orientation using environment maps, e.g. simultaneous localisation and mapping [SLAM]
-
- 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/60—Intended control result
- G05D1/646—Following a predefined trajectory, e.g. a line marked on the floor or a flight path
-
- A—HUMAN NECESSITIES
- A01—AGRICULTURE; FORESTRY; ANIMAL HUSBANDRY; HUNTING; TRAPPING; FISHING
- A01D—HARVESTING; MOWING
- A01D2101/00—Lawn-mowers
Definitions
- the present invention relates to a control device for an autonomous traveling work machine that is driven by a drive unit and autonomously travels while working in a work area.
- a control device for an autonomous traveling work machine of this type configures a boundary line that defines the outer periphery of the work area with, for example, a wire to which current is applied, and Similarly, the boundary lines of areas such as an internal pond where work is not suitable were made of wires. ..
- an object of the present invention is to provide a control device for an autonomous traveling work machine, which controls the traveling route to pass through a desired region as much as possible when the working machine travels toward a destination. It is in.
- the present invention is a control device for an autonomous traveling work machine that is driven by a drive unit to autonomously travel while working in a work area, and it is desired to travel inside and outside the work area.
- An information acquisition unit that acquires information about a desired travel region
- a search unit that searches for a travel route from the current position of the working machine to a target position based on the acquired information about the desired travel region, and a search by the search unit
- a control unit that drives the drive unit to drive the working machine according to the traveled route.
- FIG. 10 is a top view of the autonomous traveling work machine of FIG. 9.
- 11 is a block diagram similar to FIG. 3, showing the input / output relationship of the ECU of FIG. 10.
- FIG. 1 is an explanatory side view of an autonomous traveling work machine according to a first embodiment of the present invention
- FIG. 2 is a top view of the autonomous traveling work machine of FIG. 1
- FIG. 3 is an input / output of an ECU (electronic control unit) of FIG. It is a block diagram which shows a relationship.
- ECU electronic control unit
- the traveling direction (front-rear direction) of the working machine 10 in a top view, the lateral direction (horizontal direction) orthogonal thereto, and the vertical direction orthogonal to the traveling direction and the lateral direction are the front-rear direction, the left-right direction, and the vertical direction, respectively. It is defined and the configuration of each part is explained according to it.
- reference numeral 10 indicates an autonomous traveling work machine (hereinafter referred to as “work machine”).
- the working machine 10 is specifically a lawnmower.
- the machine body (base body) 12 of the working machine 10 includes a chassis 12a and a frame 12b attached thereto.
- the working machine 10 includes two left and right front wheels 14 each having a relatively small diameter fixed to the front side of the chassis 12a via a stay 12a1 in the front-rear direction, and a relatively large left and right wheel directly attached to the chassis 12a on the rear side.
- the rear wheel 16 is provided.
- a work member (hereinafter referred to as “blade”) 20 including a blade (rotary blade) for lawn mowing work is attached near the center position of the chassis 12a of the work machine 10, and an electric motor (hereinafter referred to as “work motor”) is attached to the upper portion thereof. 22) is arranged.
- the blade 20 is connected to a work motor 22 and is rotationally driven by the work motor 22.
- a blade height adjusting mechanism 24 that can be manually operated by the user is connected to the blade 20.
- the blade height adjusting mechanism 24 is provided with a screw (not shown), and the user can manually turn the screw to adjust the height of the blade 20 in the vertical direction from the ground surface GR. It should be noted that instead of manual operation, adjustment may be made electrically.
- traveling motors 26L and 26R Two electric motors (driving units; hereinafter referred to as “traveling motors”) 26L and 26R are attached to the chassis 12a of the working machine 10 at the rear end side of the blade 20.
- the traveling motors 26L and 26R are connected to the left and right rear wheels 16 and rotate the front wheel 14 as a driven wheel and the rear wheel 16 as a driving wheel to independently rotate normally (forward rotation) or reverse (reverse rotation). ..
- the blade 20, the work motor 22, the traveling motor 26, etc. are covered with the frame 12b.
- the working machine 10 has a weight and dimensions that can be carried by a user, and has, for example, a total length (length in the front-rear direction) of about 71 cm, a total width of about 55 cm, and a height of about 30 cm.
- An on-board charging unit 30 and an on-board battery (battery) 32 are stored in the rear part of the work machine 10, and a pair of battery charging terminals 34 are attached to the frame 12b so as to project forward in the forward direction.
- the onboard battery 32 is, for example, a lithium ion battery.
- the battery charging terminal 34 is connected to the onboard charging unit 30 via wiring, and the onboard charging unit 30 is connected to the onboard battery 32. Further, the work motor 22 and the traveling motor 26 are also connected to the onboard battery 32 and are configured to be energized from the onboard battery 32.
- the wiring is not shown in FIG.
- two cameras (photographing devices) 36 are arranged in front of the machine body 12 so that the front can be viewed in stereo.
- the camera 36 is arranged in the front portion of the machine body 12 of the work machine 10 at a position symmetrical in the left-right direction with respect to the machine body centerline CL1 extending in the front-rear direction. It should be noted that the single camera 36 may be used for monocular viewing, and it is also possible to view not only the front but also the entire circumference of 360 degrees.
- a contact sensor 40 that outputs an ON signal is attached to the frame 12b of the machine body 12 when the frame 12b comes off the chassis 12a due to contact with an obstacle or a foreign object.
- a storage box (not shown) is provided near the central position of the working machine 10, and an electronic control unit (Electronic Control Unit) including a microcomputer is provided on the circuit board 42 stored inside the storage box. ) 44 is mounted.
- the ECU 44 is composed of a microcomputer including at least a processor (CPU) 44a, a memory (ROM, EEPROM, RAM) 44b, and an I / O (input / output circuit) 44c.
- an angular velocity sensor 46 that produces an output indicating an angular velocity (yaw rate) around the z-axis (vertical axis) of the center of gravity of the working machine 10 in proximity to the ECU 44, and x that acts on the working machine 10.
- an acceleration sensor 50 that produces an output that indicates acceleration in the directions of three orthogonal axes of the y, z axes
- an orientation sensor 52 that produces an output that indicates an absolute orientation according to the geomagnetism.
- a wheel speed sensor 54 that generates an output indicating the wheel speed of the left and right rear wheels 16 is arranged near the left and right rear wheels 16 of the work machine 10, and a user or the like is provided between the chassis 12a and the frame 12b.
- a lift sensor 56 that outputs an ON signal when the frame 12b is lifted (lifted) from the chassis 12a by is arranged.
- a current sensor 60 that produces an output indicating the current consumption of the onboard battery 32 is arranged on the onboard battery 32.
- the work machine 10 is provided with a main switch 62 for instructing an operation start and the like and an emergency stop switch 64 for instructing an emergency stop, which can be operated by a user.
- the frame 12b of the work machine 10 is largely cut out on the upper surface thereof, and an input device 66 such as a keyboard and a touch panel for inputting a user's command is provided therein, and a display 70 is provided.
- the input device 66 and the display 70 are connected to the ECU 44, and various information such as a work mode is displayed on the display 70 according to a command from the ECU 44. Further, the ECU 44 is configured to be able to communicate with an external communication terminal 72 via the I / O 44c.
- the communication terminal 72 is composed of a PDA (Portable Digital Assistant) having a communication function such as a smartphone.
- the outputs of the sensors such as the camera 36, the contact sensor 40, the angular velocity sensor 46, and the switches such as the main switch 62 are sent to the ECU 44 and input through the I / O 44c.
- the output of the camera 36 is similarly sent to the image processing unit 36a including the ECU, and the captured image is generated there.
- the ECU 44 energizes the traveling motor 26 from the onboard battery 32 based on the output of the image processing unit 36a and other sensor outputs, and outputs a control value via the I / O 44c to drive the traveling motor 26 to drive the work machine. Control the running of 10.
- the traveling motors 26L and 26R are configured to rotate the left and right rear wheels 16 independently of each other in the forward direction (rotation in the forward direction) or in the reverse direction (rotation in the reverse direction), and generate a speed difference in the rotation of the left and right rear wheels 16. It is configured to rotate the work machine 10 in any direction.
- the working machine 10 when rotating the left and right rear wheels 16 in the forward direction, if the rotation speed of the right rear wheel 16 is faster than the rotation speed of the left rear wheel 16, the working machine 10 is moved to the left at a turning angle corresponding to the speed difference.
- the rotation speed of the left rear wheel 16 is made higher than the rotation speed of the right rear wheel 16 while turning, the working machine 10 can be turned to the right at a turning angle corresponding to the speed difference.
- the left and right rear wheels 16 are normally rotated one at a time and the other is reversely rotated at the same speed, the working machine 10 can be turned on the spot.
- the ECU 44 detects (recognizes) the work area AR from the outputs of the sensors, particularly the output of the camera 36, and based on that, energizes the work motor 22 to work in the work area AR.
- FIG. 4 shows the work area AR.
- a charging station (hereinafter referred to as “charging ST”) 76 for charging the onboard battery 32 of the working machine 10 is arranged near the boundary line (peripheral edge) 74 of the work area AR.
- FIG. 5 is a block diagram showing an electrical configuration of the charging ST76.
- the charging ST 76 includes a charger 84 connected to a power source (commercial power source) 80 via an outlet 82, and a pair of charging terminals 86 connected to the charger 84.
- the charging terminal 86 is configured to be freely connectable to the pair of battery charging terminals 34 mounted on the working machine 10 via the contacts 34a (shown in FIG. 2) thereof.
- the charger 84 includes an AC / DC converter 84a and a charging ECU (electronic control unit) 84b including a microcomputer that controls the operation of the AC / DC converter 84a.
- a charging ECU electronic control unit
- the alternating current sent from the power supply 80 through the outlet 82 is stepped down to an appropriate voltage by the AC / DC converter 84a of the charger 84, converted into direct current, sent to the charging terminal 86, and returned to the working machine 10.
- the onboard battery 32 of the working machine 10 is charged.
- the image of the charging ST76 is stored in the memory 44b of the ECU 44, and the ECU 44 recognizes the position of the charging ST76 by comparing the image with the captured image obtained by the image processing unit 36a of the camera 36. And then return.
- the charging of the on-board battery 32 of the work machine 10 is not limited to the connection by the terminals 34 and 86, but may be wireless charging.
- the ECU 44 detects (recognizes) the work area AR, the marker 90 arranged on the boundary line (periphery) 74 of the work area AR, based on the captured image obtained by the image processing unit 36 a of the camera 36.
- the markers 90 are made of colored triangular cubes and are arranged on the boundary line 74 at appropriate intervals.
- the ECU 44 causes the work machine 10 to orbit the work area AR along the boundary line 74 based on the captured image sent from the image processing unit 36a and the outputs of the wheel speed sensor 54, the direction sensor 52, and the like.
- the entire AR is recognized (detected) and a map (work area map) MP of the work area AR is generated.
- Fig. 6 shows the map MP.
- the map MP is a work area AR inside the boundary line 74 on a plane (XY plane) of the orthogonal biaxial coordinates with the position of the charging ST 76 as the origin and the predetermined azimuth defined by the azimuth sensor 52 as a reference.
- Of cells are arranged in a grid at regular intervals, and a plurality of cells Cmp are arranged to form data.
- each cell Cmp corresponds to a size of, for example, about 0.5 m in the vertical and horizontal directions in the work area AR, and has data including unique position coordinates (X, Y coordinates).
- the ECU 44 controls the traveling of the work machine 10 on the basis of the illustrated map MP as described later.
- the work area AR is composed of two rectangular areas AR1 and AR2 and a narrow road AR3 connecting the areas AR1 and AR2.
- the width W of the narrow path AR3 is not less than m times (for example, 1.5 times) and not more than n times (for example, 4 times) the width of the working machine 10 in the left-right direction.
- a path AR4 for people including the user is formed in the vicinity of the gate G of the site where the user lives and the house H, and the path AR4 has no turf planted from the beginning or has been planted. It means the area where turf hardly grows even if it is done.
- a pond is placed in the area AR1 and a slope is formed around the pond.
- the slope AR5 around the pond and its surroundings is configured such that the slope on the left side in FIG. 4 is larger (steeper) than that on the right side.
- the desired travel (by the user) is desired.
- the region is considered as a traveling unsuitable region where traveling is unsuitable.
- the "desired travel area” is inside or outside the work area AR when it is desired to surely return to the charging ST76 even when the amount of charge of the on-board battery 32 of the working machine 10 falls below the threshold value, or as the area AR1.
- the ECU 44 acquires the position data of the cell Cmp on the map MP for them as information regarding the desired traveling area. To do.
- the ECU 44 obtains the target from the current position of the work machine 10 in the work area AR based on the information acquisition unit 44a1 that acquires information such as the desired travel area and the acquired information about the desired travel area. It operates as a search unit 44a2 that searches for a travel route to a position (for example, charging ST76), and a control unit 44a3 that drives the electric motor (drive unit) 26 according to the travel route searched by the search unit to drive the work machine 10 ( Function.
- an unsuitable rate AR5a indicating the degree of unsuitable running is attached thereto.
- the inadequacy ratio AR5a has characteristics similar to contour lines, and is set such that the larger the slope is, whether it is concave or convex, the smaller the distance between adjacent lines becomes. , 1, 2, 3, etc. are added.
- the unsuitable region of this type is not limited to the pond and its surroundings, and may be a narrow bridge where the working machine 10 may fall, a place where the user does not want to make a rut, or the surroundings thereof. good.
- S processing step 10
- the working machine 10 is circulated along the marker 90 arranged on the boundary line 74 of the work area AR, a map MP is generated and stored in the memory 44b.
- the map MP is configured to be accessible from the outside of the work machine 10 to the communication terminal 72 via the I / O 44c.
- the process proceeds to S12, and it is determined whether or not the user has input a desired traveling area such as the road AR4 via the input device 66.
- the process proceeds to S14, in which the corresponding cell of the map MP is filled (information about the desired travel area is obtained), while when the result in S12 is negative, the process of S14 is skipped.
- the process proceeds to S16, and it is determined whether or not the user has input an unsuitable travel area such as AR5 via the input device 66.
- the process proceeds to S18, in which the corresponding cell of the map MP is written (information about the traveling unsuitable region is obtained), while when the result is negative, the subsequent processes are skipped.
- the narrow road AR3 is an area in which one of the areas AR1 and AR2 always travels in order to move to the other after the work is completed, and as a result, the grass may be trampled and the grass may be stripped. high. Therefore, the narrow road AR3 is preferentially driven to reduce grass stripping in other areas.
- the process in S22 is skipped.
- S24 it is determined whether or not the user has input a desired travel area such as the road AR4 via the communication terminal 72.
- a desired travel area such as the road AR4 via the communication terminal 72.
- the operation proceeds to S26, in which the desired travel area is entered in the corresponding cell of the map MP.
- the process of S26 is skipped.
- S28 it is determined whether or not there is an input of an unsuitable area such as AR5 via the communication terminal 72 from the user or the like. (Obtaining information about unsuitable areas). On the other hand, when the result in S28 is NO, the process of S30 is skipped.
- S36 it is determined whether or not a region where grass is not growing is detected in the captured image output from the image processing unit 36a, in addition to the AR4 described above. Fill in the relevant cell of the MP as the desired travel area (obtain information about the desired travel area).
- FIG. 8 is a flow chart showing the processing of the ECU 44 performed after the processing of FIG.
- the own machine position on the map MP is specified from the boundary line 74 of the work area AR and the sensor outputs of the wheel speed sensor 54 and the like.
- the program proceeds to S106, in which the desired travel area is selected, the procedure proceeds to S108, and the travel route from the own position to the destination is searched based on the information regarding the desired travel area, and the travel in the memory 44b is performed. Each time the number of times of travel is searched, the corresponding address of the cell Cmp to be sequentially written (stored) sequentially.
- the traveling route detects the position of the vehicle with respect to the boundary line 74 of the work area AR from the outputs of the wheel speed sensor 54 and the direction sensor 52, and the traveling from there to the destination (charging ST76) is the desired traveling area. Search as shortest as possible while passing.
- a captured image of the camera 36 may be used, or a GPS receiver may be provided and the output thereof may be used.
- the search and entry of the driving route is basically the same as the case based on the information on the desired driving region, but when based on the information on the driving unsuitable region, the driving route is searched considering the inadequacy rate.
- the inadequacy rate consists of numerical values that increase from the periphery of the pond toward the center.
- the travel route is calculated by selecting an area having a small numerical value, not the shortest distance to the destination.
- the drive unit (travel motor) 26 is driven according to the retrieved (or corrected) travel route to drive the machine (work machine) 10 to travel.
- this embodiment is configured as described above, when the working machine 10 travels toward the destination, it can be controlled so that the travel route passes through the desired travel area as much as possible.
- FIG. 9 is a conceptual view similar to FIG. 1, showing the entire autonomous traveling work machine according to the second embodiment of the present invention
- FIG. 10 is a top view of the autonomous traveling work machine of FIG. 9,
- FIG. FIG. 4 is a block diagram similar to FIG. 3, showing an input / output relationship of an ECU.
- the work machine in order to recognize the boundary line 74 of the work area AR, instead of the camera 36 and the image processing unit 36a, the work machine is used.
- Two magnetic sensors 360L and 360R arranged on the left and right of the front of 10 and one magnetic sensor 360C arranged on the rear are used.
- an electric wire is embedded in the ground below the boundary line 74 of the work area AR, and a direct current is supplied from the AC / DC converter 84a of the charger 84 shown in FIG.
- the magnetic sensor 360 detects the boundary line 74 of the work area AR. Details thereof are described in, for example, U.S. Pat. No. 9,740,204, and therefore further description will be omitted.
- an information acquisition unit (44a1, S14, S22, S26, S34, S38) for acquiring information on a desired travel area desired to travel inside and outside the work area AR, and information on the acquired desired travel area.
- a search unit (44a2, S102, S14, S106, S108) for searching a travel route from the current position of the work machine to the target position based on the above, and driving the drive unit according to the travel route searched by the search unit.
- a control unit 44a3, S120 for moving the working machine, the working machine 10 travels toward a destination such as a charging ST76, and a desired traveling route is desired. It is possible to control so as to pass through the area, and it is possible to prevent inconveniences such as stripping of grass in the work area AR.
- the information acquisition unit acquires information about an unsuitable travel area inside or outside the work area (S18, S30), and the search unit causes the acquired travel information to be acquired. Since the travel route is searched (S108, S110, S112, S114) on the basis of at least one of the desired area and the information about the unsuitable area, in addition to the above-mentioned effect, it is possible to preferentially pass through the area. It is also possible to encourage the user to drive in a certain desired travel area.
- the information regarding the traveling unsuitable area AR5 acquired by the information acquisition unit is provided with an unsuitable rate AR5a indicating a degree of unsuitable traveling, and the search unit is configured to perform the above-mentioned operation based on the information regarding the traveling unsuitable area.
- the travel route is searched according to the inadequacy rate (S114). Therefore, in addition to the above-described effects, it is possible to effectively control the travel in the travel inadequate region. For example, when the unsuitable area is the pond and the slope AR5 around it, by considering the unsuitable rate AR5a attached thereto, it is possible to avoid the occurrence of ruts caused by different routes each time the vehicle travels and the route becomes the same. You can
- the unsuitability ratio AR5a is configured to have characteristics similar to the contour line, in addition to the above-mentioned effects, the unsuitability degree in the unsuitable running area can be expressed in relation to the inclination of the road surface. It becomes possible to control the traveling in the vehicle more effectively.
- the processor 44a includes at least a processor 44a, a memory 44b that stores data described in a map MP in which a plurality of cells Cmp are arranged in the work area, and an input / output circuit I / O 44c, and the processor acquires the information.
- the information acquisition unit includes an electronic control unit (ECU) 44 functioning as a search unit, a search unit, and a control unit, and when the narrow road having a narrow traveling width is detected on the map, the information acquisition unit Since the data about the cell is obtained as the information regarding the desired traveling area (S20, S22), the user can save time and effort in addition to the above effects.
- ECU electronice control unit
- the information acquisition unit is configured to acquire the information input from the input device 66 connected via the input / output circuit as the information (S12 to S18), in addition to the effects described above, the user, etc. It is possible to easily input information regarding the desired traveling area or the inappropriate traveling area.
- the information acquisition unit is configured to acquire information input from an external communication terminal connected via the input / output circuit as the information (S24 to S30), in addition to the above effects, the user It is possible to easily input information regarding a desired traveling area or an inappropriate traveling area.
- the information acquisition unit is configured to acquire the information from the captured image obtained by the photographing device (S32 to S38). Therefore, in addition to the effects described above, it is possible to easily input information regarding the desired traveling region or the inappropriate traveling region without bothering the user.
- the autonomous mobile working machine 10 is a lawnmower
- the information acquisition unit uses at least one of a region in which many people travel and a region in which no grass grows as information about the desired travel region. Since it is configured to acquire (S32 to S38), in addition to the above-described effects, information regarding a desired traveling area in which many people are traveling or grass is not growing can be easily provided without bothering the user. You can enter.
- the search unit sequentially stores the searched travel route in the memory as a travel count on a plurality of cells Cmp of the map MP, and a total value of the sequentially stored travel count is equal to or more than a predetermined value.
- the searched traveling route is modified (S108, S114 to S120), in addition to the above-mentioned effects, it is possible to avoid the occurrence of ruts due to avoiding overlapping traveling routes and becoming the same route. can do.
- the magnetic sensor 360 is used to recognize the boundary line 74 of the work area AR as in the second embodiment and the camera 36 is not used, the input is performed via the input device 66 or the communication terminal 72. As a result, necessary information can be acquired, and thus the boundary line 74 of the work area AR may be recognized in any manner in the present invention.
- the working machine 10 is applied to the lawnmower working machine, but the present invention is not limited thereto, and can be applied to other autonomous traveling working machines capable of autonomous traveling.
- the control device for an autonomous traveling work machine according to the present invention can be suitably used for controlling a working machine capable of autonomous traveling.
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- Aviation & Aerospace Engineering (AREA)
- Remote Sensing (AREA)
- General Physics & Mathematics (AREA)
- Environmental Sciences (AREA)
- Life Sciences & Earth Sciences (AREA)
- Human Computer Interaction (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Multimedia (AREA)
- Electromagnetism (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Harvester Elements (AREA)
Abstract
上記した如く、作業領域内を作業しながら駆動部で駆動されて自律的に走行する自律走行作業機の制御装置において、作業領域の内外で走行が希望される走行希望領域に関する情報を取得する情報取得部と、取得された走行希望領域に関する情報に基づいて作業機の現在位置から目標位置までの走行ルートを検索する検索部(S102からS108)と、検索部で検索された走行ルートに従って駆動部を駆動して作業機を走行させる制御部(S120)とを備える。
Description
この発明は、作業領域内を作業しながら駆動部で駆動されて自律的に走行する自律走行作業機の制御装置に関する。
この種の自律走行作業機の制御装置は、従来、特許文献1で提案されるように、作業領域の外周を規定する境界線を例えば電流が通電されたワイヤなどで構成すると共に、作業領域の内部の池などの作業が不適な領域の境界線も同様にワイヤなどで構成していた。
作業領域が芝生である場合、作業機が充電ステーションなどの目的地に向けて走行する走行ルートは可能な限り走行に不適な領域を回避しつつ、走行が希望される領域を通過することが望ましい。上記特許文献1記載の技術はその点で必ずしも満足し難いものであった。
従って、この発明の課題は、作業機が目的地に向けて走行するとき、可能な限り走行ルートが希望される領域を通過する如く制御するようにした自律走行作業機の制御装置を提供することにある。
上記した課題を解決するため、この発明は、作業領域内を作業しながら駆動部で駆動されて自律的に走行する自律走行作業機の制御装置において、前記作業領域の内外において走行が希望される走行希望領域に関する情報を取得する情報取得部と、前記取得された走行希望領域に関する情報に基づいて前記作業機の現在位置から目標位置までの走行ルートを検索する検索部と、前記検索部で検索された走行ルートに従って前記駆動部を駆動して前記作業機を走行させる制御部とを備える如く構成した。
(第1実施形態)
図1はこの発明の第1実施形態に係る自律走行作業機の説明側面図、図2は図1の自律走行作業機の上面図、図3は図1のECU(電子制御ユニット)の入出力関係を示すブロック図である。
図1はこの発明の第1実施形態に係る自律走行作業機の説明側面図、図2は図1の自律走行作業機の上面図、図3は図1のECU(電子制御ユニット)の入出力関係を示すブロック図である。
以下では上面視における作業機10の進行方向(前後方向)と、それに直交する横方向(左右方向)と、進行方向と横方向に直交する鉛直方向とをそれぞれ前後方向、左右方向、上下方向と定義し、それに従って各部の構成を説明する。
図1において符号10は自律走行作業機(以下「作業機」という)を示す。作業機10は具体的には芝刈り機からなる。作業機10の機体(基体)12はシャシ12aとそれに取り付けられるフレーム12bとからなる。
作業機10は、前後方向においてシャシ12aの前側にステー12a1を介して固定される比較的小径の左右2個の前輪14を備えると共に、後側にシャシ12aに直接取り付けられる比較的大径の左右の後輪16を備える。
作業機10のシャシ12aの中央位置付近には芝刈り作業用のブレード(ロータリブレード)からなる作業部材(以下「ブレード」という)20が取り付けられると共に、その上部には電動モータ(以下「作業モータ」という)22が配置される。ブレード20は作業モータ22に接続され、作業モータ22によって回転駆動される。
ブレード20にはユーザの手動操作自在なブレード高さ調整機構24が接続される。ブレード高さ調整機構24はネジ(図示せず)を備え、そのネジをユーザが手で廻すことでブレード20の接地面GRからの上下方向の高さが調整可能に構成される。尚、手動に代え、電動によって調整可能にしても良い。
作業機10のシャシ12aには、ブレード20の後端側で2個の電動モータ(駆動部。以下「走行モータ」という)26L,26Rが取り付けられる。走行モータ26L,26Rは左右の後輪16に接続され、前輪14を従動輪、後輪16を駆動輪として左右独立に正転(前進方向への回転)あるいは逆転(後進方向への回転)させる。ブレード20と作業モータ22と走行モータ26などはフレーム12bで被覆される。
この実施形態において、作業機10はユーザが運搬可能な重量と寸法を有し、例えば全長(前後方向長さ)71cm程度、全幅55cm程度、高さ30cm程度の寸法を有する。
作業機10の後部には搭載充電ユニット30と搭載電池(バッテリ)32とが格納されると共に、フレーム12bには一対の電池充電端子34が前進方向の前方に突出するように取り付けられる。搭載電池32は例えばリチウムイオン電池からなる。
電池充電端子34は搭載充電ユニット30に配線を介して接続されると共に、搭載充電ユニット30は搭載電池32に接続される。また、作業モータ22と走行モータ26も搭載電池32に接続され、搭載電池32から通電されるように構成される。尚、図1では配線の図示を省略する。
作業機10において機体12の前側には2個のカメラ(撮影機器)36が前方をステレオ視可能に配置される。カメラ36は、作業機10の機体12の前部で、前後方向に延びる機体中心線CL1に対して左右方向に対称となる位置に配置される。尚、カメラ36は1個で単眼視するようにしても良く、さらには前方のみを視るものではなく、360度の全周を視るものでも良い。
また、機体12のフレーム12bには、障害物や異物との接触によってフレーム12bがシャシ12aから外れるとき、オン信号を出力する接触センサ40が取り付けられる。
作業機10の中央位置付近には収納ボックス(図示せず)が設けられると共に、その内部に収納された回路基板42上にはマイクロコンピュータからなる電子制御ユニット(Electronic Control Unit。以下「ECU」という)44が搭載される。図3に示す如く、ECU44は、プロセッサ(CPU)44aと、メモリ(ROM,EEPROM,RAM)44bと、I/O(入出力回路)44cとから少なくともなるマイクロコンピュータから構成される。
また、回路基板42上には、ECU44に近接して作業機10の重心位置のz軸(鉛直軸)回りの角速度(ヨーレート)を示す出力を生じる角速度センサ46と、作業機10に作用するx,y,z軸の直交3軸方向の加速度を示す出力を生じる加速度センサ50と、地磁気に応じた絶対方位を示す出力を生じる方位センサ52が設けられる。
また、作業機10の左右の後輪16の付近には左右の後輪16の車輪速を示す出力を生じる車輪速センサ 54が配置されると共に、シャシ12aとフレーム12bの間には、ユーザなどによってフレーム12bがシャシ12aからリフトされた(持ち上げられた)とき、オン信号を出力するリフトセンサ56が配置される。搭載電池32には搭載電池32の消費電流を示す出力を生じる電流センサ60が配置される。
また、作業機10には、動作開始などを指令するメインスイッチ62と非常停止を指令する非常停止スイッチ64とがユーザの操作自在に設けられる。さらに、作業機10のフレーム12bは上面で大きく切り欠かれてそこにユーザの指令などの入力のためのキーボードやタッチパネルなどの入力機器66が設けられると共に、ディスプレイ70が設けられる。
入力機器66とディスプレイ70はECU44に接続され、ディスプレイ70にはECU44の指令に応じて作業モードなどの各種の情報が表示される。また、ECU44はI/O44cを介して外部の通信端末72と通信可能に構成される。通信端末72は、スマートフォンなど通信機能を備えたPDA(Portable Digital Assistant)からなる。
図3に示す如く、カメラ36、接触センサ40、角速度センサ46などのセンサ類の出力とメインスイッチ62などのスイッチ類の出力は、ECU44に送られ、I/O44cを介して入力される。カメラ36の出力は同様にECUを備える画像処理部36aに送られ、そこで撮像画像が生成される。
ECU44は、画像処理部36aの出力とその他のセンサ出力に基づき、搭載電池32から走行モータ26に通電すると共に、I/O44cを介して制御値を出力して走行モータ26を駆動して作業機10の走行を制御する。
走行モータ26L,26Rは左右の後輪16を互いに独立に正転(前進方向への回転)あるいは逆転(後進方向への回転)可能に構成され、左右の後輪16の回転に速度差を生じさせて作業機10を任意の方向に旋回させるように構成される。
例えば、左右の後輪16をそれぞれ正転させる際、右後輪16の回転速度を左後輪16の回転速度よりも速くすると、その速度差に応じた旋回角度で作業機10を左方に旋回させる一方、左後輪16の回転速度を右後輪16の回転速度よりも速くすると、その速度差に応じた旋回角度で作業機10を右方に旋回させることができる。また、左右の後輪16を互いに同一速度で一方を正転、他方を逆転させると、作業機10をその場で旋回させることができる。
また、ECU44はセンサ類の出力、特にカメラ36の出力から作業領域ARを検出(認識)し、それに基づいて作業モータ22に通電して作業領域ARで作業させる。図4に作業領域ARを示す。
作業領域ARの境界線(周縁)74の付近には作業機10の搭載電池32を充電するための充電ステーション(以下「充電ST」という)76が配置される。図5は充電ST76の電気的な構成を示すブロック図である。
同図に示す如く、充電ST76は、電源(商用電源)80にコンセント82を介して接続される充電器84と、充電器84に接続される一対の充電端子86とを備える。充電端子86は、作業機10に搭載される一対の電池充電端子34にその接点34a(図2に示す)を介して接続自在に構成される。
充電器84は、AC/DC変換器84aと、AC/DC変換器84aの動作を制御するマイクロコンピュータからなる充電用ECU(電子制御ユニット)84bを備える。
充電ST76において電源80からコンセント82を通じて送られる交流は、充電器84のAC/DC変換器84aで適宜な電圧に降圧されつつ直流に変換されて充電端子86に送られ、帰還した作業機10が充電端子86と電池充電端子34とを介して接続(ドッキング)されたとき、作業機10の搭載電池32を充電するように構成される。
即ち、作業機10においてECU44のメモリ44bには充電ST76の画像が格納されており、ECU44はそれをカメラ36の画像処理部36aで得られた撮像画像と比較することによって充電ST76の位置を認識して帰還するように構成される。尚、作業機10の搭載電池32の充電は、端子34,86による接続に限らず、無線充電によっても良い。
次いで、作業領域ARあるいはその検出(認識)などについて図4を参照して説明する。
ECU44は、作業領域ARを、その境界線(周縁)74に配置されるマーカ90をカメラ36の画像処理部36aで得られた撮像画像に基づいて検出(認識)する。マーカ90は着色された三角形の立方体からなり、境界線74上に適宜な間隔をおいて配置される。
作業機10においてECU44は、画像処理部36aから送られる撮像画像と車輪速センサ54と方位センサ52などの出力に基づき、作業機10を境界線74に沿って作業領域ARを周回させて作業領域AR全体を認識(検出)して作業領域ARのマップ(作業領域マップ)MPを生成する。
図6にそのマップMPを示す。マップMPは図示の如く、充電ST76の位置を原点とし、かつ方位センサ52によって規定される所定方位を基準とする直交2軸座標の平面(XY平面)上において境界線74の内側の作業領域ARを格子状に等間隔に分割して得られる複数のセルCmpを配列してなるデータから構成される。
マップMPにおいて、セルCmpはそれぞれ作業領域ARにおいて例えば縦横0.5m程度の大きさに相当すると共に、それぞれ固有の位置座標(X,Y座標)からなるデータを有する。ECU44は図示のマップMPに基づいて後述の如く、作業機10の走行を制御する。
図4に戻って作業領域ARについて説明すると、この実施形態において作業領域ARは矩形状の2つの領域AR1,AR2と、領域AR1,AR2を接続する走行幅の狭い狭路AR3とからなる。狭路AR3の幅Wは作業機10の左右方向の幅のm倍(例えば1.5倍)以上でn倍(例えば4倍)以下とする。
また、作業領域ARはユーザが居住する敷地の門Gから家屋Hに連なる付近にはユーザを含む人の通り道AR4が形成され、通り道AR4は芝が最初から植栽されていないか、あるいは植栽されていても芝がほとんど生育しない領域を意味する。
また、領域AR1には池が配置されると共に、池の周辺には斜面が形成される。池とその周辺の斜面AR5は図4で左側の傾斜が右側のそれよりも大きい(急峻)であるように構成される。
この実施形態において、上記した狭路AR3はマップMP上に検出されるとき、また通り道AR4は入力機器66あるいは通信端末72を介して入力されるとき、(ユーザによって)走行が希望される走行希望領域とされると共に、池とその周辺の斜面AR5は入力機器66あるいは通信端末72を介して入力されるとき、走行が不適な走行不適領域とされる。
尚、この実施形態において、「走行希望領域」は作業領域ARの内外において、作業機10の搭載電池32の充電量が閾値を下回っても充電ST76に確実に帰還させたい場合、あるいは領域AR1とAR2の一方で作業を終了した後に他方に移動させたい場合などに特に選択が希望される領域を意味し、「走行不適領域」はそのような場合の走行に適さない領域を意味する。
ECU44は後述する如く、狭路AR3が検出されるとき、あるいはそれらが入力機器66などを介して入力されるとき、それらについてのマップMP上のセルCmpの位置データを走行希望領域に関する情報として取得する。
即ち、図3に示す如く、ECU44は走行希望領域などの情報を取得する情報取得部44a1と、取得された走行希望領域などに関する情報に基づいて作業領域AR内の作業機10の現在位置から目標位置(例えば充電ST76)までの走行ルートを検索する検索部44a2と、検索部で検索された走行ルートに従って電動モータ(駆動部)26を駆動して作業機10を走行させる制御部44a3として動作(機能)する。
尚、池とその周辺の斜面AR5からなる走行不適領域の場合、図4に示す如く、そこに走行が不適な程度を示す不適率AR5aが付される。不適率AR5aは等高線類似の特性を備え、傾斜が、凹状にせよ凸状にせよ、大きいほど隣接する線の間隔が小さくなるように設定されると共に、周辺から中央(池)に向かうに従って、0,1,2,3などと増える数値を付される。
尚、この種の走行不適領域は池とその周辺などに限らず、作業機10が落下する恐れがある細い橋や、ユーザが轍の発生を生じさせたくない箇所とその周辺などであっても良い。
次いで、図7フロー・チャートを参照してECU44の動作を説明する。
以下説明すると、S(S:処理ステップ)10において作業機10を作業領域ARの境界線74に配置されたマーカ90に沿って一巡させ、マップMPを生成してメモリ44bに格納する。マップMPは作業機10の外部からI/O44cを介して通信端末72とアクセス可能に構成される。
次いでS12に進み、ユーザなどから入力機器66を介して通り道AR4などの走行希望領域の入力があったか否か判断する。S12で肯定されるときはS14に進み、マップMPの該当セルに記入する(走行希望領域に関する情報取得する)一方、否定されるときはS14の処理をスキップする。
次いでS16に進み、ユーザなどから入力機器66を介してAR5などの走行不適領域の入力があったか否か判断する。S16で肯定されるときはS18に進み、マップMPの該当セルに記入する(走行不適領域に関する情報取得する)一方、否定されるときは以降の処理をスキップする。
次いでS20に進み、マップMPに狭路AR3があるか否か判断し、肯定されるときはS22に進み、マップMPの該当セルに走行希望領域として記入する(走行希望領域に関する情報を取得する)。
即ち、狭路AR3は領域AR1,AR2の一方で作業が終了した後などに他方に移動するために必ず走行する領域であり、その結果芝が踏み荒らされて芝剥ぎが起きている可能性が高い。よって狭路AR3を優先的に走行させることで他の領域での芝剥ぎを減少させることとする。一方、S20で否定されるときはS22の処理をスキップする。
次いでS24に進み、ユーザなどから通信端末72を介して通り道AR4などの走行希望領域の入力があったか否か判断し、肯定されるときはS26に進み、マップMPの該当セルに走行希望領域として記入する(走行希望領域に関する情報を取得する)一方、否定されるときはS26の処理をスキップする。
次いでS28に進み、ユーザなどから通信端末72を介してAR5などの走行不適領域の入力があったか否か判断し、肯定されるときはS30に進み、マップMPの該当セルに走行不適領域として記入する(走行不適領域に関する情報を取得する)。一方、S28で否定されるときはS30の処理をスキップする。
次いでS32に進み、画像処理部36aから出力される撮像画像に、前記したAR4の他に、人の走行が多い領域が検出されたか否か判断し、肯定されるときはS34に進み、マップMPの該当セルに走行希望領域として記入する(走行希望領域に関する情報を取得する)。
即ち、人の走行が多いということは芝が踏み荒らされて芝剥ぎが起きているか、芝がそもそも植栽されていない可能性が高く、よってこの領域を優先的に走行させることで他の領域での芝剥ぎを減少できるからである。一方、S32で否定されるときはS34の処理をスキップする。
次いでS36に進み、画像処理部36aから出力される撮像画像に、前記したAR4の他に、芝の生育していない領域が検出されたか否か判断し、肯定されるときはS38に進み、マップMPの該当セルに走行希望領域として記入(走行希望領域に関する情報を取得)する。
これも芝の生育していない領域を優先的に走行させることで他の領域の芝剥ぎを減少させるためである。尚、S36で否定されるときは以降の処理をスキップして終わる。
図8は、図7の処理の後に行われるECU44の処理を示すフロー・チャートである。
以下説明すると、S100においてマップMP上の自機位置を作業領域ARの境界線74と車輪速センサ54などのセンサ出力から特定する。
次いでS102に進み、走行希望領域と走行不適領域に関する情報が共にあるか否か判断し、否定されるときはS104に進み、走行希望領域のみあるか否か判断する。
S102あるいはS104で肯定されるときはS106に進み、走行希望領域を選択し、S108に進み、走行希望領域に関する情報に基づいて自機位置から目的地までの走行ルートを検索し、メモリ44bの走行するセルCmpの該当アドレスに走行回数を検索するたびに経時的に順次記入(格納)する。
走行ルートは具体的には作業領域ARの境界線74に対する自機位置を車輪速センサ54と方位センサ52の出力などから検出し、そこから目的地(充電ST76)までの走行が走行希望領域を通過しながら可能な限り最短となるように最短となるように検索する。尚、方位センサ52に代え、カメラ36の撮像画像を用いる、あるいはGPS受信機を設けてその出力を用いるようにしても良い。
他方、S102とS104で否定されるときはS110に進み、走行不適領域のみあるか否か判断し、肯定されるときはS112に進み、走行不適領域を選択する。
次いでS114に進み、走行不適領域に関する情報に基づいて自機位置から目的地までの走行ルートを検索し、メモリ44bの走行するセルCmpの該当アドレスに走行回数を検索するたびに経時的に順次記入(格納)する。
走行ルートの検索と記入自体は走行希望領域に関する情報に基づく場合と基本的に同じであるが、走行不適領域に関する情報に基づく場合、不適率を考慮して走行ルートを検索する。
図4で示した池とその周辺の斜面AR5に付される不適率AR5aを参照して説明すると、不適率は池の周辺から中央に向かうに従って増える数値からなることから、池とその周辺の斜面AR5を経由して走行するとき、目的地までの最短距離ではなく、数値が小さい領域を選択することで走行ルートを算出する。その結果、池のような走行不適領域を回避しつつ、走行のたびに池からの距離を少しずつ変更して轍が重ならないように制御することも可能となる。
尚、S110で否定されるときはS114の処理をスキップする。次いでS116に進み、記入(格納)されたセルCmpの走行回数が適宜設定される所定値以上か否か判断し、肯定されるときはS118に進み、S108あるいはS114で検索された走行ルートを修正する。S116で否定されるときはS118の処理をスキップする。
次いでS120に進み、検索された(あるいは修正された)走行ルートに従って駆動部(走行モータ)26を駆動して自機(作業機)10を走行させる。
この実施形態は上記の如く構成したので、作業機10が目的地に向けて走行するとき、可能な限り走行ルートが希望される走行希望領域を通過するように制御することができる。
(第2実施形態)
図9はこの発明の第2実施形態に係る自律走行作業機を全体的に示す、図1と同様の概念図、図10は図9の自律走行作業機の上面図、図11は図10のECUの入出力関係を示す、図3と同様のブロック図である。
図9はこの発明の第2実施形態に係る自律走行作業機を全体的に示す、図1と同様の概念図、図10は図9の自律走行作業機の上面図、図11は図10のECUの入出力関係を示す、図3と同様のブロック図である。
第1実施形態と相違する点に焦点をおいて説明すると、第2実施形態にあっては、作業領域ARの境界線74を認識するのに、カメラ36と画像処理部36aに代え、作業機10の前方左右に配置した2個の磁気センサ360L,360Rと後方に配置した1個の磁気センサ360Cを用いるようにした。
より具体的には、作業領域ARの境界線74の下部の地中に電線を埋設し、それに図5に示した充電器84のAC/DC変換器84aから直流電流を通電し、その電流を磁気センサ360で検出して作業領域ARの境界線74を検出するようにした。その詳細は例えば、米国特許明細書第9,740,204号に記載されているので、これ以上の説明を省略する。
上記した如く、この発明の第1、第2実施形態にあっては、作業領域内ARを作業しながら駆動部(電動モータ)26で駆動されて自律的に走行する自律走行作業機10の制御装置において、前記作業領域ARの内外において走行が希望される走行希望領域に関する情報を取得する情報取得部(44a1,S14,S22,S26,S34,S38)と、前記取得された走行希望領域に関する情報に基づいて前記作業機の現在位置から目標位置までの走行ルートを検索する検索部(44a2,S102,S14,S106,S108)と、前記検索部で検索された走行ルートに従って前記駆動部を駆動して前記作業機を走行させる制御部(44a3,S120)とを備える如く構成したので、作業機10が充電ST76などの目的地に向けて走行するとき、可能な限り走行ルートが希望される走行希望領域を通過するように制御することが可能となり、作業領域ARにおいて芝剥ぎなどの不都合が生じるのを防止することができる。
また、前記情報取得部は、前記走行希望領域に加え、前記作業領域の内外において走行が不適な走行不適領域に関する情報を取得すると共に(S18,S30)、前記検索部は、前記取得された走行希望領域と走行不適領域に関する情報の少なくともいずれかに基づいて前記走行ルートを検索する(S108,S110,S112,S114)如く構成したので、上記した効果に加え、優先的に通過して欲しい領域である走行希望領域での走行を促すことも可能となる。
また、前記情報取得部によって取得される前記走行不適領域AR5に関する情報は走行が不適な程度を示す不適率AR5aが付されてなると共に、前記検索部は、前記走行不適領域に関する情報に基づいて前記走行ルートを検索するとき、前記不適率に従って前記走行ルートを検索する(S114)如く構成したので、上記した効果に加え、走行不適領域での走行を効果的に制御することが可能となる。例えば走行不適領域が池とその周辺の斜面AR5の場合、そこに付される不適率AR5aを考慮することで、走行の度に相違させて同じルートとなることによる轍の発生などを回避することができる。
また、前記不適率AR5aは、等高線類似の特性からなる如く構成したので、上記した効果に加え、走行不適領域での不適の程度を路面の傾斜と関係づけて表現することができ、走行不適領域での走行を一層効果的に制御することが可能となる。
また、プロセッサ44aと、前記作業領域を複数のセルCmpを配列してなるマップMPで記述するデータを格納するメモリ44bと、入出力回路I/O44cとから少なくとも構成され、前記プロセッサが前記情報取得部と検索部と制御部として機能する電子制御ユニット(ECU)44を備えると共に、前記情報取得部は、前記マップ上に走行幅の狭い狭路が検出されるとき、前記検出された狭路のセルについてのデータを前記走行希望領域に関する情報として取得する(S20,S22)如く構成したので、上記した効果に加え、ユーザなどが入力する手間を省くことができる。
また、前記情報取得部は、前記入出力回路を介して接続される入力機器66から入力される情報を前記情報として取得する(S12からS18)如く構成したので、上記した効果に加え、ユーザなどが走行希望領域あるいは走行不適領域に関する情報を簡易に入力することができる。
また、前記情報取得部は、前記入出力回路を介して接続される外部の通信端末から入力される情報を前記情報として取得する(S24からS30)如く構成したので、上記した効果に加え、ユーザなどが走行希望領域あるいは走行不適領域に関する情報を簡易に入力することができる。
また、前記作業領域を撮影する撮影機器(カメラ36、画像処理部36a)を備え、前記情報取得部は、前記撮影機器で得られた撮像画像から前記情報を取得する(S32からS38)如く構成したので、上記した効果に加え、ユーザの手間を煩わせることなく、走行希望領域あるいは走行不適領域に関する情報を簡易に入力することができる。
また、前記自律走行作業機10が芝刈り機であると共に、前記情報取得部は、人の走行が多い領域と芝が生育していない領域の少なくともいずれかの情報を前記希望走行領域に関する情報として取得する(S32からS38)如く構成したので、上記した効果に加え、ユーザの手間を煩わせることなく、人の走行の多い、あるいは芝の生育していないような走行希望領域に関する情報を簡易に入力することができる。
前記検索部は、前記検索された走行ルートを前記マップMPの複数のセルCmp上の走行回数として前記メモリに経時的に順次格納すると共に、前記順次格納された走行回数の合計値が所定値以上のとき、前記検索された走行ルートを修正する(S108,S114からS120)如く構成したので、上記した効果に加え、走行ルートの重複を回避して同じルートとなることによる轍の発生などを回避することができる。
尚、上記において第2実施形態のような作業領域ARの境界線74の認識に磁気センサ360を用いてカメラ36を用いない場合であっても、入力機器66あるいは通信端末72を介して入力することで、必要な情報を取得することが可能となるので、この発明において作業領域ARの境界線74の認識はどのように行っても良いものである。
また、作業機10を芝刈り作業機に適用したが、この発明はそれに限られるものではなく、他の自律走行可能な自律走行作業機に適用可能である。
この発明に係る自律走行作業機の制御装置は、自律走行可能な作業機の制御に好適に使用することができる。
10 自律走行作業機(作業機)、12 機体、14 前輪、16 後輪、20 ブレード(作業部材)、22 電動モータ(作業モータ)、24 ブレード高さ調節機構、26 電動モータ(駆動部。走行モータ)、30 搭載充電ユニット、32 搭載電池、34 電池充電端子、36 カメラ、36a 画像処理部、360 磁気センサ、44 電子制御ユニット(ECU)、44a プロセッサ、44a1 情報取得部、44a2 検索部、44a3 制御部、46 角速度センサ、50 加速度センサ、52 方位センサ、54 車輪速センサ、66 入力機器、70 ディスプレイ、72 通信端末、74 境界線、76 充電ステーション(ST)、84 充電器、86 充電端子、AR 作業領域、AR3 狭路、AR4 走行希望領域(通り道)、AR5 走行不適領域(池とその斜面)
Claims (10)
- 作業領域内を作業しながら駆動部で駆動されて自律的に走行する自律走行作業機の制御装置において、
前記作業領域の内外において走行が希望される走行希望領域に関する情報を取得する情報取得部と、
前記取得された走行希望領域に関する情報に基づいて前記作業機の現在位置から目標位置までの走行ルートを検索する検索部と、
前記検索部で検索された走行ルートに従って前記駆動部を駆動して前記作業機を走行させる制御部と、
を備えることを特徴とする自律走行作業機の制御装置。 - 前記情報取得部は、前記走行希望領域に加え、前記作業領域の内外において走行が不適な走行不適領域に関する情報を取得すると共に、
前記検索部は、前記取得された走行希望領域と走行不適領域に関する情報の少なくともいずれかに基づいて前記走行ルートを検索することを特徴とする請求項1に記載の自律走行作業機の制御装置。 - 前記情報取得部によって取得される前記走行不適領域に関する情報は走行が不適な程度を示す走行不適率が付されてなると共に、
前記検索部は、前記走行不適領域に関する情報に基づいて前記走行ルートを検索するとき、前記走行不適率に従って前記走行ルートを検索することを特徴とする請求項2に記載の自律走行作業機の制御装置。 - 前記走行不適率は、等高線類似の特性からなることを特徴とする請求項2または3に記載の自律走行作業機の制御装置。
- プロセッサと、前記作業領域を複数のセルを配列してなるマップで記述するデータを格納するメモリと、入出力回路とから少なくとも構成され、前記プロセッサが前記情報取得部と検索部と制御部として機能する電子制御ユニットを備えると共に、
前記情報取得部は、前記マップ上に走行幅の狭い狭路が検出されるとき、前記検出された狭路のセルについてのデータを前記走行希望領域に関する情報として取得することを特徴とする請求項1から4のいずれか1項に記載の自律走行作業機の制御装置。 - 前記情報取得部は、前記入出力回路を介して接続される入力機器から入力される情報を前記情報として取得することを特徴とする請求項5に記載の自律走行作業機の制御装置。
- 前記情報取得部は、前記入出力回路を介して接続される外部の通信端末から入力される情報を前記情報として取得することを特徴とする請求項5または6に記載の自律走行作業機の制御装置。
- 前記作業領域を撮影する撮影機器を備え、前記情報取得部は、前記撮影機器で得られた撮像画像から前記情報を取得することを特徴とする請求項1から7のいずれか1項に記載の自律走行作業機の制御装置。
- 前記自律走行作業機が芝刈り機であると共に、
前記情報取得部は、人の走行が多い領域と芝が生育していない領域の少なくともいずれかの情報を前記希望走行領域に関する情報として取得することを特徴とする請求項1から8のいずれか1項に記載の自律走行作業機の制御装置。 - 前記検索部は、前記検索された走行ルートを前記マップの複数のセル上の走行回数として前記メモリに経時的に順次格納すると共に、前記順次格納された走行回数の合計値が所定値以上のとき、前記検索された走行ルートを修正することを特徴とする請求項5から9のいずれか1項に記載の自律走行作業機の制御装置。
Priority Applications (3)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| DE112018008157.5T DE112018008157T5 (de) | 2018-11-20 | 2018-11-20 | Steuervorrichtung einer autonom navigierenden Arbeitsmaschine |
| PCT/JP2018/042745 WO2020105101A1 (ja) | 2018-11-20 | 2018-11-20 | 自律走行作業機の制御装置 |
| US17/292,632 US12185662B2 (en) | 2018-11-20 | 2018-11-20 | Control apparatus of autonomously navigating work machine |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| PCT/JP2018/042745 WO2020105101A1 (ja) | 2018-11-20 | 2018-11-20 | 自律走行作業機の制御装置 |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| WO2020105101A1 true WO2020105101A1 (ja) | 2020-05-28 |
Family
ID=70774666
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| PCT/JP2018/042745 Ceased WO2020105101A1 (ja) | 2018-11-20 | 2018-11-20 | 自律走行作業機の制御装置 |
Country Status (3)
| Country | Link |
|---|---|
| US (1) | US12185662B2 (ja) |
| DE (1) | DE112018008157T5 (ja) |
| WO (1) | WO2020105101A1 (ja) |
Cited By (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US20210373561A1 (en) * | 2020-06-01 | 2021-12-02 | Honda Motor Co., Ltd. | Movable body control device, movable body, movable body management system, movable body control method, and program |
| EP4700525A4 (en) * | 2023-04-21 | 2026-04-08 | Positec Power Tools Suzhou Co Ltd | METHOD FOR CONTROLLING A SELF-PROPOSED DEVICE, STORAGE SUPPORT AND SELF-PROPOSED DEVICE |
Families Citing this family (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| EP4332931A4 (en) * | 2021-04-27 | 2025-06-11 | Kubota Corporation | IMPLEMENTATION MACHINE MONITORING SYSTEM |
Citations (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH04333903A (ja) * | 1991-05-09 | 1992-11-20 | Fujita Corp | 自走車の走行制御装置 |
| JP2009265941A (ja) * | 2008-04-24 | 2009-11-12 | Panasonic Electric Works Co Ltd | 自律移動装置 |
| JP2013103135A (ja) * | 2011-11-14 | 2013-05-30 | Samsung Electronics Co Ltd | ロボット掃除機及びその制御方法 |
| JP2016186749A (ja) * | 2015-03-27 | 2016-10-27 | 本田技研工業株式会社 | 無人作業車の制御装置 |
| JP2016186750A (ja) * | 2015-03-27 | 2016-10-27 | 本田技研工業株式会社 | 無人作業車の制御装置 |
Family Cites Families (8)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| DK2703925T3 (da) | 2011-04-28 | 2021-05-10 | Positec Power Tools Suzhou Co Ltd | Automatisk arbejdssystem, automatisk gangindretning og styrefremgangsmåde dertil |
| US9594380B2 (en) * | 2012-03-06 | 2017-03-14 | Travis Dorschel | Path recording and navigation |
| EP2689650B1 (en) * | 2012-07-27 | 2014-09-10 | Honda Research Institute Europe GmbH | Trainable autonomous lawn mower |
| WO2014027945A1 (en) * | 2012-08-14 | 2014-02-20 | Husqvarna Ab | Mower with object detection system |
| US10405488B2 (en) * | 2014-12-23 | 2019-09-10 | Husqvarna Ab | Zone control system for a robotic vehicle |
| EP3081068B1 (en) * | 2015-04-17 | 2021-06-09 | Honda Research Institute Europe GmbH | Autonomous lawn mower, module for an autonomous lawn mower and system comprising such autonomous lawn mower and module |
| WO2019099253A1 (en) * | 2017-11-20 | 2019-05-23 | The Toro Company | System and method for operating an autonomous robotic working machine within a travelling containment zone |
| EP4397167A3 (en) * | 2018-08-08 | 2024-09-25 | The Toro Company | Autonomous machine navigation and training using vision system |
-
2018
- 2018-11-20 US US17/292,632 patent/US12185662B2/en active Active
- 2018-11-20 WO PCT/JP2018/042745 patent/WO2020105101A1/ja not_active Ceased
- 2018-11-20 DE DE112018008157.5T patent/DE112018008157T5/de active Pending
Patent Citations (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH04333903A (ja) * | 1991-05-09 | 1992-11-20 | Fujita Corp | 自走車の走行制御装置 |
| JP2009265941A (ja) * | 2008-04-24 | 2009-11-12 | Panasonic Electric Works Co Ltd | 自律移動装置 |
| JP2013103135A (ja) * | 2011-11-14 | 2013-05-30 | Samsung Electronics Co Ltd | ロボット掃除機及びその制御方法 |
| JP2016186749A (ja) * | 2015-03-27 | 2016-10-27 | 本田技研工業株式会社 | 無人作業車の制御装置 |
| JP2016186750A (ja) * | 2015-03-27 | 2016-10-27 | 本田技研工業株式会社 | 無人作業車の制御装置 |
Cited By (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US20210373561A1 (en) * | 2020-06-01 | 2021-12-02 | Honda Motor Co., Ltd. | Movable body control device, movable body, movable body management system, movable body control method, and program |
| EP4700525A4 (en) * | 2023-04-21 | 2026-04-08 | Positec Power Tools Suzhou Co Ltd | METHOD FOR CONTROLLING A SELF-PROPOSED DEVICE, STORAGE SUPPORT AND SELF-PROPOSED DEVICE |
Also Published As
| Publication number | Publication date |
|---|---|
| US20220000017A1 (en) | 2022-01-06 |
| US12185662B2 (en) | 2025-01-07 |
| DE112018008157T5 (de) | 2021-08-05 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| AU2024220020B2 (en) | Autonomous machine navigation and training using vision system | |
| JP6263567B2 (ja) | 自律走行作業車の制御装置 | |
| US20250172940A1 (en) | Autonomous machine navigation with object detection and 3d point cloud | |
| JP6212590B2 (ja) | 自律走行作業車の制御装置 | |
| US10222797B2 (en) | Control apparatus for autonomously navigating utility vehicle | |
| US10268206B2 (en) | Control apparatus for utility vehicle | |
| JP6498627B2 (ja) | 自律走行作業車の制御装置 | |
| US9939812B2 (en) | Control apparatus for autonomously navigating utility vehicle | |
| US20200100425A1 (en) | Automatic lawn trimmer and automatic lawn trimming method | |
| WO2020105125A1 (ja) | 自律作業機、自律作業機の制御方法及びプログラム | |
| JP6212591B2 (ja) | 自律走行作業車の制御装置 | |
| JPWO2020110247A1 (ja) | 制御システム、制御装置、自律作業機、制御装置の動作方法、自律作業機の制御方法及びプログラム | |
| JP2016186750A (ja) | 無人作業車の制御装置 | |
| WO2020105101A1 (ja) | 自律走行作業機の制御装置 | |
| JP7116799B2 (ja) | 自律走行作業機の作業領域ゾーン境界画定装置 | |
| CN118050679A (zh) | 确定机器人园艺工具使用的基站设备的放置位置 | |
| WO2020100264A1 (ja) | 自律作業機、自律作業機の制御方法及びプログラム | |
| JP7554695B2 (ja) | 作業システムおよび充電ステーション | |
| US12510897B2 (en) | Return node map | |
| CN119882710A (zh) | 一种跨区控制方法、自主作业设备及可读存储介质 |
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: 18940901 Country of ref document: EP Kind code of ref document: A1 |
|
| 122 | Ep: pct application non-entry in european phase |
Ref document number: 18940901 Country of ref document: EP Kind code of ref document: A1 |
|
| NENP | Non-entry into the national phase |
Ref country code: JP |