Patent Application
20230051334
The present invention relates to the field of automatic control, specifically to a mowing control method for an intelligent lawn mower.
With the development of the economy and the accelerated pace of urban construction, intelligent lawn mowers are widely used to maintain and mow the lawns of home yards. The common intelligent lawn mowers in the market are all driven by three motors, two of which are self-propelled motors that control the forward and backward movement and turning of the machine; the remaining one motor is a mowing motor, which drives the blades to achieve the mowing of the lawn.
Currently, all the motors are driven and controlled by a main control unit, and the self-propelled motor and the mowing motor are controlled separately, that is, the mowing motor is independent of the working state of the self-propelled motor. When mowing the grass, the self-propelled motor and the mowing motor generally run at constant speed, and the speed will not be adjusted according to the condition of the grass. When the grass is dense, the speed of the self-propelled motor is fast, or the speed of the mowing motor is low, which will lead to poor single cutting effect or even shutdown; but when the grass is sparse, the speed of the self-propelled motor is slow or the speed of the mowing motor is high, which will lead to low cutting efficiency or high energy consumption.
In view of the defects of the prior art that the self-propelled motor and the mowing motor are controlled separately, when the grass is dense, it will lead to poor single cutting effect or even shutdown; but when the grass is sparse, it will lead to low cutting efficiency or high energy consumption, the present invention provides a new mowing control method for an intelligent lawn mower.
In order to solve the technical problems, the present disclosure can be realized through the following technical schemes:
A mowing control method for an intelligent lawn mower, said intelligent lawn mower comprises a left self-propelled motor, a left self-propelled motor control unit, a right self-propelled motor, a right self-propelled motor control unit, a mowing motor, a mowing motor control unit, a main control unit, and a boundary sensor, said left self-propelled motor is connected to said left self-propelled motor control unit, said right self-propelled motor is connected to said right self-propelled motor control unit, said mowing motor is connected to said mowing motor control unit, and said left self-propelled motor control unit, said right self-propelled motor control unit, said mowing motor control unit and said boundary sensor are respectively connected to said main control unit, said control method comprises the following steps:
A. acquiring, by said mowing motor control unit, a current I0 when said mowing motor drives a blade for no-load operation and a real-time working current I, and setting a current threshold value for said mowing motor to switch from a low-speed mode to a high-speed mode as It1, a current threshold value for said mowing motor to switch from the high-speed mode to the low-speed mode as It2, a current limit value of a mowing drive current as IR, a minimum operating threshold value for speed protection of said mowing motor as Vmin, and a maximum operating speed of said mowing motor as Vmax;
B. acquiring, by said left self-propelled motor control unit and said right self-propelled motor control unit respectively, real-time speed V of said left self-propelled motor and said right self-propelled motor during operation, and setting the speed during low-speed operation as VL, and the speed during high-speed operation as VH;
C. when working, said mowing motor runs in the low-speed mode, and said left self-propelled motor and said right self-propelled motor run at the speed VH;
D. when encountering grassy areas, if the real-time working current I of said mowing motor is I0<I<It1, then keeping the current state; if the real-time working current I of said mowing motor is I≥It1 and it lasts for a period of T1, then skipping to step E; if the real-time working current I of said mowing motor equals to the current limit value IR, then skipping to step G;
E. said mowing motor control unit switches said mowing motor to the high-speed mode, at the same time said mowing motor control unit requests said main control unit, said main control unit sends a deceleration command to said left self-propelled motor control unit and said right self-propelled motor control unit, and said left self-propelled motor control unit and said right self-propelled motor control unit, after receiving the deceleration command, reduce the real-time speed V of said left self-propelled motor and said right self-propelled motor respectively at the same time, so that the real-time speed V is dynamically adjusted between VL and VH; subsequently, if the real-time working current I of said mowing motor is I<It2 and it lasts for a period of T2, then skipping to step F; if the real-time current I of said mowing motor equals to the current limit value IR, then skipping to step G;
F. said mowing motor control unit controls said mowing motor to switch to the low-speed mode, at the same time said mowing motor control unit requests said main control unit, said main control unit sends an acceleration command to said left self-propelled motor control unit and said right self-propelled motor control unit, and said left self-propelled motor control unit and said right self-propelled motor control unit, after receiving the acceleration command, switch the real-time speed V of said left self-propelled motor and said right self-propelled motor to VH respectively at the same time; subsequently, if the real-time working current I of said mowing motor is I≥It1 and it lasts for a period of T1, then skipping to the step E; if the real-time working current I of said mowing motor equals to the current limit value IR, then skipping to step G;
G. said mowing motor control unit controls said mowing motor to switch to the high-speed mode, said mowing motor control unit requests said main control unit, said main control unit sends a deceleration command to said left self-propelled motor control unit and said right self-propelled motor control unit, and said left self-propelled motor control unit and said right self-propelled motor control unit, after receiving the deceleration command, adjust the speed of said left self-propelled motor and said right self-propelled motor to VL respectively; subsequently, if the real-time working current I of said mowing motor is I<It2 and it lasts for a period of T2, then skipping to the step F; if the load on said mowing motor is too high and causes overcurrent shutdown protection of said mowing motor or the speed of said mowing motor is <Vmin and it lasts for a period of T3, then skipping to step H;
H. said mowing motor control unit controls said mowing motor to stop, at the same time said mowing motor control unit intercommunicates with said main control unit, and said left self-propelled motor control unit and said right self-propelled motor control unit control said left self-propelled motor and said right self-propelled motor to stop respectively, then said left self-propelled motor and said right self-propelled motor retreat first and then continue to work along the original forward cutting path; after attempting for M times, if said left self-propelled motor and said right self-propelled motor stop again, it is determined that the area is a dense grass area, then bypassing the dense grass area and skipping to the step C to continue working
Wherein, steps A and B are used to acquire or set various parameters, so as to prepare for the subsequent mowing control, wherein the current limit value IR of the mowing drive current adopts the rms current.
In the step C, at this point, the intelligent lawn mower has just started working. Before encountering grassy areas, by allowing the mowing motor to run in a low-speed mode and allowing the left self-propelled motor and the right self-propelled motor to run at the speed VH, the energy consumption can be reduced, and the intelligent lawn mower is also enabled to pass quickly, so that it can reach grassy areas for operation as soon as possible.
In the step D, when encountering grassy areas, a variety of situations may occur. By judging the real-time working current I of the mowing motor, the follow-up actions of the intelligent lawn mower under different working conditions can be well controlled, so as to better adapt to the working requirements in different situations.
In the step E, at this point, the area has been determined as a dense grass area by judging the real-time working current I of the mowing motor, then the cutting effect can be greatly improved by increasing the speed of the mowing motor. At this point, if the left self-propelled motor and the right self-propelled motor go too fast, the same cutting speed requires a greater input power. When the grass is particularly dense or particularly hard, the current limit value of the mowing motor will be definitely exceeded, causing the mowing motor control unit to automatically control the mowing motor to reduce its cutting speed; but after the speed of the mowing motor is reduced, the grass will not be cut or will not be cut evenly, or the lawn mower will go through the area directly. However, if the left self-propelled motor and the right self-propelled motor go too slowly, the mowing area per unit time will be reduced. In this step, by dynamically adjusting the speed of the left self-propelled motor and the right self-propelled motor, cutting can be done at the fastest walking speed under the premise of constant input while guaranteeing the mowing effect. After the dense grass area is cut, skipping to other steps according to different working conditions.
In the step F, at this point, the area has been determined as a sparse grass area or a grass-free area by judging the real-time working current I of the mowing motor. In the case of no mowing or little grass, high mowing speed will only increase energy consumption and noise, and the speed of the self-propelled motor determines the area that the intelligent lawn mower can cover after a single charge. In this step, by automatically reducing the speed of the mowing motor and increasing the speed of the left self-propelled motor and the right self-propelled motor to the maximum after judging the working current of the mowing motor, energy consumption can be reduced, and the working coverage area of the intelligent lawn mower can be increased. When subsequently encountering grassy areas, a variety of situations may occur. By judging the real-time working current I of the mowing motor, the follow-up actions of the intelligent lawn mower under different working conditions can be well controlled, so as to better adapt to the working requirements in different situations.
In the step G at this point, the real-time working current of the mowing motor has reached the limit of the mowing motor control unit, and the density or hardness of the grass has exceeded the load capacity of the mowing motor. If the load continues to increase at this point, causing the stall or nearly stall of the mowing motor, then skipping to a stall protection step; if such a state is only temporary, then skipping to the working condition of sparse grass areas.
In the step H, at this point, because the grassy area is too dense, in order to avoid the intelligent lawn mower being damaged due to the excessive load, the control method in the step H enables the intelligent lawn mower to either cut all the current grassy area through several attempts, or directly bypass the current grassy area and find other grassy areas for cutting, making it more intelligent in use.
Preferably, in the step E, the real-time speed V is dynamically adjusted between VL and VH following an equation V=VH*(I0/I)*K, where K is an adjustment coefficient, 0≤K≤1.
By dynamically adjusting the speed of the left self-propelled motor and the right self-propelled motor, the mowing effect and the coverage area of the intelligent lawn mower can be improved greatly under the condition of a constant input power.
Preferably, in the step H, said left self-propelled motor and said right self-propelled motor retreat first and then continue to work along the original cutting path, for which the specific steps are: said left self-propelled motor and said right self-propelled motor retreat at the speed VH for X1*N1 turns, and then continue to work at the speed VL along the original cutting path, said X1 is the coefficient of motor rotation, 0.1<X1<1, 1<N1<3.
Through the above steps, the intelligent lawn mower can be more intelligent and less likely to report a stall error; and the grass in the blind area which is formed during the judgement of switching from a sparse grass area to a dense grass area can be cut seamlessly; in addition, the backward operation can loosen the grass that was stuck before, and can improve the cutting effect when cutting again.
Preferably, in the step H, the method for bypassing the dense grass area comprises the following steps:
F1. said left self-propelled motor and said right self-propelled motor retreat first at the speed VH for X2*G*N2 turns and then stop, where 0.1≤X2≤1, 1≤N2≤3, 1≤G≤5;
F2. starting from the stopping point, with the center of the circle located on the line defined by the boundary sensor and the stopping point, detouring forward in a semicircle of radius R towards the interior of the boundary line, where 0.3≤R≤1.
Through the steps F1 and F2, the working conditions of being unable to cut or getting stuck can be avoided, making the intelligent lawn mower less prone to be blocked, more intelligent and more reliable.
Preferably, in the step A, said It1=I0*P, 1.1≤P≤5, and in the step D, step F, and step 0.1 s≤T1≤5 s.
The P value determines the sensitivity of the intelligent lawn mower in the judgement of dense grass areas. The smaller the P value, the more sensitive the intelligent lawn mower is to define a dense grass area, but there may be some misjudgment; the larger the P value, the more obtuse the intelligent lawn mower is to define a dense grass area, but it may be more energy efficient when the grass is not particularly dense. T1 determines the response speed of the intelligent lawn mower. The smaller T1, the faster the response speed is when a dense grass area is detected; the larger T1, the slower the response speed of the intelligent lawn mower. Limiting the P value and T1 within the above ranges can balance the judgement and the response speed of operation at the same time.
Preferably, in the step A, said It2=It1*Y, 1.2≤Y≤3, and in the step E and step 1 s≤T2≤5 s.
The Y value determines the sensitivity of the intelligent lawn mower in the judgement of sparse grass areas. The smaller the Y value, the more sensitive the intelligent lawn mower is to define a sparse grass area, but it is prone to be a misjudgment; the larger the Y value, the more obtuse the intelligent lawn mower is to define a sparse grass area, which may reduce the frequency of switching between high and low speed. T2 determines the response speed of the intelligent lawn mower. The smaller T2, the faster the response speed is when a sparse grass area is detected; the larger T2, the less chance of misjudgment. Limiting the Y value and T2 within the above ranges can balance the judgement and the response speed of operation at the same time.
Preferably, in the step A, Vmin=Vmax*L, 0.15≤L≤0.65, and in the step G 0.1 s≤T3≤3 s.
L determines the shutdown protection speed value of the mowing motor. The larger L, the more sensitive the protection, and the less likely it is to burn-in; the smaller L, the stronger the overload capacity of the mowing motor, and the less likely it is to stall and stop. T3 determines the sensitivity of the intelligent lawn mower to the mowing motor protection. The larger T3, the less likely the mowing motor will be stalled; the smaller T3, the less chance of burn-in. The above value ranges can ensure the maximum motor overload capacity without burn-in.
Preferably, in the step H, 1≤M≤5.
M determines the number of attempts after the mowing motor is stalled. The larger M, the cutting effect can be improved, but it will also increase the energy consumption of the intelligent lawn mower; the smaller M, the energy consumption can be reduced, but the cutting effect may be slightly worse. The above value range can achieve a better cutting effect while ensuring energy saving.
The present invention has the following beneficial effects:
1. Through the mowing control method of the present invention, the lawn can be directly cut and maintained by the intelligent lawn mower in most applications without manual intervention.
2. Through the mowing control method of the present invention, the cutting effect of dense grass areas can be improved significantly. For conventional intelligent lawn mowers, both the self-propelled motor and the mowing motor run at constant speed, so the lawn mowers may be easily blocked in dense grass areas, or they just push the grass down without cutting it completely. In contrast, in the mowing control method of the present invention, the speed of the left self-propelled motor and the right self-propelled motor is dynamically adjusted according to the actual working conditions of the mowing motor. Under the same energy consumption, the cutting effect of dense grass areas is greatly improved. Within a certain range, the grass in the area traversed by the intelligent lawn mower is cut into a neat path according to the cutter diameter, and the intelligent lawn mower will not be blocked due to the deep grass.
3. In the range of a sparse grass area, the present invention can prolong the service time of the intelligent lawn mower after a single charge. Most of conventional intelligent lawn mowers generally run at constant speed. In order to ensure the mowing effect, most solutions will increase the speed of the mowing motor. However, in sparse grass areas, the mowing motor runs almost with no load, and high-speed cutting will cause waste of energy. The present invention adopts an intelligent high-and-low speed scheme, where in dense grass areas, the speed of the mowing motor will be increased so as to greatly improve the cutting effect; while in sparse grass areas, the speed of the mowing motor will be reduced, thereby reducing the energy consumption and prolonging the service time of the intelligent lawn mower after a single charge. It is tested that by employing the mowing control method of the present invention, the energy consumption of the mowing motor alone is reduced by about 30%.
4. The noise of the intelligent lawn mower is reduced. By employing the mowing control method of the present invention, in sparse grass areas or during post-maintenance (mostly with small load), the mowing motor can be intelligently switched to a low-speed mode, thereby reducing the noise of the intelligent lawn mower. It is tested that by employing the mowing control method of the present invention, the noise is reduced by about 3 dB.
The present invention will be described in further detail below in conjunction with the accompanying drawings 1-4 and specific embodiments, but they are not intended to limit the present invention:
As shown in
A. acquiring, by said mowing motor control unit 3, a current I0 when said mowing motor 1 drives a blade for no-load operation and a real-time working current I, and setting a current threshold value for said mowing motor 1 to switch from a low-speed mode to a high-speed mode as It1, a current threshold value for said mowing motor 1 to switch from the high-speed mode to the low-speed mode as It2, a current limit value of a mowing drive current as IR, a minimum operating threshold value for speed protection of said mowing motor 1 as Vmin, and a maximum operating speed of said mowing motor 1 as Vmax;
B. acquiring, by said left self-propelled motor control unit 2 and said right self-propelled motor control unit 4 respectively, real-time speed V of said left self-propelled motor 6 and said right self-propelled motor 5 during operation, and setting the speed during low-speed operation as VL, and the speed during high-speed operation as VH;
C. when working, said mowing motor 1 runs in the low-speed mode, and said left self-propelled motor 6 and said right self-propelled motor 5 run at the speed VH;
D. when encountering grassy areas, if the real-time working current I of said mowing motor 1 is I0<I<It1, then keeping the current state; if the real-time working current I of said mowing motor 1 is I>It1 and it lasts for a period of T1, then skipping to step E; if the real-time working current I of said mowing motor 1 equals to the current limit value IR, then skipping to step G;
E. said mowing motor control unit 3 switches said mowing motor 1 to the high-speed mode, at the same time said mowing motor control unit 3 requests said main control unit 7, said main control unit 7 sends a deceleration command to said left self-propelled motor control unit 2 and said right self-propelled motor control unit 4, and said left self-propelled motor control unit 2 and said right self-propelled motor control unit 4, after receiving the deceleration command, reduce the real-time speed V of said left self-propelled motor 6 and said right self-propelled motor 5 respectively at the same time, so that the real-time speed V is dynamically adjusted between VL and VH; subsequently, if the real-time working current I of said mowing motor 1 is I<It2 and it lasts for a period of T2, then skipping to step F; if the real-time current I of said mowing motor 1 equals to the current limit value IR, then skipping to step G;
F. said mowing motor control unit 3 controls said mowing motor 1 to switch to the low-speed mode, at the same time said mowing motor control unit 3 requests said main control unit 7, said main control unit 7 sends an acceleration command to said left self-propelled motor control unit 2 and said right self-propelled motor control unit 4, and said left self-propelled motor control unit 2 and said right self-propelled motor control unit 4, after receiving the acceleration command, switch the real-time speed V of said left self-propelled motor 6 and said right self-propelled motor 5 to VH respectively at the same time; subsequently, if the real-time working current I of said mowing motor 1 is I>It1 and it lasts for a period of T1, then skipping to the step E; if the real-time working current I of said mowing motor 1 equals to the current limit value IR, then skipping to step G;
G. said mowing motor control unit 3 controls said mowing motor 1 to switch to the high-speed mode, said mowing motor control unit 3 requests said main control unit 7, said main control unit 7 sends a deceleration command to said left self-propelled motor control unit 2 and said right self-propelled motor control unit 4, and said left self-propelled motor control unit 2 and said right self-propelled motor control unit 4, after receiving the deceleration command, adjust the speed of said left self-propelled motor 6 and said right self-propelled motor 5 to VL respectively; subsequently, if the real-time working current I of said mowing motor 1 is I<It2 and it lasts for a period of T2, then skipping to the step F; if the load on said mowing motor 1 is too high and causes overcurrent shutdown protection of said mowing motor 1 or the speed of said mowing motor 1 is <Vmin and it lasts for a period of T3, then skipping to step H;
H. said mowing motor control unit 3 controls said mowing motor 1 to stop, at the same time said mowing motor control unit 3 intercommunicates with said main control unit 7, and said left self-propelled motor control unit 2 and said right self-propelled motor control unit 4 control said left self-propelled motor 6 and said right self-propelled motor 5 to stop respectively, then said left self-propelled motor 6 and said right self-propelled motor 5 retreat first and then continue to work along the original forward cutting path; after attempting for M times, if said left self-propelled motor 6 and said right self-propelled motor 5 stop again, it is determined that the area is a dense grass area, then bypassing the dense grass area and skipping to the step C to continue working.
Preferably, in the step E, the real-time speed V is dynamically adjusted between VL and VH following an equation V=VH*(I0/I)*K, where K is an adjustment coefficient, 0<K<1.
Preferably, in the step H, said left self-propelled motor 6 and said right self-propelled motor 5 retreat first and then continue to work along the original cutting path, for which the specific steps are: said left self-propelled motor 6 and said right self-propelled motor 5 retreat at the speed VH for X1*N1 turns, and then continue to work at the speed VL along the original cutting path, said X1 is the coefficient of motor rotation, X1 is 0.1, N1 is 1.
Preferably, in the step H, the method for bypassing the dense grass area comprises the following steps:
F1. said left self-propelled motor 6 and said right self-propelled motor 5 retreat first at the speed VH for X2*G*N2 turns and then stop, where 0.1≤X2≤1, 1≤N2≤3, 1≤G≤5;
F2. starting from the stopping point, with the center of the circle located on the line defined by the boundary sensor 8 and the stopping point, detouring forward in a semicircle of radius R towards the interior of the boundary line, where 0.3≤R≤1.
Preferably, in the step A, said It1=I0*P, P is 1.1, and in the step D, step F, and step T1 is 0.1 s.
Preferably, in the step A, said It2=It1 *Y, Y is 1.2, and in the step E and step G, T2 is 1 s.
Preferably, in the step A, Vmin=Vmax*L, L is 0.15, and in the step T3 is 0.1 s.
Preferably, in the step H, M is 1.
As shown in
A. acquiring, by said mowing motor control unit 3, a current I0 when said mowing motor 1 drives a blade for no-load operation and a real-time working current I, and setting a current threshold value for said mowing motor 1 to switch from a low-speed mode to a high-speed mode as It1, a current threshold value for said mowing motor 1 to switch from the high-speed mode to the low-speed mode as It2, a current limit value of a mowing drive current as IR, a minimum operating threshold value for speed protection of said mowing motor 1 as Vmin, and a maximum operating speed of said mowing motor 1 as Vmax;
B. acquiring, by said left self-propelled motor control unit 2 and said right self-propelled motor control unit 4 respectively, real-time speed V of said left self-propelled motor 6 and said right self-propelled motor 5 during operation, and setting the speed during low-speed operation as VL, and the speed during high-speed operation as VH;
C. when working, said mowing motor 1 runs in the low-speed mode, and said left self-propelled motor 6 and said right self-propelled motor 5 run at the speed VH;
D. when encountering grassy areas, if the real-time working current I of said mowing motor 1 is I0<I<It1, then keeping the current state; if the real-time working current I of said mowing motor 1 is I>It1 and it lasts for a period of T1, then skipping to step E; if the real-time working current I of said mowing motor 1 equals to the current limit value IR, then skipping to step G;
E. said mowing motor control unit 3 switches said mowing motor 1 to the high-speed mode, at the same time said mowing motor control unit 3 requests said main control unit 7, said main control unit 7 sends a deceleration command to said left self-propelled motor control unit 2 and said right self-propelled motor control unit 4, and said left self-propelled motor control unit 2 and said right self-propelled motor control unit 4, after receiving the deceleration command, reduce the real-time speed V of said left self-propelled motor 6 and said right self-propelled motor 5 respectively at the same time, so that the real-time speed V is dynamically adjusted between VL and VH; subsequently, if the real-time working current I of said mowing motor 1 is I<It2 and it lasts for a period of T2, then skipping to step F; if the real-time current I of said mowing motor 1 equals to the current limit value IR, then skipping to step G;
F. said mowing motor control unit 3 controls said mowing motor 1 to switch to the low-speed mode, at the same time said mowing motor control unit 3 requests said main control unit 7, said main control unit 7 sends an acceleration command to said left self-propelled motor control unit 2 and said right self-propelled motor control unit 4, and said left self-propelled motor control unit 2 and said right self-propelled motor control unit 4, after receiving the acceleration command, switch the real-time speed V of said left self-propelled motor 6 and said right self-propelled motor 5 to VH respectively at the same time; subsequently, if the real-time working current I of said mowing motor 1 is I≥It1 and it lasts for a period of T1, then skipping to the step E; if the real-time working current I of said mowing motor 1 equals to the current limit value IR, then skipping to step G;
G. said mowing motor control unit 3 controls said mowing motor 1 to switch to the high-speed mode, said mowing motor control unit 3 requests said main control unit 7, said main control unit 7 sends a deceleration command to said left self-propelled motor control unit 2 and said right self-propelled motor control unit 4, and said left self-propelled motor control unit 2 and said right self-propelled motor control unit 4, after receiving the deceleration command, adjust the speed of said left self-propelled motor 6 and said right self-propelled motor 5 to VL respectively; subsequently, if the real-time working current I of said mowing motor 1 is I<It2 and it lasts for a period of T2, then skipping to the step F; if the load on said mowing motor 1 is too high and causes overcurrent shutdown protection of said mowing motor 1 or the speed of said mowing motor 1 is <Vmin and it lasts for a period of T3, then skipping to step H;
H. said mowing motor control unit 3 controls said mowing motor 1 to stop, at the same time said mowing motor control unit 3 intercommunicates with said main control unit 7, and said left self-propelled motor control unit 2 and said right self-propelled motor control unit 4 control said left self-propelled motor 6 and said right self-propelled motor 5 to stop respectively, then said left self-propelled motor 6 and said right self-propelled motor 5 retreat first and then continue to work along the original forward cutting path; after attempting for M times, if said left self-propelled motor 6 and said right self-propelled motor 5 stop again, it is determined that the area is a dense grass area, then bypassing the dense grass area and skipping to the step C to continue working.
Preferably, in the step E, the real-time speed V is dynamically adjusted between VL and VH following an equation V=VH*(I0/I)*K, where K is an adjustment coefficient, 0≤K<1.
Preferably, in the step H, said left self-propelled motor 6 and said right self-propelled motor 5 retreat first and then continue to work along the original cutting path, for which the specific steps are: said left self-propelled motor 6 and said right self-propelled motor 5 retreat at the speed VH for X1*N1 turns, and then continue to work at the speed VL along the original cutting path, said X1 is the coefficient of motor rotation, X1 is 1, N1 is 3.
Preferably, in the step H, the method for bypassing the dense grass area comprises the following steps:
F1. said left self-propelled motor 6 and said right self-propelled motor 5 retreat first at the speed VH for X2*G*N2 turns and then stop, where 0.1<X2<1, 1<N2<3, 1<G<5;
F2. starting from the stopping point, with the center of the circle located on the line defined by the boundary sensor 8 and the stopping point, detouring forward in a semicircle of radius R towards the interior of the boundary line, where 0.3≤R≤1.
Preferably, in the step A, said It1=I0*P, P is 5, and in the step D, step F, and step T1 is 5 s.
Preferably, in the step A, said It2=It1 *Y, Y is 3, and in the step E and step G, T2 is 5 s.
Preferably, in the step A, Vmin=Vmax*L, L is 0.65, and in the step T3 is 3 s.
Preferably, in the step H, M is 5.
As shown in
A. acquiring, by said mowing motor control unit 3, a current I0 when said mowing motor 1 drives a blade for no-load operation and a real-time working current I, and setting a current threshold value for said mowing motor 1 to switch from a low-speed mode to a high-speed mode as It1, a current threshold value for said mowing motor 1 to switch from the high-speed mode to the low-speed mode as It2, a current limit value of a mowing drive current as IR, a minimum operating threshold value for speed protection of said mowing motor 1 as Vmin, and a maximum operating speed of said mowing motor 1 as Vmax;
B. acquiring, by said left self-propelled motor control unit 2 and said right self-propelled motor control unit 4 respectively, real-time speed V of said left self-propelled motor 6 and said right self-propelled motor 5 during operation, and setting the speed during low-speed operation as VL, and the speed during high-speed operation as VH;
C. when working, said mowing motor 1 runs in the low-speed mode, and said left self-propelled motor 6 and said right self-propelled motor 5 run at the speed VH;
D. when encountering grassy areas, if the real-time working current I of said mowing motor 1 is I0<I<It1, then keeping the current state; if the real-time working current I of said mowing motor 1 is I>It1 and it lasts for a period of T1, then skipping to step E; if the real-time working current I of said mowing motor 1 equals to the current limit value IR, then skipping to step G;
E. said mowing motor control unit 3 switches said mowing motor 1 to the high-speed mode, at the same time said mowing motor control unit 3 requests said main control unit 7, said main control unit 7 sends a deceleration command to said left self-propelled motor control unit 2 and said right self-propelled motor control unit 4, and said left self-propelled motor control unit 2 and said right self-propelled motor control unit 4, after receiving the deceleration command, reduce the real-time speed V of said left self-propelled motor 6 and said right self-propelled motor 5 respectively at the same time, so that the real-time speed V is dynamically adjusted between VL and VH; subsequently, if the real-time working current I of said mowing motor 1 is I<It2 and it lasts for a period of T2, then skipping to step F; if the real-time current I of said mowing motor 1 equals to the current limit value IR, then skipping to step G;
F. said mowing motor control unit 3 controls said mowing motor 1 to switch to the low-speed mode, at the same time said mowing motor control unit 3 requests said main control unit 7, said main control unit 7 sends an acceleration command to said left self-propelled motor control unit 2 and said right self-propelled motor control unit 4, and said left self-propelled motor control unit 2 and said right self-propelled motor control unit 4, after receiving the acceleration command, switch the real-time speed V of said left self-propelled motor 6 and said right self-propelled motor 5 to VH respectively at the same time; subsequently, if the real-time working current I of said mowing motor 1 is I≥It1 and it lasts for a period of T1, then skipping to the step E; if the real-time working current I of said mowing motor 1 equals to the current limit value IR, then skipping to step G;
G. said mowing motor control unit 3 controls said mowing motor 1 to switch to the high-speed mode, said mowing motor control unit 3 requests said main control unit 7, said main control unit 7 sends a deceleration command to said left self-propelled motor control unit 2 and said right self-propelled motor control unit 4, and said left self-propelled motor control unit 2 and said right self-propelled motor control unit 4, after receiving the deceleration command, adjust the speed of said left self-propelled motor 6 and said right self-propelled motor 5 to VL respectively; subsequently, if the real-time working current I of said mowing motor 1 is I<It2 and it lasts for a period of T2, then skipping to the step F; if the load on said mowing motor 1 is too high and causes overcurrent shutdown protection of said mowing motor 1 or the speed of said mowing motor 1 is <Vmin and it lasts for a period of T3, then skipping to step H;
H. said mowing motor control unit 3 controls said mowing motor 1 to stop, at the same time said mowing motor control unit 3 intercommunicates with said main control unit 7, and said left self-propelled motor control unit 2 and said right self-propelled motor control unit 4 control said left self-propelled motor 6 and said right self-propelled motor 5 to stop respectively, then said left self-propelled motor 6 and said right self-propelled motor 5 retreat first and then continue to work along the original forward cutting path; after attempting for M times, if said left self-propelled motor 6 and said right self-propelled motor 5 stop again, it is determined that the area is a dense grass area, then bypassing the dense grass area and skipping to the step C to continue working.
Preferably, in the step E, the real-time speed V is dynamically adjusted between VL and VH following an equation V=VH*(I0/I)*K, where K is an adjustment coefficient, 0≤K≤1.
Preferably, in the step H, said left self-propelled motor 6 and said right self-propelled motor 5 retreat first and then continue to work along the original cutting path, for which the specific steps are: said left self-propelled motor 6 and said right self-propelled motor 5 retreat at the speed VH for X1*N1 turns, and then continue to work at the speed VL along the original cutting path, said X1 is the coefficient of motor rotation, X1 is 0.5, N1 is 2.
Preferably, in the step H, the method for bypassing the dense grass area comprises the following steps:
F1. said left self-propelled motor 6 and said right self-propelled motor 5 retreat first at the speed VH for X2*G*N2 turns and then stop, where 0.1≤X2≤1, 1≤N2≤3, 1≤G≤5;
F2. starting from the stopping point, with the center of the circle located on the line defined by the boundary sensor 8 and the stopping point, detouring forward in a semicircle of radius R towards the interior of the boundary line, where 0.3≤R≤1.
Preferably, in the step A, said It1=I0*P, P is 3, and in the step D, step F, and step T1 is 2.5 s.
Preferably, in the step A, said It2=It1*Y, Y is 2.1, and in the step E and step G, T2 is 3 s.
Preferably, in the step A, Vmin=Vmax*L, L is 0.4, and in the step T3 is 1.5 s.
Preferably, in the step H, M is 3.
In summary, the above are only preferred embodiments of the present invention, and all equivalent variations and modifications made in accordance with the scope of the patent application of the present invention shall be covered by the present invention.
| Number | Date | Country | Kind |
|---|---|---|---|
| 202011563350.0 | Dec 2020 | CN | national |
| Filing Document | Filing Date | Country | Kind |
|---|---|---|---|
| PCT/CN2021/126007 | 10/25/2021 | WO |
