Patent Application
20190227574
The present invention relates to a self-moving device capable of automatically recognizing an object in front and a recognition method thereof.
With ongoing development of computer technologies and artificial intelligence technologies, automatic working systems similar to smart robots start to enter people's lives. A fully-automatic vacuum cleaner usually has a small volume and integrates an environmental sensor, a self-driving system, a vacuum cleaning system, a battery, and a charging system. The vacuum cleaner can navigate and vacuum an indoor area automatically without manual manipulation. When the battery is low, the vacuum cleaner returns to a charging station automatically and is docked for charging, and later continues with navigation and vacuum cleaning. A smart lawn mower can cut grass on a user's lawn automatically and can be charged automatically without intervention of the user. Such an automatic working system no longer needs to be manually managed after being set once, so that users are freed from tedious and time- and labor-consuming housework such as cleaning and lawn maintenance.
A smart lawn mower usually has an obstacle-avoidance function. During working, the smart lawn mower can be effectively prevented from colliding with an obstacle by using the obstacle-avoidance function. In a conventional obstacle-avoidance manner, an ultrasonic transmitter is mounted on the smart lawn mower. The ultrasonic transmitter keeps transmitting ultrasound. The ultrasound is reflected when hitting an obstacle in front. The smart lawn mower determines a distance between the smart lawn mower and the obstacle based on a time difference between the time when the ultrasound is transmitted and the time when the reflected ultrasound is received. When the distance is close to zero, a main controller of the smart lawn mower determines that the smart lawn mower encounters an obstacle and controls the smart lawn mower to steer to avoid the obstacle. However, the conventional obstacle-avoidance manner cannot completely adapt to complex grass cutting conditions. Especially, when the smart lawn mower encounters a slope, by using the working principle of ultrasound, the slope may be recognized as an obstacle by mistake. As a result, the smart lawn mower does not move to the slope to perform cutting, and a user's lawn on a slope cannot get cut.
To overcome the deficiencies in the prior art, the problem to be resolved by the present invention is to provide a self-moving device capable of automatically recognizing an object in front and a recognition method thereof.
To resolve the foregoing problem, the present invention adopts the following technical solutions:
A self-moving device capable of automatically recognizing an object in front, wherein the self-moving device comprises a signal transmission module, a gradient determination module, and a control module, wherein the signal transmission module transmits recognition signals propagated along at least two different paths; the gradient determination module obtains, according to the recognition signals, a first determination result indicating whether an object in front is a slope; and the control module controls a traveling path of the self-moving device according to the first determination result.
In an embodiment, an operational program is preset in the gradient determination module, and the self-moving device inputs parameters of the recognition signals propagated on the at least two different paths into the operational program to obtain the first determination result indicating whether the object in front is a slope.
In an embodiment, when the first determination result is that the object in front is a slope within a preset angle range, the control module controls the self-moving device to ascend the slope.
In an embodiment, each recognition signal comprises a slope recognition signal, the signal transmission module comprises a first transmission unit and a second transmission unit, and the first transmission unit and the second transmission unit respectively transmit the slope recognition signals propagated along the two different paths.
In an embodiment, the first transmission unit and the second transmission unit are disposed at a first transmission point and a second transmission point at different heights.
In an embodiment, the first transmission unit and the second transmission unit transmit the slope recognition signals respectively in a horizontal direction to obtain a first horizontal distance and a second horizontal distance that are respectively between the first transmission point to the second transmission point to a corresponding point of the object in front.
In an embodiment, the first transmission point and the second transmission point are not in a same vertical plane parallel to a movement direction of the self-moving device.
In an embodiment, the gradient determination module determines, by using a relationship between the first horizontal distance and a vertical height of the corresponding first transmission point and a relationship between the second horizontal distance and a vertical height of the corresponding second transmission point, whether the object in front is a slope.
In an embodiment, the gradient determination module determines, by comparing a ratio of the first horizontal distance to the vertical height of the first transmission point and a ratio of the second horizontal distance to the vertical height of the second transmission point, whether the object in front is a slope.
In an embodiment, when the first transmission point and a foremost position of the object in front are both located in a same vertical plane perpendicular to a movement direction of the self-moving device, the gradient determination module determines, based on whether the ratio of the first horizontal distance to the vertical height of the first transmission point is equal to the ratio of the second horizontal distance to the vertical height of the second transmission point, whether the object in front is a slope, and determines, when the ratio of the first horizontal distance to the vertical height of the first transmission point is equal to the ratio of the second horizontal distance to the vertical height of the second transmission point, that the object in front is a slope.
In an embodiment, the recognition signals propagated on the different paths are propagated along paths at different angles from a movement direction of the self-moving device.
In an embodiment, the signal transmission module comprises a transmission unit that transmits the recognition signals, and the recognition signals propagated on the different paths are transmitted by the same transmission unit.
In an embodiment, the signal transmission module comprises several transmission units that transmit the recognition signals, and the recognition signals propagated on the different paths are transmitted by different transmission units.
In an embodiment, the signal transmission module transmits the recognition signals along at least three different height points.
In an embodiment, the gradient determination module comprises a slope determination module and a gradient recognition module, the slope determination module is configured to determine whether the object in front is a slope, the gradient recognition module is configured to determine an angle of inclination of the slope, and obtain, according to the angle of inclination of the slope, a second determination result indicating whether the self-moving device can pass the slope, when the first determination result is that the object in front is not a slope, the control module controls the traveling path of the self-moving device according to the first determination result, and when the first determination result is that the object in front is a slope, the control module controls the traveling path of the self-moving device according to the second determination result.
In an embodiment, the gradient recognition module comprises an angle setting unit, a gradient analysis unit, and a gradient determination unit, the angle setting unit is configured to set an angle threshold in advance, the gradient analysis unit is configured to determine the angle of inclination of the slope, and the gradient determination unit is configured to compare the angle threshold with the angle of inclination of the slope to determine whether the self-moving device can pass the object in front.
In an embodiment, each recognition signal comprises a slope recognition signal, the signal transmission module comprises a first transmission unit and a second transmission unit, the first transmission unit and the second transmission unit are disposed at a first transmission point and a second transmission point at different heights, the first transmission unit and the second transmission unit transmit the slope recognition signals respectively in a horizontal direction to obtain a first horizontal distance and a second horizontal distance that are respectively between the first transmission point and the second transmission point to a corresponding point of the object in front, and the gradient analysis unit acquires the angle of inclination of the slope according to a ratio of a distance difference between the second horizontal distance and the first horizontal distance to a difference between vertical heights of the corresponding second transmission point and first transmission point.
In an embodiment, each recognition signal comprises a slope recognition signal, the signal transmission module comprises a first transmission unit, the first transmission unit is disposed at the first transmission point, the first transmission unit transmits the slope recognition signals in a horizontal direction to obtain the first horizontal distance between the first transmission point and the corresponding point of the object in front, and when the first transmission point and a foremost position of the object in front are both located in a same vertical plane perpendicular to a movement direction of the self-moving device, the gradient analysis unit acquires the angle of inclination of the slope according to a ratio of the first horizontal distance to the vertical height of the corresponding first transmission point.
In an embodiment, the signal transmission module further receives the recognition signals.
In an embodiment, when the recognition signals encounters the object in front, the recognition signals are reflected back to the self-moving device, and the signal transmission module receives the reflected recognition signals.
In an embodiment, the self-moving device further comprises a signal reception module that receives the recognition signals.
In an embodiment, when the recognition signals encounters the object in front, the recognition signals are reflected back to the self-moving device, and the signal reception module receives the reflected recognition signals.
In an embodiment, the signal transmission module is an ultrasonic transmission module that transmits an ultrasonic signal, and the slope recognition signal is an ultrasonic signal.
In an embodiment, the self-moving device further comprises a width determination module, the width determination module obtains a width of the object in front according to the recognition signals, and obtains, according to the width of the object in front, a third determination result indicating whether the self-moving device can pass the object in front, and the control module controls the traveling path of the self-moving device according to the third determination result.
In an embodiment, each recognition signal further comprises a width recognition signal, the signal transmission module further transmits the width recognition signals propagated along the at least two different paths, the width determination module obtains the width of the object in front according to the width recognition signals, and obtains, according to the width of the object in front, the third determination result indicating whether the self-moving device can pass the object in front, and the control module controls the traveling path of the self-moving device according to the third determination result.
In an embodiment, when the first determination result is that the object in front is not a slope, the control module controls the traveling path of the self-moving device according to the first determination result; when the first determination result is that the object in front is a slope, if the second determination result does not exist, the control module directly controls the traveling path of the self-moving device according to the third determination result; and when the first determination result is that the object in front is a slope and both the second determination result and the third determination result exist, only if both the second determination result and the third determination result indicate that the self-moving device can pass the slope, the control module controls the self-moving device to ascend the slope, and if the second determination result or the third determination result or both the second determination result and the third determination result indicate that the self-moving device cannot pass the slope, the control module controls the self-moving device not to pass the slope.
In an embodiment, the control module comprises a first control unit and a second control unit, wherein the first control unit is configured to control the traveling path of the self-moving device according to the first determination result or the second determination result, and the second control unit is configured to control the traveling path of the self-moving device according to the third determination result.
In an embodiment, the signal transmission module transmits the width recognition signals to different horizontal positions.
In an embodiment, the signal transmission module transmits the width recognition signals at a same height.
In an embodiment, the signal transmission module further receives the width recognition signals.
In an embodiment, the self-moving device further comprises a signal reception module that receives the width recognition signals.
In an embodiment, the signal transmission module is an ultrasonic transmission module that transmits an ultrasonic signal, and the width recognition signal is an ultrasonic signal.
In an embodiment, the width determination module determines whether the width of the object in front is less than a width of the self-moving device to determine whether the self-moving device can pass the object in front, and determines, when the width of the object in front is less than the width of the self-moving device, that the self-moving device cannot pass the object in front.
A method for automatically recognizing an object in front of a self-moving device, wherein the method for automatically recognizing an object in front comprises the following steps:
step 1): providing a signal transmission module, wherein the signal transmission module transmits recognition signals propagated along at least two different paths;
step 2): providing a gradient determination module, wherein the gradient determination module obtains, according to the recognition signals, a first determination result indicating whether an object in front is a slope; and
step 3): providing a control module, wherein the control module controls a traveling path of the self-moving device according to the first determination result.
In an embodiment, in step 2), an operational program is preset in the gradient determination module, and the self-moving device inputs parameters propagated on the at least two different paths into the operational program to obtain the first determination result indicating whether the object in front is a slope.
In an embodiment, in step 3), when the first determination result is that the object in front is a slope within a preset angle range, the control module controls the self-moving device to ascend the slope.
In an embodiment, in step 1), each recognition signal comprises a slope recognition signal, and the slope recognition signals are propagated respectively along paths at different heights.
In an embodiment, the slope recognition signals are all propagated in a horizontal direction to obtain a first horizontal distance and a second horizontal distance of at least two different height points from the object in front.
In an embodiment, the slope recognition signals are not propagated in a same vertical plane parallel to a movement direction of the self-moving device.
In an embodiment, in step 2), it is determined, according to relationships between the first horizontal distance and the second horizontal distance and vertical heights of the corresponding height points, whether the object in front is a slope.
In an embodiment, it is determined, by comparing a ratio of the first horizontal distance to the vertical height of the height point corresponding to the first horizontal distance with a ratio of the second horizontal distance to the vertical height of the height point corresponding to the second horizontal distance, whether the object in front is a slope.
In an embodiment, when the height point corresponding to the first horizontal distance and a foremost position of the object in front are both located in a same vertical plane perpendicular to a movement direction of the self-moving device, it is determined, based on whether the ratio of the first horizontal distance to the vertical height of the height point corresponding to the first horizontal distance is equal to the ratio of the second horizontal distance to the vertical height of the height point corresponding to the second horizontal distance, whether the object in front is a slope, and it is determined, when the ratios are equal, that the object in front is a slope.
In an embodiment, the recognition signals propagated on the different paths are propagated along paths at different angles from a movement direction of the self-moving device.
In an embodiment, the signal transmission module comprises a transmission unit that transmits the recognition signals, and the recognition signals propagated on the different paths are transmitted by the same transmission unit.
In an embodiment, the signal transmission module comprises several transmission units that transmit the recognition signals, and the recognition signals propagated on the different paths are transmitted by different transmission units.
In an embodiment, in step 1), the recognition signals are transmitted along at least three different height points.
In an embodiment, when the first determination result in step 2) indicates that the object in front is not a slope, the traveling path of the self-moving device is controlled according to the first determination result in step 3); when the first determination result in step 2) indicates that the object in front is a slope, an angle of inclination of the slope is further determined, a second determination result indicating whether the self-moving device can pass the slope is obtained according to the angle of inclination of the slope, and the traveling path of the self-moving device is controlled according to the second determination result in step 3).
In an embodiment, in step 2), a method for determining whether the self-moving device can pass the slope comprises the following steps:
setting an angle threshold in advance;
determining the angle of inclination of the slope; and
comparing the angle of inclination of the slope with the angle threshold to obtain the second determination result.
In an embodiment, in step 1), slope recognition signals are respectively propagated at different heights in a horizontal direction to obtain a first horizontal distance and a second horizontal distance between at least two different height points and the slope; and a method for determining the angle of inclination of the slope in step 2) comprises determining the angle of inclination of the slope according to ratios of the second horizontal distance and the first horizontal distance to a difference between vertical heights of the corresponding different height points.
In an embodiment, in step 1), at least one of the slope recognition signals is propagated in a horizontal direction to obtain a first horizontal distance between at least one height point and the slope; when the height point and a foremost position of the slope are located in a same vertical plane perpendicular to a movement direction of the self-moving device, a method for determining the angle of inclination of the slope in step 2) comprises determining the angle of inclination of the slope according to a ratio of the first horizontal distance to the vertical height of the height point corresponding to the first horizontal distance.
In an embodiment, in step 1), the signal transmission module transmits the recognition signals propagated along the at least two different paths and receives the recognition signals.
In an embodiment, when the recognition signals encounters the object in front, the recognition signals are reflected back to the self-moving device, and in step 1), the signal transmission module transmits the recognition signals propagated along the at least two different paths and receives the reflected recognition signals.
In an embodiment, in step 1), a signal reception module is further provided, and the signal reception module receives the slope recognition signals.
In an embodiment, when the recognition signals encounters the object in front, the recognition signals are reflected back to the self-moving device, and in step 1), the signal reception module transmits the recognition signals propagated along the at least two different paths and receives the reflected recognition signals.
In an embodiment, the slope recognition signal is an ultrasonic signal.
In an embodiment, when the first determination result in step 2) indicates that the object in front is a slope, step 4) is further comprised after step 3), and step 4) comprises the following steps: providing a width determination module, wherein the width determination module obtains a width of the slope according to the recognition signals, and determining, according to the width of the slope, a third determination result indicating whether the self-moving device can pass the slope; and controlling, by the control module, the traveling path of the self-moving device according to the third determination result.
In an embodiment, in the step of providing a width determination module in step 4), each recognition signal further comprises a width recognition signal, the signal transmission module further transmits the width recognition signals propagated along the at least two different paths, and the width determination module obtains the width of the slope according to the width recognition signals and determines, according to the width of the slope, the third determination result indicating whether the self-moving device can pass the slope.
In an embodiment, if the second determination result does not exist, the traveling path of the self-moving device is directly controlled according to the third determination result; when both the second determination result and the third determination result exist, only if both the second determination result and the third determination result indicate that the self-moving device can pass the slope, the self-moving device is controlled to ascend the slope; and when both the second determination result and the third determination result exist, if the second determination result or the third determination result or both the second determination result and the third determination result indicate that the self-moving device cannot pass the slope, the self-moving device is controlled not to pass the slope.
In an embodiment, in the step of transmitting the width recognition signals in step 4), the width recognition signals are transmitted to different horizontal positions.
In an embodiment, the width recognition signals are transmitted at a same height.
In an embodiment, in the step of transmitting the width recognition signals in step 4), another signal transmission module transmits the width recognition signals propagated along the at least two different paths and receives the width recognition signals.
In an embodiment, in the step of transmitting the width recognition signals in step 4), a signal reception module is further provided, and the signal reception module receives the width recognition signals.
In an embodiment, in the step of transmitting the width recognition signals in step 4), the width recognition signal is an ultrasonic signal.
In an embodiment, the method for determining whether the self-moving device can pass the slope comprises determining, by determining whether the width of the slope is less than a width of the self-moving device, whether the self-moving device can pass the slope, and it is determined, when the width of the slope is less than the width of the self-moving device, that the self-moving device cannot pass the slope.
The beneficial effect of the present invention is: The self-moving device can automatically determine whether an object in front is a slope and intelligently control a traveling path of the self-moving device according to a determination result, thereby improving the working intelligence and safety of the self-moving device.
In order to make the objectives, technical solutions, and advantages of the present invention more comprehensible, the present invention is described below in further detail with reference to the embodiments and accompanying drawings. It should be understood that specific embodiments described herein are merely used to explain the present invention instead of limiting the present invention.
As shown in
Step S110: Provide a signal transmission module configured to transmit recognition signals propagated along at least two different paths. In a specific embodiment, the signal transmission module is configured to transmit the recognition signals to obtain a plurality of first horizontal distances between a plurality of different height points on the self-moving device in a vertical direction and an object in front. In this embodiment, the recognition signals are ultrasonic signals. The recognition signals transmitted in step S110 may alternatively be referred to as slope recognition signals.
As shown in
The recognition signals may be ultrasonic signals, laser signals, or the like. In this embodiment, ultrasonic signals are used as an example. When the self-moving device 100 encounters an object 200 in front, the self-moving device 100 transmits ultrasound toward the plurality of different height points in front and receives ultrasonic signals reflected back at the corresponding height points by using an ultrasonic transmission module mounted on the self-moving device 100, to obtain horizontal distances between the different height points on the self-moving device 100 and the object 200 in front.
Step S120: Provide a gradient determination module, where the gradient determination module obtains, according to the recognition signals, a first determination result indicating whether an object in front is a slope. Specifically, the gradient determination module presets an operational program related to parameters propagated on the at least two different paths of the recognition signals. The self-moving device inputs the parameters propagated on the at least two different paths of the recognition signals into the operational program to obtain the first determination result indicating whether the object in front is a slope.
In a specific embodiment, the gradient determination module obtains, by analyzing a position relationship between each first horizontal distance and a vertical height of a corresponding height point, the first determination result indicating whether the object in front is a slope.
The first horizontal distances between the self-moving device 100 and the object 200 in front that are obtained by using the corresponding height points 101, 102, and 103 are respectively d1, d2, and d3. It is obtained, by analyzing position relationships between d1, d2, and d3 and vertical heights L1, L2, and L3 of the corresponding height points, whether the object in front is a slope.
Specifically, when the height point 101 and a foremost position 201 of the object 200 in front are both located in a same vertical plane perpendicular to a movement direction of the self-moving device 100, it is analyzed whether ratios of the horizontal distances d1, d2, and d3 to the vertical heights Ll, L2, and L3 of the corresponding height points are equal to recognize whether the object in front is a slope. Further specifically, if the object in front is a slope, as the vertical height increases, the horizontal distances d1, d2, and d3 between the self-moving device and the slope at different height points are also in a sequentially ascending order, and the ratios of the first horizontal distances d1, d2, and d3 to L1, L2, and L3 of the corresponding height points should also be approximately equal, so that the self-moving device may determine, according to whether the ratios of the horizontal distances d1, d2, and d3 to the vertical heights of the corresponding height points are approximately equal, whether the object in front is a slope. Certainly, in consideration of a working environment of the self-moving device, because it is fully considered that a particular error should be allowed for the ratios of the first horizontal distances d1, d2, and d3 to the vertical heights of the corresponding height points, when the ratios of the first horizontal distances d1, d2, and d3 to the vertical heights of the corresponding height points are within specified error ranges, it is considered that the object in front is a slope. Generally, there need to be at least two height points, and preferably, there are at least three height points.
For the measured horizontal distances d1, d2, and d3 between the self-moving device 100 and the object in front, errors caused to the measured horizontal distances d1, d2, and d3 by horizontal distances between the corresponding height points 101, 102, and 103 of the self-moving device 100 should be fully considered. For example, a horizontal position of the height point 101, corresponding to d1, of the self-moving device 100 is used as a reference plane. The actually measured distance d2 should be a distance between the height point 102 corresponding to d2 and the object in front minus a horizontal distance between the height point 102 corresponding to d2 and the height point 101 corresponding to d1. The actually measured distance d3 should be a distance between the height point 103 corresponding to d3 and the object in front minus a horizontal distance between the height point 103 corresponding to d3 and the height point 101 corresponding to d1.
Alternatively, because a distance between the self-moving device 100 and the object in front is far greater than the horizontal distances between the height points 101, 102, and 103 on the self-moving device 100, the horizontal distances between the height points 101, 102, and 103 on the self-moving device 100 may be negligible.
In this embodiment, the gradient determination module obtains, according to the recognition signals, horizontal distances between corresponding points of the self-moving device 100 and the object in front, a corresponding functional expression is preset in an operational program, and the functional relation is used to perform operation to determine whether the object 200 in front is a slope. In other embodiments, all the recognition signals may alternatively be not transmitted in a horizontal direction, and may alternatively be propagated along different paths at different angles from a movement direction of the self-moving device 100. The recognition signals may be transmitted from a same transmission point, and may alternatively be transmitted from different transmission points. In other embodiments, according to actual cases, the gradient determination module may perform operation by using other operational relations in addition to a functional relation.
Step S130: If the first determination result is that the object 200 in front is a slope, determine a gradient of the slope to obtain a second determination result indicating whether the self-moving device 100 can pass the slope.
If the determination result in S120 is that the object 200 in front is a slope, the gradient of the slope can be analyzed to find out whether the self-moving device 100 can pass the slope. Specifically, the gradient of the slope may be determined by using a ratio of the first horizontal distance to a vertical height of the corresponding height point on the slope. Further specifically, a worker may set an angle threshold in advance. The set angle threshold is a gradient range in which the self-moving device can pass the slope. Next, an angle of inclination of the slope is obtained according to the ratio of the first horizontal distance to the vertical height of the corresponding height point and according to the principle of trigonometric functions. The principle is a common technical measure in this field and is therefore not described in detail here in the present invention. Next, the angle threshold is compared with the obtained angle of inclination of the slope to determine whether the self-moving device 100 can pass the slope. If the angle of inclination of the slope obtained according to the ratio of the first horizontal distance to the vertical height of the corresponding height point is within a range of the angle threshold, it is determined that the self-moving device 100 can pass the slope. If the angle of inclination of the slope obtained according to the ratio of the first horizontal distance to the vertical height of the corresponding height point is outside the angle range, it is determined that the self-moving device 100 cannot pass the slope.
The self-moving device capable of automatically recognizing an object in front in the first embodiment of the present invention may further include, in addition to the foregoing steps, comparing a width of the self-moving device 100 with a width of the object in front by using ultrasound to determine whether the self-moving device 100 can pass the slope.
Specifically, in step S140, the signal transmission module further transmits ultrasound to obtain a plurality of second horizontal distances between the self-moving device and the object in front in a same horizontal direction. The ultrasonic signal transmitted in step S140 may alternatively be referred to as a width recognition signal. The slope recognition signal transmitted in step S110 and the width recognition signal transmitted in step S140 may alternatively be generally referred to as recognition signals.
As shown in
For the measured horizontal distances d4, d5, and d6 between the self-moving device 100 and the object in front, errors caused to the measured horizontal distances d4, d5, and d6 between the corresponding position points 104, 105, and 106 of the self-moving device 100 should be fully considered. In
Alternatively, because a distance between the self-moving device 100 and the object in front is far greater than the horizontal distances between the position points 104, 105, and 106 on the self-moving device 100, the horizontal distances between the position points 104, 105, and 106 on the self-moving device 100 may be negligible.
Step S150: According to each second horizontal distance, obtain a third determination result indicating whether a width of the slope is greater than or equal to a width of the self-moving device. In a specific embodiment, several critical position points may be set on two sides and at a middle position in a width direction of the self-moving device 100. Ultrasonic signals are transmitted from the position points respectively in a movement direction of the self-moving device. If reflected ultrasonic signals can be received at all the position points from the object 200 in front, the second horizontal distances can be obtained, and a difference between the second horizontal distances is within a particular range, it is determined that the width of the slope is not less than the width of the self-moving device. If reflected signals can be received at only some of the disposed position points, the corresponding second horizontal distances are obtained, and a difference between the corresponding second horizontal distances is within a particular range, a width of the object 200 in front is calculated according to the distance between some position points at which reflected signals can be received. In other embodiments, specific positions of the position points and a direction of transmitting ultrasonic signals may also be adjusted, and the width of the object 200 in front is calculated according to an actual case.
In sum, in various specific embodiments, according to the second horizontal distances, a relative relationship between the width of the slope and the width of the self-moving device is determined. When the width of the slope is less than the width of the self-moving device, it is considered that the self-moving device cannot pass the slope.
Step S160: Provide a control module, where the control module controls a traveling path of the self-moving device according to the first determination result, the second determination result, and the third determination result.
Generally, when the first determination result, the second determination result, and the third determination result all indicate that the self-moving device can pass the object in front, the self-moving device is controlled to pass the object (slope) in front. If one of the first determination result, the second determination result, and the third determination result indicates that the self-moving device 100 cannot pass the object 200 in front, the self-moving device 100 is controlled to steer or stop moving forward to avoid passing the object in front.
By using a method for recognizing a slope of the self-moving device, it can be effectively recognized whether there is a slope in front of the self-moving device and determined, if there is a slope, whether the self-moving device can pass the slope, so as to automatically implement cutting on a slope.
In the foregoing embodiment, steps S110 to S160 are all completed, and the first determination result, the second determination result, and the third determination result are all used to determine whether the self-moving device 100 continues to move forward to pass the object in front, that is, ascend the slope. In other embodiments, one or more of step S130 to S150 may alternatively be omitted, and it is directly determined, according to the corresponding first determination result or a combination of the first determination result and one or both of the second determination result and the third determination result, whether the self-moving device 100 continues to move forward. For example, steps S130 to S150 are all omitted, and the control module controls a traveling path of the self-moving device 100 according to only the first determination result. When the first determination result is that the object 200 in front is a slope, the control module controls the self-moving device 100 to pass the object 200 in front. When the first determination result is that the object 200 in front is not a slope, the control module controls the self-moving device 100 not to pass the object 200 in front. For example, the self-moving device 100 may be controlled to steer, turn around, reverse or the like.
As shown in
The first signal transmission module, which is configured to transmit recognition signals propagated along at least two different paths. In a specific embodiment, the first signal transmission module obtains a plurality of first horizontal distances between a plurality of different height points on the self-moving device in a vertical direction and an object in front at by using ultrasound. The first signal transmission module may be an ultrasonic transmission module, a laser transmission module, or the like. In this embodiment, the signal transmission module is a first ultrasonic transmission module 11.
As shown in
The slope determination module 12, which is configured to obtain, according to the recognition signals, a first determination result indicating whether an object in front is a slope. Specifically, the slope determination module presets an operational program related to parameters propagated on the at least two different paths of the recognition signals, and the self-moving device 100 inputs the parameters propagated on the at least two different paths of the recognition signals into the operational program to obtain the first determination result indicating whether the object 200 in front is a slope.
In a specific embodiment, the slope determination module 12 is configured to analyze a position relationship between each first horizontal distance and a vertical height of a corresponding height point to obtain the first determination result indicating whether the object 200 in front is a slope.
The slope determination module 12 obtains that the first horizontal distances between the self-moving device 100 and the object 200 in front that are at the corresponding height points 101, 102, and 103 are respectively d1, d2, and d3, and obtains, by analyzing position relationships between d1, d2, and d3 and vertical heights L1, L2, and L3 of the corresponding height points, whether the object in front is a slope.
Specifically, it is analyzed whether ratios of the horizontal distances d1, d2, and d3 to the vertical heights L1, L2, and L3 of the corresponding height points are equal to recognize whether the object in front is a slope. Further specifically, if the object in front is a slope, as the vertical height increases, the horizontal distances d1, d2, and d3 between the self-moving device and the slope at different height points are also in a sequentially ascending order, and the ratios of the first horizontal distances d1, d2, and d3 to L1, L2, and L3 of the corresponding height points should also be approximately equal, so that the self-moving device may determine, according to whether the ratios of the horizontal distances d1, d2, and d3 to the vertical heights of the corresponding height points are approximately equal, whether the object in front is a slope. Certainly, in consideration of a working environment of the self-moving device, because it is fully considered that a particular error should be allowed for the ratios of the first horizontal distances d1, d2, and d3 to the vertical heights of the corresponding height points, when the ratios of the first horizontal distances d1, d2, and d3 to the vertical heights of the corresponding height points are within specified error ranges, it is considered that the object in front is a slope. Generally, there need to be at least two height points, and preferably, there are at least three height points.
For the measured horizontal distances d1, d2, and d3 between the self-moving device 100 and the object in front, errors caused to the measured horizontal distances d1, d2, and d3 by horizontal distances between the corresponding height points 101, 102, and 103 of the self-moving device 100 should be fully considered. For example, the height point 101, corresponding to d1, of the self-moving device 100 is used as a reference point, and a vertical plane in which the height point 101 is located and that is perpendicular to a movement direction of the self-moving device 100 is used as a reference plane. The actually measured distance d2 should be a distance between the height point 102 corresponding to d2 and the object in front minus a horizontal distance between the height point 102 corresponding to d2 and the height point 101 corresponding to d1. The actually measured distance d3 should be a distance between the height point 103 corresponding to d3 and the object in front minus a horizontal distance between the height point 103 corresponding to d3 and the height point 101 corresponding to d1.
Alternatively, because a distance between the self-moving device 100 and the object in front is far greater than the horizontal distances between the height points 101, 102, and 103 on the self-moving device 100, the horizontal distances between the height points 101, 102, and 103 on the self-moving device 100 may be negligible.
In this embodiment, the slope determination module obtains, according to the recognition signals, horizontal distances between corresponding points of the self-moving device 100 and the object in front, a corresponding functional expression is preset in an operational program, and the functional relation is used to perform operation to determine whether the object 200 in front is a slope. In other embodiments, all the recognition signals may alternatively be not transmitted in a horizontal direction, and may alternatively be propagated along different paths at different angles from a movement direction of the self-moving device 100. The recognition signals may be transmitted from a same transmission point, and may alternatively be transmitted from different transmission points. In other embodiments, according to actual cases, the gradient determination module may perform operation by using other operational relations in addition to a functional relation.
The gradient recognition module 13, which is configured to: if the first determination result is that the object in front is a slope, determine the gradient of the slope to obtain a second determination result indicating whether the self-moving device can pass the slope.
If the determination result is that the object in front is a slope, the gradient recognition module can analyze the gradient of the slope to find out whether the self-moving device can pass the slope. Specifically, the gradient of the slope may be determined by using a ratio of the first horizontal distance to a vertical height of the corresponding height point on the slope. Further specifically, a worker may set an angle threshold in advance. The set angle threshold is a gradient range in which the self-moving device can pass the slope. Next, an angle of inclination of the slope is obtained according to the ratio of the first horizontal distance to the vertical height of the corresponding height point and according to the principle of trigonometric functions. The principle is a common technical measure in this field and is therefore not described in detail here in the present invention. Next, the angle threshold is compared with the obtained angle of inclination of the slope to determine whether the self-moving device can pass the slope. If the angle of inclination of the slope obtained according to the ratio of the first horizontal distance to the vertical height of the corresponding height point is within a range of the angle threshold, it is determined that the self-moving device can pass the slope. If the angle of inclination of the slope obtained according to the ratio of the first horizontal distance to the vertical height of the corresponding height point is outside the angle range, it is determined that the self-moving device cannot pass the slope. The slope determination module 12 and the gradient recognition module 13 are generally referred to as the gradient determination module.
The slope recognition system 10 of the self-moving device may further include: comparing a width of the self-moving device with a width of the object in front by using ultrasound to determine whether the self-moving device can pass the slope. Specifically, the slope recognition system of the self-moving device may further include:
The second signal transmission module, which is configured to transmit recognition signals propagated along at least two different paths. In a specific embodiment, the second signal transmission module is configured to transmit ultrasound to obtain a plurality of second horizontal distances between the self-moving device and the object in front in a same horizontal direction. In this embodiment, the second signal transmission module is a second ultrasonic transmission module 14.
As shown in
For the measured horizontal distances d4, d5, and d6 between the self-moving device 100 and the object in front, errors caused to the measured horizontal distances d4, d5, and d6 horizontal distances between the corresponding position points 104, 105, and 106 of the self-moving device 100 should be fully considered. For example, the position point 105, corresponding to d5, of the self-moving device 100 is used as a reference point, and a vertical plane in which the position point 105 is located and that is perpendicular to a movement direction of the self-moving device 100 is used as a reference plane. The actually measured distance d4 should be a distance between the position point 104 corresponding to d4 and the object in front minus a horizontal distance between the position point 104 corresponding to d4 and the position point 105 corresponding to d5. The actually measured distance d6 should be a distance between the position point 106 corresponding to d6 and the object in front minus a horizontal distance between the position point 106 corresponding to d6 and the position point 105 corresponding to d5.
Alternatively, because a distance between the self-moving device 100 and the object in front is far greater than the horizontal distances between the position points 104, 105, and 106 on the self-moving device 100, the horizontal distances between the position points 104, 105, and 106 on the self-moving device 100 may be negligible.
The width determination module 15 is configured to obtain, according to each second horizontal distance, a third determination result indicating whether a width of the slope is greater than or equal to the width of the self-moving device.
The width determination module 15 determines a relative relationship between the width of the slope and the width of the self-moving device according to the second horizontal distances, and determines, when the width of the slope is less than the width of the self-moving device, that the self-moving device cannot pass the slope.
The control module 16 has a first control unit and a second control unit. The first control unit is configured to control the traveling path of the self-moving device according to the first determination result or the second determination result. The second control unit is configured to control the traveling path of the self-moving device according to the third determination result.
Generally, when the first determination result, the second determination result, and the third determination result all indicate that the self-moving device can pass the object in front, the control module 16 controls the self-moving device to pass the object (slope) in front. If one of the first determination result, the second determination result, and the third determination result indicates that the self-moving device cannot pass the object in front, the self-moving device is controlled to steer or stop moving forward to avoid passing the object in front.
The slope recognition system 10 of the self-moving device can effectively recognize whether there is a slope in front of the self-moving device, and determine, if there is a slope, whether the self-moving device can pass the slope, so as to automatically implement cutting on a slope.
In the foregoing embodiments, the first signal transmission module and the second signal transmission module may be generally referred to as the signal transmission module. The recognition signals transmitted by the first signal transmission module may alternatively be referred to as slope recognition signals. The signals transmitted by the second signal transmission module may alternatively be referred to as width recognition signals. The slope recognition signals and the width recognition signals may be generally referred to as recognition signals.
In the foregoing embodiment, the first determination result, the second determination result, and the third determination result are all used to determine whether the self-moving device 100 continues to move forward to pass the object in front. In other embodiments, one or both of the second determination result and the third determination result may alternatively be omitted, and it is directly determined, according to the corresponding first determination result or a combination of the first determination result and one or both of the second determination result and the third determination result, whether the self-moving device 100 continues to move forward. For example, the first determination result and the second determination result are both omitted. The control module controls the traveling path of the self-moving device 100 according to only the first determination result. When the first determination result is that the object 200 in front is a slope, the control module controls the self-moving device 100 to pass the object 200 in front. When the first determination result is that the object 200 in front is not a slope, the control module controls the self-moving device 100 not to pass the object 200 in front. For example, the self-moving device 100 may be controlled to steer, turn around, reverse or the like.
As shown in
Step S310: Transmit recognition signals to obtain a first horizontal distance and a second horizontal distance between at least two different height points of the self-moving device in a vertical direction and an object in front.
As shown in
Step S320: Analyze position relationships between the first horizontal distance d3 and the second horizontal distance d4 and vertical heights of the corresponding height points 301 and 302 to obtain a first determination result indicating whetherself-moving the object in front is a slope.
The first horizontal distance d3 and the second horizontal distance d4 between the self-moving device 300 and the object 200 in front are obtained at the corresponding height points 301 and 302, and it is obtained, by analyzing position relationships between d3 and d4 and the vertical heights of the corresponding height points L3 and L4, whether the object in front is a slope.
Specifically, when the height point 301 and a foremost position 201 of the object 200 in front are both located in a same vertical plane perpendicular to a movement direction of the self-moving device 300, it is analyzed whether a ratio of the first horizontal distance d3 to the vertical height L3 of the corresponding height point is equal to a ratio of the second horizontal distance d4 to the vertical height L4 of the corresponding height point to recognize whether the object in front is a slope. Further specifically, if the object in front is a slope, for distances between the self-moving device and the slope at different height points, the ratio of the first horizontal distance d3 to the vertical height L3 of the corresponding height point is approximately equal to the ratio of the second horizontal distance d4 to the vertical height L4 of the corresponding height point, so that the self-moving device may determine, according to whether the ratios of the horizontal distances d3 and d4 to the vertical heights of the corresponding height points are approximately equal, whether the object in front is a slope. Certainly, in consideration of a working environment of the self-moving device, because it is fully considered that a particular error should be allowed for a difference between the ratio of the first horizontal distance d3 to L3 of the corresponding height point and the ratio of the second horizontal distance d4 to the vertical height L4 of the corresponding height point, when the difference between the ratio of the first horizontal distance d3 to L3 of the corresponding height point and the ratio of the second horizontal distance d4 to the vertical height L4 of the corresponding height point is within a specified error range, it is considered that the object in front is a slope.
Step S330: Obtain an angle of inclination of the slope according to a ratio of a difference between the first horizontal distance d3 and the second horizontal distance d4 to a difference between the vertical heights of the corresponding height points 301 and 302; and obtain, according to the angle of inclination of the slope, a second determination result indicating whether the self-moving device can pass the slope.
If the determination result in 5320 is that the object 200 in front is a slope, the gradient of the slope can be analyzed to find out whether the self-moving device can pass the slope. Specifically, the angle of inclination of the slope is obtained according to the ratio of the difference between the first horizontal distance d3 and the second horizontal distance d4 to the difference between the vertical heights L3 and L4 of the corresponding height points. Further specifically, a worker may set an angle threshold in advance. The set angle threshold is a gradient range in which the self-moving device can pass the slope. Next, the angle of inclination of the slope is obtained according to the ratio of the difference between the first horizontal distance d3 and the second horizontal distance d4 to the difference between the vertical heights L3 and L4 of the corresponding height points and according to the principle of trigonometric functions. Next, the angle threshold is compared with the obtained angle of inclination of the slope to determine whether the self-moving device can pass the slope. If the angle of inclination of the slope obtained according to a ratio of a difference between two adjacent first horizontal distances to a difference between the vertical heights of the corresponding height points is within a range of the angle threshold, it is determined that the self-moving device can pass the slope. If the angle of inclination of the slope obtained according to the ratio of the difference between the first horizontal distance and the second horizontal distance to the difference between the vertical heights of the corresponding height points is outside the angle range, it is determined that the self-moving device 300 cannot pass the slope.
To avoid mutual interference between ultrasonic signals for obtaining the first horizontal distances at different height points, a recognition signal used for detecting the first horizontal distance d3 and a recognition signal used for detecting the second horizontal distance d4 are not in a same vertical plane.
Step S340: Control a traveling path of the self-moving device according to the first determination result or the second determination result.
Generally, when the first determination result and the second determination result both determine that the self-moving device can pass the object in front, the self-moving device is controlled to pass the object (slope) in front. If either of the first determination result and the second determination result determines that the self-moving device cannot pass the object in front, the self-moving device is controlled to steer or stop moving forward to avoid passing the object in front.
By using a method for recognizing a slope of the self-moving device, it can be effectively recognized whether there is a slope in front of the self-moving device and determined, if there is a slope, whether the self-moving device can pass the slope, so as to automatically implement cutting on a slope.
As shown in
The signal transmission module, which has a first transmission unit and a second transmission unit. The first transmission unit and the second transmission unit respectively transmit recognition signals to obtain a first horizontal distance and a second horizontal distance between at least two different height points in a vertical direction of the self-moving device and an object in front.
As shown in
The slope determination module 420 analyzes whether a ratio of the first horizontal distance to the vertical height of the corresponding height point is equal to a ratio of the second horizontal distance to the vertical height of the corresponding height point.
The first horizontal distance d3 and the second horizontal distance d4 between the corresponding height points 301 and 302 of the self-moving device 300 and the object 200 in front are obtained, and it is obtained, by analyzing position relationships between d3 and d4 and the vertical heights of the corresponding height points L3 and L4, whether the object in front is a slope.
Specifically, the slope determination module 420 includes a slope recognition unit. The slope recognition unit recognizes, by analyzing whether a ratio of the first horizontal distance d3 to the vertical height L3 of the corresponding height point is equal to a ratio of the second horizontal distance d4 to the vertical height L4 of the corresponding height point, whether the object in front is a slope. Further specifically, if the object in front is a slope, for distances between the self-moving device and the slope at different height points, the ratio of the first horizontal distance d3 to the vertical height L3 of the corresponding height point is approximately equal to the ratio of the second horizontal distance d4 to the vertical height L4 of the corresponding height point, so that the self-moving device 300 may determine, according to whether the ratios of the horizontal distances d3 and d4 to the vertical heights of the corresponding height points are approximately equal, whether the object in front is a slope. Certainly, in consideration of a working environment of the self-moving device, because it is fully considered that a particular error should be allowed for a difference between the ratio of the first horizontal distance d3 to L3 of the corresponding height point and the ratio of the second horizontal distance d4 to the vertical height L4 of the corresponding height point, when the difference between the ratio of the first horizontal distance d3 to L3 of the corresponding height point and the ratio of the second horizontal distance d4 to the vertical height L4 of the corresponding height point is within a specified error range, it is considered that the object in front is a slope.
The gradient recognition module 430 obtains an angle of inclination of the slope according to a ratio of a difference between the first horizontal distance and the second horizontal distance to a difference between the vertical heights of the corresponding height points; and obtains, according to the angle of inclination of the slope, a second determination result indicating whether the self-moving device can pass the slope.
The determination result of the slope determination module is that the object in front is a slope, and the gradient of the slope can be analyzed to find out whether the self-moving device 300 can pass the slope 200. Specifically, the angle of inclination of the slope is obtained according to the ratio of the difference between the first horizontal distance d3 and the second horizontal distance d4 to the difference between the vertical heights L3 and L4 of the corresponding height points. Further specifically, the gradient recognition module 430 includes an angle setting unit 431, a gradient analysis unit 432, and a gradient determination unit 433. A worker may set an angle threshold in advance by using the angle setting unit 431. The set angle threshold is a gradient range in which the self-moving device 300 can pass the slope 200. Next, the gradient analysis unit 432 obtains the angle of inclination of the slope according to the ratio of the difference between the first horizontal distance d3 and the second horizontal distance d4 to the difference between the vertical heights L3 and L4 of the corresponding height points and according to the principle of trigonometric functions. Next, the gradient determination unit 433 compares the angle threshold with the obtained angle of inclination of the slope to determine whether the self-moving device can pass the slope. If the angle of inclination of the slope obtained according to the ratio of the difference between the first horizontal distance d3 and the second horizontal distance d4 to the difference between the vertical heights L3 and L4 of the corresponding height points is within a range of the angle threshold set by the angle setting unit 431, it is determined that the self-moving device can pass the slope. If the angle of inclination of the slope obtained according to the ratio of the difference between the first horizontal distance d3 and the second horizontal distance d4 to the difference between the vertical heights of the corresponding height points is outside the angle range, it is determined that the self-moving device cannot pass the slope.
To avoid mutual interference between ultrasonic signals for obtaining the first horizontal distances at different height points, as shown in
A control module 440 is configured to control the traveling path of the self-moving device according to the first determination result or the second determination result.
Generally, when the first determination result and the second determination result both determine that the self-moving device can pass the object in front, the self-moving device is controlled to pass the object (slope) in front. If either of the first determination result and the second determination result indicates that the self-moving device cannot pass the object in front, the self-moving device is controlled to steer or stop moving forward to avoid passing the object in front.
The self-moving device 300 can effectively recognize whether there is a slope in front of the self-moving device, and determine, if there is a slope, whether the self-moving device can pass the slope, so as to automatically implement cutting on a slope.
In the foregoing embodiments, the signal transmission modules can transmit a recognition signal and can receive a recognition signal and are disposed by using a structure that integrates transmission and reception. In other embodiments, transmission of a recognition signal and reception of a recognition signal may alternatively be set separately. The signal transmission modules are only configured to transmit a recognition signal, and signal reception modules that receive a recognition signal are added on the self-moving devices 100 and 300. In another embodiment, the added signal reception modules that receive a recognition signal may alternatively be disposed on objects other than the self-moving devices 100 and 300.
The technical features in the foregoing embodiments may be randomly combined. For simplicity of description, all possible combinations of the technical features in the foregoing embodiments are not described. However, it should be considered that these combinations of technical features fall within the scope recorded in the specification provided that these combinations of technical features do not have any conflict.
The foregoing embodiments only describe several implementation manners of the present invention, and their description is specific and detailed, but cannot therefore be understood as a limitation to the patent scope of the present invention. It should be noted that a person of ordinary skill in the art may further make variations and improvements without departing from the conception of the present invention, and these all fall within the protection scope of the present invention. Therefore, the patent protection scope of the present invention should be subject to the appended claims.
| Number | Date | Country | Kind |
|---|---|---|---|
| 201610576271.0 | Jul 2016 | CN | national |
| 201610576272.5 | Jul 2016 | CN | national |
| Number | Date | Country | |
|---|---|---|---|
| Parent | PCT/CN2017/093953 | Jul 2017 | US |
| Child | 16250960 | US |
