The present invention relates to an autonomous work machine, a method of controlling the same, and a storage medium.
PTL 1 discloses a lane departure prevention device that recognizes the position of a lane marker by using a camera mounted on a vehicle and executes image processing to correct the position of the lane marker when the detected position of the sun is in a backlighting position with respect to the camera.
PTL 1: Japanese Patent Laid-Open No. 2009-37541
However, in an autonomous work machine that observes the external world by using an image captured by a camera and works in a work area while autonomously traveling through various kinds of tracks, if the information of the external world is to be recognized by applying image processing in the manner of PTL 1, a more complicated image processing operation may be needed depending on various kinds of image capturing conditions.
In consideration of the above problem, the present invention provides a technique that, instead of correcting the image of the camera, controls the autonomous work machine to avoid backlighting.
According to one aspect of the present invention, there is provided an autonomous work machine that includes a camera configured to capture an image of an external world, comprising: an obtainment unit configured to obtain, based on date and time information, azimuth information of the sun, and imaging date and time information of the autonomous work machine, sun information that indicates one of a position and an azimuth of the sun in which backlighting can occur while the autonomous work machine is traveling in a work area; and a control unit configured to set, based on the sun information obtained by the obtainment unit, tracks by which the autonomous work machine will avoid backlighting.
According to the present invention, the autonomous work machine can be controlled to avoid backlighting.
Embodiments of the present invention will be described hereinafter with reference to the accompanying drawings. Components described in the embodiments are merely exemplary and are not limited by the following embodiments.
(Outline of Autonomous Work Machine)
In
As shown in
The cameras 11 for capturing the external world of the autonomous work machine 10 are formed by a plurality of cameras (a left camera 11L and a right camera 11R) that can capture the state at the front of the autonomous work machine 10. Distance information between the autonomous work machine 10 and an object, which is present in the front of the autonomous work machine, can be calculated and obtained by using images captured by the cameras 11 (the left camera 11L and the right camera 11R) which have a parallax between the plurality of cameras. In
Each of the cameras 11 (the left camera 11L and the right camera 11R) is held by a pan angle adjustment mechanism 11b for adjusting an angle in the horizontal direction and a tilt angle adjustment mechanism 11c for adjusting an angle in the vertical direction. The ECU 44 (a control unit C2) can control the angle of each camera 11 by controlling at least one of the pan angle adjustment mechanism 11b and the tilt angle adjustment mechanism 11c.
The vehicle body 12 of the autonomous work machine 10 includes a chassis 12a and a frame 12b attached to the chassis 12a. Two front wheels 14 (a left front wheel 14L and a right front wheel 14R) as left and right small-diameter wheels are fixed to the front part of the chassis 12a via the stay 13. Two rear wheels 16 (a left rear wheel 16L and a right rear wheel 16R) as left and right large-diameter wheels are attached to the rear part of the chassis 12a.
The blade 20 is a rotary blade for lawn mowing attached near the central position of the chassis 12a. The work motor 22 is an electric motor arranged above the blade 20. The blade 20 is connected to and rotated by the work motor 22. The motor holding member 23 holds the work motor 22. The rotation of the motor holding member 23 is regulated with respect to the chassis 12a. In addition, the vertical movement of the motor holding member 23 is permitted by a combination of a guide rail and a slider which can move vertically by being guided by the guide rail.
The blade height adjustment motor 100 is a motor for adjusting the height of the blade 20 in the vertical direction from a ground surface GR. The translation mechanism 101 is connected to the blade height adjustment motor 100, and converts the rotation of the blade height adjustment motor 100 into a vertical translational movement. The translation mechanism 101 is also connected to the motor holding member 23 for holding the work motor 22.
The rotation of the blade height adjustment motor 100 is converted into the translational movement (vertical movement) by the translation mechanism 101, and this translational movement is transmitted to the motor holding member 23. The translational movement (vertical movement) of the motor holding member 23 causes the work motor 22 held by the motor holding member 23 to translationally move (vertically move). The height of the blade 20 from the ground surface GR can be adjusted by the vertical movement of the work motor 22.
The travel motors 26 (a left travel motor 26L and a right travel motor 26R) are two electric motors (motors) attached to the chassis 12a of the autonomous work machine 10. The two electric motors are connected to the left and right rear wheels 16. The left and right rear wheels are independently rotated forward (rotated in an advancing direction) or rotated backward (rotated in a reversing direction) by using the front wheels 14 as driven wheels and the rear wheels 16 as driving wheels. This allows the autonomous work machine 10 to move in various directions.
The charging terminal 34 is a charging terminal installed in the front end position of the frame 12b in the front-and-rear direction, and can receive power from a charging station when connected to a corresponding charging terminal of the charging station. The charging terminal 34 is connected to the charging unit 30 by a wiring line, and the charging unit 30 is connected to the battery 32. The work motor 22, the travel motors 26, and the blade height adjustment motor 100 are also connected to the battery 32, and receive power from the battery 32.
The ECU 44 is an electronic control unit including a microcomputer formed on a circuit board, and controls the operation of the autonomous work machine 10. Details of the ECU 44 will be described later. The notification unit 35 notifies a user of the occurrence of an abnormality in a case in which an abnormality has occurred in the autonomous work machine 10. For example, notification can be performed by sound or display. Alternatively, notification can be performed by outputting an abnormality generation notification to an external device which is wirelessly connected to the autonomous work machine 10. The user can be notified of the occurrence of an abnormality through the external device.
(Control Block Diagram)
The memory 44c stores a work schedule of the autonomous work machine 10, information about a work area, various kinds of programs for controlling the operation of the autonomous work machine 10, and an area map that shows the shape of the work area. The autonomous work machine 10 can perform predetermined work in a work area while autonomously traveling in the work area based on the area map of the work area. The ECU 44 can operate as each processing unit for implementing the present invention by reading out and executing a program stored in the memory 44c.
The ECU 44 is connected to the various kinds of sensors S. The sensors S include an azimuth sensor 46, a GPS sensor 48, a wheel speed sensor 50, an angular velocity sensor 52, an acceleration sensor 54, a current sensor 62, a blade height sensor 64, and magnetic sensors 66.
The azimuth sensor 46 and the GPS sensor 48 are sensors for obtaining information of the direction and the position of the autonomous work machine 10. The azimuth sensor 46 detects the azimuth corresponding to the terrestrial magnetism. The GPS sensor 48 receives radio waves from GPS satellites and detects information indicating the current position (the latitude and the longitude) of the autonomous work machine 10.
The wheel speed sensor 50, the angular velocity sensor 52, and the acceleration sensor 54 are sensors for obtaining information on the state of the movement of the autonomous work machine 10. The wheel speed sensor 50 detects the wheel speeds of the left and right rear wheels 16. The angular velocity sensor 52 detects the angular velocity around the vertical axis (the z-axis in the perpendicular direction) in the barycentric position of the autonomous work machine 10. The acceleration sensor 54 detects accelerations in the directions of three perpendicular axes, that is, the x-, y-, and z-axes, which act on the autonomous work machine 10.
The current sensor 62 detects the current consumption (power consumption) of the battery 32. The detection result of the current consumption (power consumption) is saved in the memory 44c of the ECU 44. When a predetermined power amount is consumed and the power amount stored in the battery 32 becomes equal to or lower than a threshold value, the ECU 44 executes control to return the autonomous work machine 10 to a charging station ST (
The blade height sensor 64 detects the height of the blade 20 from the ground surface GR. The blade height sensor 64 outputs the detection result to the ECU 44. Under the control of the ECU 44, the blade height adjustment motor 100 is driven, and the blade 20 vertically moves, thereby adjusting the height from the ground surface GR.
Magnetic sensors 66 (a right magnetic sensor 66R and a left magnetic sensor 66L) are arranged at symmetrical positions to each other in the left-and-right direction of the autonomous work machine 10. Each magnetic sensor outputs a signal indicating the magnitude of the magnetic field (magnetic field strength) to the ECU 44.
The outputs from the various sensors S are input to the ECU 44 via the I/O 44b. Based on the outputs from the various sensors S, the ECU 44 supplies power from the battery 32 to the travel motors 26, the work motor 22, and the height adjustment motor 100. The ECU 44 controls the travel motors 26 by outputting a control value via the I/O 44b, thereby controlling travel of the autonomous work machine 10. The ECU 44 also controls the height adjustment motor 100 by outputting a control value via the I/O 44b, thereby controlling the height of the blade 20. Furthermore, the ECU 44 controls the work motor 22 by outputting a control value via the I/O 44b, thereby controlling the rotation of the blade 20. The I/O 44b can function as a communication interface (communication unit), and can wirelessly communicate with a server 350 via a network 320.
A date and time information database SD1 that stores date and time information which indicates the sunshine hours and an azimuth information database SD2 that stores azimuth information of the sun corresponding to the sunshine hours are stored in the server 350. The date and time information database SD1 and the azimuth information database SD2 are databases stored in advance in the server 350, and the I/O 44b (communication unit) of the autonomous work machine 10 can store (download) the databases SD1 and SD2 obtained from the server 350 in the memory 44c. The CPU 44a can refer to the databases SD1 and SD2 stored in the memory 44c and execute various kinds of processing.
Note that instead of downloading the databases SD1 and SD2 from the server 350, the I/O 44b (communication unit) of the autonomous work machine 10 can also obtain predetermined data by referring to the databases SD1 and SD2 in the server 350 by executing wireless communication with the server 350.
A work area database SD3 that stores backlight information related to a work area where the autonomous work machine 10 will actually work is also stored in the server 350. Here, backlighting refers to a state in which the camera is faced toward the direction of a light source (for example, the sun) or a state in which the camera is faced toward a direction close to the direction of the light source while image capturing of the external world is performed by each camera 11. Backlighting can occur in a state in which the direction (optical axis) of each camera 11 matches the azimuth of the sun or a state in which the sun is positioned within a range of a predetermined angle of view of each camera 11.
In addition, backlight information is information that indicates the generation conditions (the azimuth of the sun and the imaging date and time, the position, and the direction (azimuth) of the autonomous work machine 10 in the work area) of backlighting that occurred in a work area. The work area database SD3 is a database generated based on the information collected while the autonomous work machine 10 is working, and is stored in the memory 44c. The I/O 44b (communication unit) stores the generated work area database SD3 in the storage unit of the server 350. By storing the work area database SD3 in the server 350 on the network 320, the information of the work area database SD3 can be shared among a plurality of autonomous work machines 10 and 15 that are working in the same work area.
In
The ECU 44 includes a determination unit C1, a control unit C2, a generation unit C3, and an obtainment unit C4 as functional components of the CPU 44a for implementing the present invention by reading out and executing programs stored in the memory 44c. The functional components C1 to C4 of the autonomous work machine 10 will be described in detail later.
The determination unit C1 determines whether backlighting has occurred based on images captured by the cameras 11. Also, the determination unit C1 can further determine whether backlighting has occurred by comparing the imaging date and time information of the autonomous work machine and the date and time information obtained from the date and time information database, which stores the date and time information indicating the sunshine hours. Furthermore, the determination unit C1 can further determine whether backlighting has occurred by comparing the azimuth information obtained from the azimuth information database, which stores the azimuth information of the sun corresponding to the date and time information, and the imaging date and time information, the position information, and the direction information of the autonomous work machine 10.
If the determination unit C1 determines that backlighting has occurred, the control unit C2 will control the autonomous work machine 10 to avoid the backlighting (execution of backlight avoidance control). A more specific example of backlight avoidance control will be described later.
In addition, if the determination unit C1 determines that backlighting has not occurred, the control unit C2 will execute normal control. In this case, the control unit C2 will control the autonomous work machine 10 so that the autonomous work machine will execute predetermined work in a work area AR while autonomously traveling in the work area AR based on set predetermined tracks. Alternatively, when the charge amount of the battery 32 has become equal to or less than a threshold, the control unit C2 will execute control to make the autonomous work machine 10 return to the charging station ST.
The generation unit C3 will generate, when the determination unit C1 has determined the occurrence of backlighting, the work area database SD3 that associates the azimuth information of the sun with the imaging date and time information, the position information, and the direction information of the autonomous work machine 10. After the generation unit C3 has stored the generated work area database SD3 in the memory 44c, the I/O 44b will cause the generated work area database SD3 to be stored in the storage unit of the server 350. By storing the work area database SD3 in the server 350 on the network 320, the information of the work area database SD3 can be shared among the plurality of autonomous work machines that are working in the same work area.
The obtainment unit C4 obtains, based on the date and time information, the azimuth information of the sun, and the imaging date and time information of the autonomous work machine 10, sun information that indicates the position or the azimuth of the sun in which backlighting can occur while the autonomous work machine is traveling in the work area.
(Usage Example of Autonomous Work Machine 10)
The charging station ST for charging the battery 32 included in the autonomous work machine 10 is installed inside the work area AR, and the autonomous work machine 10 that has started moving from the charging station ST will travel in the work area AR along a predetermined track. In
When the autonomous work machine 10 starts moving from the charging station ST, the cameras 11 (11L and 11R) start capturing the external world. Here, whether backlighting has occurred will be determined by the determination unit C1 based on the images captured by the cameras 11. Tracks 301 and 304 shown in
Also, in the travel along a track 302, the sun S will be positioned on the left side of the autonomous work machine 10 with respect to the direction of movement of the autonomous work machine 10. Hence, backlighting will not occur because the light from the sun S will not fall in the angle of view of each of the cameras 11 (11L and 11R).
The travel along a track 303 is a movement toward the direction of the sun S. However, in a case in which the light from the sun S is shielded by the trees TR1 and TR2 near the boundary of the work area AR, backlighting will not occur because the light from the sun S will not fall in the angle of view of each of the cameras 11 (11L and 11R).
However, since the latitude and the longitude of the sun S will differ depending on the date and time (month, day, and time) even when the same track 303 is to be traveled, there can be a case in which backlighting will occur because the light from the sun S will fall in the angle of view of each of the cameras 11 (11L and 11R) without being influenced by the trees TR1 and TR2. If the determination unit C1 determines that backlighting has occurred, the generation unit C3 will store, in the work area database SD3, information obtained by associating the azimuth information of the sun with the imaging date and time information, the position information, and the direction information of the autonomous work machine 10. As a result, the generation conditions (the azimuth of the sun and the imaging date and time, the position, and the direction (azimuth) of the autonomous work machine 10 in the work area) of the backlighting that occurred in the work area AR can be accumulated as unique information of the work area AR. Hence, it will be possible to more accurately determine whether backlighting has occurred in accordance with the actual state of the work by referring to the work area database SD3, and this determination can be reflected in the backlight suppression control. If the determination unit C1 determines that backlighting has occurred, the control unit C2 will control the autonomous work machine 10 to avoid the backlighting (execution of backlight avoidance control).
Travel along a track 305 is a movement toward the direction of the sun S. Since the light from the sun S will not be shielded by the trees TR1 and TR2 in the track 305, backlighting can occur because the light from the sun S will fall in the angle of view of each of the cameras 11 (11L and 11R).
In a case in which the determination unit C1 determines that the backlighting has occurred, the generation unit C3 will store, in the work area database SD3 of the memory 44c, the information obtained by associating the azimuth information of the sun with the imaging date and time information, the position information, and the direction information of the autonomous work machine 10. Subsequently, when the determination unit C1 determines that backlighting has occurred, the control unit C2 will control the autonomous work machine 10 to avoid the backlighting (execution of backlight avoidance control).
(Processing Procedure of Autonomous Work Machine 10)
First, in step S401, when the autonomous work machine 10 starts moving from the charging station ST, the cameras 11 (11L and 11R) will start capturing the external world. Each camera 11 can capture a moving image at a predetermined frame rate, and the images captured by the cameras 11 (11L and 11R) are input to the determination unit C1 and the ECU 44 via the I/O 44b.
In step S402, whether backlighting has occurred is determined by the determination unit C1 based on an image captured by each camera 11. Determination conditions are, for example, (1) a case in which an extremely bright portion that exceeds a predetermined threshold is present in the image, (2) a case in which there is no parallax between the left camera 11L and the right camera 11R and an object cannot be recognized in the image (a case in which distance information between the autonomous work machine 10 and the object cannot be obtained), (3) a case in which the captured image matches or is similar to a glare image, which indicates a scene of a backlit state pre-registered in the memory 44c, within a range of a predetermined similarity, (4) a case in which the periphery of a bright portion is dark and the difference between the bright portion and the dark portion is equal to or more than a predetermined threshold in the image, (5) a case in which the white balance exceeds a predetermined threshold, and the like. Whether backlighting has occurred can be determined by the determination unit C1 based on these determination conditions (1) to (5).
If the determination unit C1 determines that backlighting has not occurred (NO in step S402), the control unit C2 will advance the process to step S408, and the control unit C2 will execute normal control in step S408. That is, based on the set predetermined tracks (for example, the track 301 to track 304 of
On the other hand, if the determination unit C1 determines that backlighting has occurred in the determination process of step S402, the process advances to step S403.
In step S403, the determination unit C1 obtains the date and time information. The determination unit C1 may obtain the date and time information by, for example, referring to the date and time information database SD1 of the server 350 or by obtaining the date and time information downloaded in the memory 44c.
In step S404, the determination unit C1 determines whether image capturing by the cameras 11 has been performed within sunshine hours. The determination unit C1 can obtain, based on the work schedule of the autonomous work machine 10 stored in the memory 44c or the information of an internal clock included in the CPU 44a, the information (imaging date and time information) of the date and the time of the image capturing operation when the image capturing is actually performed.
The determination unit C1 determines whether the image capturing operation is an image capturing operation performed within sunshine hours by comparing the imaging date and time information of the autonomous work machine 10 with the date and time information obtained from the date and time information database SD1, which stores the date and time information indicating the sunshine hours. For example, in a case in which sunshine hours are defined to be T1 (6:00) to T2 (18:00) as sunshine information when the imaging date is X (month)/Y (day), backlighting can occur if the imaging date and time information (an imaging time T3 of X (month)/Y (day) (for example, 14:00)) of the autonomous work machine 10 is within the sunshine hours. In such a case, the determination unit C1 will determine that backlighting has occurred (YES in step S404), and advance the process to step S405.
On the other hand, since backlighting cannot occur if the imaging time T3 (for example, 5:30 or 18:30) of the autonomous work machine 10 is outside the sunshine hours, the detection can be determined to be a detection error. In this case, the determination unit C1 will determine that backlighting has not occurred (NO in step S404), and the control unit C2 will advance the process to step S408 to execute normal control.
Note that backlighting can also occur when the state of the external world changes. For example, if the trees that shield the sunlight have grown, a state in which backlighting will not occur even during the sunshine hours can be generated. Also, on the other hand, even in a case in which backlighting did not occur in a previous state, if the trees in the periphery of the work area are cut down, a state in which backlighting will occur can be generated. Cases in which backlighting will occur or not occur can be generated in accordance with various kinds of changes in the state of the external world, such as building of a new house, demolishing of a house, or the like in the vicinity of the work area. When a detection error has been determined for a predetermined number of times, the determination unit C1 will determine that the state of the external world has changed and update the information of the work area database SD3. As a result, each change in the state of the external world of each individual work area to be worked by the autonomous work machine 10 can be reflected in the backlighting determination result.
In step S405, the determination unit C1 obtains the azimuth information of the sun. The determination unit C1 may obtain the azimuth information of the sun by, for example, referring to the azimuth information database SD2 of the server 350 or by obtaining the azimuth information downloaded in the memory 44c.
In step S406, the determination unit C1 compares the imaging date and time information, the position information, and the direction information of the autonomous work machine 10 with the azimuth information obtained from the azimuth information database SD2, which stores the azimuth information of the sun corresponding to the date and time information. As a result of the comparison, if the azimuth of the sun S matches the direction of each camera 11 or the azimuth of the sun S falls within a predetermined range of the angle of view of each of the cameras 11 (11L and 11R), it can be determined that backlighting will occur. In such a case, the determination unit C1 will determine that backlighting has occurred (YES in step S406), and advance the process to step S407.
On the other hand, as a result of the comparison, if the azimuth of the sun S does not match the direction of each camera 11 or the azimuth of the sun S falls outside the range of the predetermined angle of view of each of the cameras 11 (11L and 11R), the detection can be determined to be an detection error because backlighting will not occur. In such a case, the determination unit C1 will determine that backlighting has not occurred (NO in step S406), and the control unit C2 will advance the process to step S408 to execute normal control.
In step S407, if the determination unit C1 has determined that backlighting has occurred, the control unit C2 will control the autonomous work machine 10 to avoid the backlighting (execution of backlight avoidance control).
(More Specific Example of Backlight Avoidance Control)
(On-the-Spot Turn and Traveling While Turning)
A more specific example of backlight avoidance control will be described with reference to
By controlling the autonomous work machine 10 so that the autonomous work machine will turn on the spot or travel while turning, the autonomous work machine can avoid being backlit while continuing work in the work area AR. As a result, it will be possible to prevent a detection error in the external world information.
In
The state will transition to states ST7 and ST8 in a case in which the on-the-spot turn mode is selected. The state ST7 shows a state in which the autonomous work machine has started to turn from the state of the state ST6 (stopped state). In this case, the control unit C2 will control the autonomous work machine 10 to make an on-the-spot turn on a track 701 so the sun will not fall within the range of the angle of view of each of the cameras 11 (11L and 11R). The state ST8 shows a state in which the autonomous work machine 10 has made an on-the-spot turn on the track 701. The autonomous work machine 10 that has made an on-the-spot turn will travel (move with its back toward the sun S) along a track 702 in the reverse direction of the track 701. Since the azimuth of the sun S will fall outside the range of the angle of view of each of the cameras 11 (11L and 11R), backlighting can be avoided.
The state will transition to states ST9 and ST10 in a case in which the advancing-while-turning mode is selected. The state ST9 shows a control state in which the autonomous work machine 10 has started moving along the track 701 from the state ST6 (stopped state) and advances while taking a track for turning so the sun S will not fall within the range of the angle of view of each of the cameras 11 (11L and 11R). The state ST10 shows a state in which the autonomous work machine 10 is traveling along a track 703 after turning. The autonomous work machine 10 that advances while turning will travel along the track 703 in a direction in which the autonomous work machine will move with its back toward the sun S. Since the azimuth of the sun S will fall outside the range of the angle of view of each of the cameras 11 (11L and 11R), backlighting can be avoided. Since the control of the autonomous work machine is started to avoid the backlighting after temporarily stopping, it will be possible to obtain the information of the external world with greater accuracy than a case in which control for avoiding the backlight is performed while the autonomous work machine is moving, and the autonomous work machine can be controlled based on the obtained external world information. However, the temporary stop may also be omitted.
(Track Correction after Turn)
A state ST12 shows a state in which the control unit C2 has corrected, when the determination unit C1 has determined that backlighting has occurred in the track 802, the preset track 802 into a track 803 in which the turning angle has been returned to a direction in which backlighting can be avoided. In a case in which the autonomous work machine 10 travels along the corrected track 803, the sun S will not fall within the range of the angle of view of each of the cameras 11 (11L and 11R), and backlighting can be avoided.
If the autonomous work machine continues to travel based on a track that does not travel toward the sun S, it may skew a worked area in the work area. However, by correcting the preset track 802 into the track 803 set by returning the turning angle to a direction that will barely make the position of the sun S fall outside of a backlighting position, the skewing of the worked area can be prevented.
(Modification)
The first embodiment described, as an example of backlight avoidance control, an example in which the autonomous work machine 10 is made to turn or the track after the turn is corrected. However, the direction of each of the cameras 11 (11L and 11R) may also be corrected. In a case in which the determination unit C1 has determined that backlighting has occurred, the control unit C2 can control the angle of each of the cameras 11 (11L and 11R) so that the sun will not fall within the range of the angle of view of each of the cameras 11 (11L and 11R). Each of the cameras 11 (11L and 11R is held by the pan angle adjustment mechanism 11b for adjusting the angle in the horizontal direction and the tilt angle adjustment mechanism 11c for adjusting the angle in the vertical direction. The control unit C2 can control at least one of the pan angle adjustment mechanism 11b and the tilt angle adjustment mechanism 11c and control the angle of each of the cameras 11 (11L and 11R) to avoid backlighting. For example, the pan angle adjustment mechanism 11b can change the angle of each camera 11 in the horizontal direction or the tilt angle adjustment mechanism 11c can change the angle of each camera 11 in a downward direction. By avoiding backlighting by controlling the angle of each camera while continuing the execution of work, it will be possible to prevent a detection error in the external world information.
The first embodiment descried an arrangement in which a determination unit C1 determines whether backlighting has occurred and an autonomous work machine 10 is controlled to avoid backlighting when the occurrence of backlighting was determined. The second embodiment will describe an arrangement in which a control unit C2 will set the track of the autonomous work machine 10 so that backlighting can be avoided. The arrangement of the autonomous work machine 10 is similar to that of the first embodiment. In this embodiment, as a functional component of the autonomous work machine 10, an obtainment unit C4 will obtain, before the autonomous work machine starts traveling and based on the date and time information, the azimuth information of the sun, and the imaging date and time information of the autonomous work machine 10, sun information that indicates the position or the azimuth of the sun which will be in a backlighting position when the autonomous work machine travels in a work area. The control unit C2 sets, based on the sun information obtained by the obtainment unit C4, a track that will allow the autonomous work machine 10 to avoid backlighting.
(Processing Procedure of Autonomous Work Machine 10)
In step S901, the obtainment unit C4 obtains the date and time information. The obtainment unit C4 can obtain the date and time information by, for example, referring to a date and time information database SD1 of a server 350 or by obtaining the date and time information downloaded in a memory 44c.
In step S902, the obtainment unit C4 obtains the azimuth information of the sun corresponding to the date and time information. The obtainment unit C4 can obtain the azimuth information of the sun by, for example, referring to an azimuth information database SD2 of the server 350 or by obtaining the azimuth information downloaded in the memory 44c.
In step S903, the obtainment unit C4 obtains the imaging date and time information of the autonomous work machine 10. The obtainment unit C4 obtains, based on the work schedule of the autonomous work machine 10 stored in the memory 44c or the information of an internal clock included in a CPU 44a, the information (imaging date and time information) of the date and the time of the image capturing operation when the image capturing is actually performed.
In step S904, before the start of the travel and based on the date and time information obtained in step S901, the azimuth information of the sun obtained in step S902, and the imaging date and time information of the autonomous work machine 10 obtained in step S903, the sun information that indicates the position or the azimuth of the sun, which is to be in a backlighting position when the autonomous work machine is to travel in a work area AR, is obtained by the obtainment unit C4.
Also, in a case in which it is determined, after the autonomous work machine has started traveling, that a track in which backlighting will occur is present among the set tracks while the autonomous work machine is traveling in the work area AR, the generation unit C3 will generate, as the sun information, information obtained by associating the azimuth information of the sun with the imaging date and time information and the position information and the direction information on the track of the autonomous work machine 10. After the generation unit C3 has stored the generated sun information in the work area database of the memory 44c, an I/O 44b (communication unit) will cause the generated sun information to be stored in a storage unit (a work area database SD3) of the server 350.
The sun information collected/generated during the travel in the work area AR is accumulated in the work area database SD3, and the obtainment unit C4 can obtain the sun information by referring to the work area database SD3 of the server 350.
Note that in a case in which the sun information is stored in the work area database SD3 of the server 350 in the state before the autonomous work machine starts traveling, the sun information can be obtained by referring to the work area database SD3 of the server 350 regardless of the processes of step S901 to step S903.
In
In step S905, the control unit C2 will use the sun information obtained by the obtainment unit C4 to set each track of the autonomous work machine 10 so that backlighting can be avoided. The control unit C2 sets the track so that the duration of backlighting or the number of times in which the sun S will fall into the range of the angle of view of each of the cameras 11 (11L and 11R) will be reduced.
Among the tracks shown in
In the tracks shown in
(Camera Angle Control in Synchronization with Track Setting)
In
The control unit C2 will control the angle of each of the cameras 11 (11L and 11R) in accordance with each of the set tracks (1110, 1111, 1112, and 1113). For example, the pan angle adjustment mechanism 11b can change the angle of each camera 11 in the horizontal direction or the tilt angle adjustment mechanism 11c can change the angle of each camera 11 in a downward direction, in accordance with the set track. By executing camera angle control in synchronization with the track setting of the control unit C2, the angle of each camera can be controlled in advance, together with the setting of the track, so as to prevent the sun from falling within the range of the angle of view of each camera. As a result, travel that avoids backlighting can be performed in a track set based on the sun information.
A program that implements the functions of one or more autonomous work machines described in the embodiment is supplied to a system or an apparatus via a network or a storage medium, and one or more processors in the computer of the system or the apparatus can load and execute the program. The present invention can also be implemented by such a mode.
Arrangement 1. An autonomous work machine according to the above-described embodiment is an autonomous work machine (10) that includes a camera (for example, 11 of
an obtainment unit (for example, C4 of
a control unit (for example, C2 of
According to the autonomous work machine of Arrangement 1, when the autonomous work machine is traveling in a work area or returning from the work area to a charging station, the autonomous work machine can travel on tracks that avoid backlighting. Since it can be difficult to accurately obtain the information of the external world in a backlit state, setting each track so as to avoid backlighting will prevent the autonomous work machine from having to travel in a state in which the information of the external world cannot be obtained. Hence, the autonomous work machine will be able to accurately travel in the work area and accurately return to the charging station.
Arrangement 2. In the autonomous work machine according to the above-described embodiment, the control unit (C2) sets the tracks to reduce one of the number of times in which the sun will fall in an angle of view of the camera and a duration of the backlighting.
According to the autonomous work machine of Arrangement 2, a track that can avoid backlighting can be set by a simple method.
Arrangement 3. The autonomous work machine according to the above-described embodiment further comprises:
a generation unit (for example, C3 of
a communication unit (for example, 44b of
wherein the communication unit (44b) causes a database (for example, SD3 of
the obtainment unit (C4) obtains the sun information stored in the database (SD3).
According to the autonomous work machine of Arrangement 3, sun information (the position information or the azimuth information of the sun associated with the imaging date and time information, the position information, and the direction information of the autonomous work machine) of times at which backlighting occurs can be accumulated, as unique information of the work area, in accordance with the actual work. As a result, whether backlighting has occurred can be determined more accurately in accordance with the actual work by referring to the work area database, and a track that avoids backlighting can be set based on the determination result.
Arrangement 4. In the autonomous work machine according to the above-described embodiment, the camera (11) is held by a pan angle adjustment mechanism (for example, 11b of
the control unit (C2) controls at least one of the pan angle adjustment mechanism (11b) and the tilt angle adjustment mechanism (11c) to control the angle of the camera (11).
According to the autonomous work machine of Arrangement 4, when the autonomous work machine is traveling in a work area or returning from the work area to a charging station, backlighting can be avoided by controlling the angle of the camera based on the sun information.
Arrangement 5. In the autonomous work machine according to the above-described embodiment, the control unit (C2) controls the angle of the camera (11) in accordance with the set tracks.
According to the autonomous work machines of Arrangement 4 and Arrangement 5, in a case in which backlighting is predicted to occur temporarily in a set track, the angle of the camera can be controlled together with the setting of the track in advance so the sun will not fall within the range of the angle of view of the camera. Hence, travel that avoids backlighting becomes possible in each track set based on the sun information.
Arrangement 6. A method of controlling an autonomous work machine according to the above-described embodiment is a method of controlling an autonomous work machine (for example, 10 of
an obtainment step (for example, S904 of
a control step (for example, S905 of
According to the method of controlling the autonomous work machine of Arrangement 6, when the autonomous work machine is traveling in a work area or returning from the work area to a charging station, the autonomous work machine can travel on tracks that avoid backlighting. Since it can be difficult to accurately obtain the information of the external world in a backlit state, setting each track so as to avoid backlighting will prevent the autonomous work machine from having to travel in a state in which the information of the external world cannot be obtained. Hence, the autonomous work machine will be able to accurately travel in the work area and accurately return to the charging station.
Arrangement 7. A program according to the above-described embodiment causes a computer (for example, 44a of
According to the program of Arrangement 7, the function of the autonomous work machine according to the present invention can be implemented by a computer.
This application is a continuation of International Patent Application No. PCT/JP2018/042852 filed on Nov. 20, 2018, the entire disclosure of which is incorporated herein by reference.
Number | Date | Country | |
---|---|---|---|
Parent | PCT/JP2018/042852 | Nov 2018 | US |
Child | 17320067 | US |