CN111941418A - Control method of self-moving robot and self-moving robot system - Google Patents
Control method of self-moving robot and self-moving robot system Download PDFInfo
- Publication number
- CN111941418A CN111941418A CN201910401318.3A CN201910401318A CN111941418A CN 111941418 A CN111941418 A CN 111941418A CN 201910401318 A CN201910401318 A CN 201910401318A CN 111941418 A CN111941418 A CN 111941418A
- Authority
- CN
- China
- Prior art keywords
- point
- self
- boundary line
- moving robot
- distance
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 53
- 238000004364 calculation method Methods 0.000 claims description 17
- 230000008569 process Effects 0.000 claims description 12
- 238000007689 inspection Methods 0.000 claims description 4
- 230000001960 triggered effect Effects 0.000 claims description 4
- 238000001514 detection method Methods 0.000 description 7
- 244000025254 Cannabis sativa Species 0.000 description 5
- 230000002093 peripheral effect Effects 0.000 description 5
- 238000010586 diagram Methods 0.000 description 2
- 239000000428 dust Substances 0.000 description 2
- 210000001503 joint Anatomy 0.000 description 2
- 241001494496 Leersia Species 0.000 description 1
- 238000009825 accumulation Methods 0.000 description 1
- 230000009471 action Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 239000000306 component Substances 0.000 description 1
- 239000008358 core component Substances 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000004146 energy storage Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000006870 function Effects 0.000 description 1
- 230000006698 induction Effects 0.000 description 1
- 230000007246 mechanism Effects 0.000 description 1
- 239000000203 mixture Substances 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000003032 molecular docking Methods 0.000 description 1
- 238000012806 monitoring device Methods 0.000 description 1
- 238000005507 spraying Methods 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1656—Programme controls characterised by programming, planning systems for manipulators
- B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- G05D1/02—Control of position or course in two dimensions
Abstract
The invention provides a control method of a self-moving robot, which comprises the following steps: s1, the self-moving robot walks to the boundary line and adjusts the posture of walking along the boundary line; s2, recording the current position point as a first point; s3, walking along the boundary line, and recording the current position point as a second point when a preset condition is reached; s4, calculating the distance between the first point and the second point; and S5, determining whether the current boundary line is the target boundary line according to whether the calculated distance is smaller than the threshold value. The distance between the first point and the second point is calculated, and the self-moving robot is controlled to walk according to the comparison result of the calculated distance and the threshold value, so that the self-moving robot is prevented from walking along an island boundary line in a circulating mode, and the self-moving robot is ensured to work more reliably automatically.
Description
Technical Field
The invention relates to the field of intelligent control, in particular to a control method of a self-moving robot and a self-moving robot system.
Background
With the continuous progress of scientific technology, various automatic working devices have started to slowly move into people's lives, such as: a mowing robot. The automatic working equipment is provided with the travelling device, the working device and the automatic control device, so that the automatic working equipment can be separated from the operation of people, automatically travels and executes work within a certain range, and can automatically return to the base station device to charge and then continue to work when the energy of the energy storage device of the automatic working equipment is insufficient.
In the prior art, random mowing is one of the main low-cost ways of mowing robots. The robot moves forwards in a defined range such as an electronic boundary until meeting an obstacle or a boundary, rotates by a random angle, continues to move forwards until meeting the obstacle or the boundary again, performs the same treatment, and circulates in the way. When the mowing robot finishes a work task or detects that the electric quantity of the mowing robot is low, a nearest boundary line is searched, and the mowing robot returns to charge along the boundary line. Since the boundary line of the obstacle and the boundary line of the working area are both used as the conducting wire, when the mowing robot encounters the conducting wire around the obstacle, the mowing robot is mistaken for the conducting wire located at the boundary of the working area and continuously walks along the conducting wire. The wires around obstacles tend to form a closed circle with a small radius, causing the mower to fall into a dead loop when performing a return.
Disclosure of Invention
An object of the present invention is to provide a control method for a self-moving robot capable of rapidly recognizing a work area.
Another object of the present invention is to provide a self-moving robot system that can rapidly identify a work area.
In order to achieve one of the above objects, the present invention provides a control method of a self-moving robot, including the steps of:
s1, the self-moving robot walks to the boundary line and adjusts the posture of walking along the boundary line;
s2, recording the current position point as a first point;
s3, walking along the boundary line, and recording the current position point as a second point when a preset condition is reached;
s4, calculating the distance between the first point and the second point;
and S5, determining whether the current boundary line is the target boundary line according to whether the calculated distance is smaller than the threshold value.
As a preferred embodiment of the present invention, the step S2 records the current position as the first point and starts timing, the step S3 walks along the boundary line, and when the preset condition is reached, the timing is interrupted and the current position is recorded as the second point.
As a preferable embodiment of the present invention, if the calculated distance is equal to or greater than the threshold value, the above steps S3 to S5 are repeated, and in the process of repeating steps S3 to S5, the distance between the first point and the second point in each of the steps S3 to S5 is calculated.
As a preferred embodiment of the present invention, in the process of repeating the steps S3 to S5, if the self-moving robot detects a preset event, an interrupt is triggered, and the loop of the steps S3 to S5 is skipped.
As a preferable embodiment of the present invention, in the step S3, it is determined whether the predetermined condition is reached after walking along the boundary line for a predetermined time.
As a preferable embodiment of the present invention, in the steps S3 and S4, the number of times that the self-moving robot reaches the preset condition reaches the preset value is recorded as the second point, the plurality of second points are obtained, and the distance between the first point and each of the second points is calculated.
As a preferable mode of one embodiment of the present invention, the distance between any of the second points and the first point is smaller than a threshold value, and the current boundary line is determined as the target boundary line.
As a preferable aspect of the embodiment of the present invention, the distance between the preset number of second points and the first point is smaller than the threshold, and the current boundary line is determined as the target boundary line.
As a preferable mode of one embodiment of the present invention, the average of the sums of the distances between the plurality of second points and the first point is smaller than a threshold value, and the current boundary line is determined as the target boundary line.
As a preferred embodiment of the present invention, if the calculated distance is greater than the threshold, the mobile robot rotates in place by a predetermined angle and then moves straight forward, leaves the current boundary line, and reaches another part of the boundary line, and the above steps S1 to S5 are performed in a loop.
As a preferable mode of one embodiment of the present invention, the preset condition is a preset time interval.
As a preferable mode of one embodiment of the present invention, the preset condition is that wheel speeds of driving wheels from both sides of the mobile robot are different.
In a preferred embodiment of the present invention, the self-moving robot is in a regression charging mode, and the adjusting to the posture of walking along the boundary line in step S2 includes turning the heading of the self-moving robot toward the direction of the regression base station so that the front-back direction of the self-moving robot is parallel to the extending direction of the boundary line.
As a preferable embodiment of the present invention, the self-moving robot is in the working mode, and the self-moving robot walks along the boundary line for one circle and performs the working task at the same time according to the determination result in the step S5, if the target boundary line is the preset working boundary line.
As a preferable mode of the embodiment of the present invention, in the step S1, the adjusting to the posture of walking along the boundary line includes turning the heading of the self-moving robot toward the side where the current traveling direction has a larger angle with the boundary line.
As a preferable aspect of one embodiment of the present invention, the calculating the distance between the first point and the second point includes:
s41, calculating parameters of the second point;
and S42, calculating the distance between the first point and the second point.
As a preferable aspect of one embodiment of the present invention, the calculating the parameter of the second point includes:
s411, calculating wheel speed difference, angular speed, mass center linear speed and track radius of driving wheels at two sides of the self-moving robot from a first point to a second point;
s412, judging whether the wheel speed difference of the driving wheels on the two sides is equal to zero or not;
and S413, calculating the parameter of the second point by using the parameter of the first point when the wheel speed difference is equal to zero.
As a preferable aspect of one embodiment of the present invention, the calculating the parameter of the second point further includes:
s414, when the wheel speed difference is not equal to zero, calculating the angular velocity, the mass center linear velocity and the track radius from the first point to the second point;
s415, calculating a parameter of a reference circle center according to the parameter of the first point;
and S416, calculating parameters of the second point according to the parameters of the circle center.
As a preferred embodiment of the present invention, if the wheel speed difference between the driving wheels on the two sides is not equal to zero, the calculation formula of the parameter of the reference circle center and the parameter of the current position point is as follows:
if the wheel speed difference of the driving wheels on the two sides is equal to zero, the calculation formula of the parameters of the current position point is as follows:
the distance between the second point and the first point is calculated as follows:
in the above-mentioned formula,
is the first point x-direction parameter,
is a first point y-direction parameter, thetaiAs a first point angle parameter, the angle of the point,Riradius of track of self-moving robot, diriIs the track direction, omega, of a self-moving robotiIs the angular velocity of the self-moving robot; Δ tiFor the time interval from the mobile robot traveling from the first point to the second point,
for reference to the x-direction parameter of the circle center,
for reference to the y-direction parameter of the circle center,
in order to refer to the parameter of the angle of the circle center,
for the x-direction parameter of the current location point,
for the y-direction parameter of the current position point, θi+1Δ d is the distance between the first point and the second point, which is the second point angle parameter.
The invention also relates to a self-moving robot system, which comprises a self-moving robot and a boundary line defining a working area, wherein the self-moving robot is provided with a walking module for driving the self-moving robot and a control module connected with the walking module, the walking module comprises a driving wheel moving in a range limited by the boundary line, the control module is used for controlling the walking module to enable the self-moving robot to walk, and the control module comprises:
the inspection unit is used for controlling the self-moving robot to reach the boundary line and adjusting the self-moving robot to the pose of walking along the boundary line, repeatedly executing control on the self-moving robot to walk along the boundary line and recording the current position as a first point when preset conditions are reached until the number of times of reaching the preset conditions reaches the preset value, and recording the current position as a second point; the calculating unit is used for calculating parameters of a second point according to the parameters of the first point and the walking parameters of the self-moving robot, and calculating the distance between the first point and the second point reaching preset conditions at least once based on the parameters of the first point and the parameters of the second point;
and the pushing unit is used for controlling whether the self-moving robot leaves the current boundary line or not according to whether the calculated distance is smaller than a threshold value or not.
As a preferable mode of one embodiment of the present invention, the control module further includes a timing unit for timing the self-moving robot from the first point to the second point.
As a preferable mode of one embodiment of the present invention, the preset condition is a preset time interval.
As a preferable mode of one embodiment of the present invention, the driving wheels include two driving wheels respectively located at two sides of the self-moving robot, and the preset condition is that wheel speeds of the two driving wheels are different.
The invention has the beneficial effects that: the distance between the first point and the second point is calculated, and the self-moving robot is controlled to walk according to the comparison result of the calculated distance and the threshold value, so that the self-moving robot is prevented from walking along an island boundary line in a circulating mode, and the self-moving robot is ensured to work more reliably automatically.
Drawings
FIG. 1 is a schematic view of a self-moving robot in a preferred embodiment of the present invention;
FIG. 2 is a schematic diagram of a self-moving robotic system in a preferred embodiment of the present invention;
FIG. 3 is a first control flow diagram of a self-moving robot in accordance with a preferred embodiment of the present invention;
FIG. 4 is a sub-flowchart of step S2 in FIG. 3;
FIG. 5 is a sub-flowchart of step S3 in FIG. 3;
FIG. 6 is a sub-flowchart of step S5 in FIG. 3;
FIG. 7 is a detailed flow chart of the self-propelled robot charging regression execution edgewise mode in the preferred embodiment of the present invention;
FIG. 8 is a flow chart of the calculation of a second point parameter from the mobile robot in a preferred embodiment of the present invention;
fig. 9 is a second control flowchart of the self-moving robot in the preferred embodiment of the present invention.
Detailed Description
The present invention will be described in detail below with reference to embodiments shown in the drawings. The present invention is not limited to the embodiment, and structural, methodological, or functional changes made by one of ordinary skill in the art according to the embodiment are included in the scope of the present invention.
The self-moving robot of the present invention may be an automatic lawn mower or an automatic vacuum cleaner, which automatically travels in a working area to perform lawn mowing and dust suction. Of course, the self-moving robot is not limited to the lawn mower and the dust collector, but may be other devices such as a spraying device, a snow removing device, a monitoring device, and the like suitable for unattended operation.
As shown in fig. 1 and 2, in a preferred embodiment of the present invention, the self-moving robot is a lawn mower 100, and the lawn mower 100 includes: the device comprises a machine body, a walking module arranged on the machine body, a boundary detection module, an energy module and a control module. In addition, the mower also comprises a working module which is used for executing specific working tasks of the mower, and the working module comprises a mowing blade, a cutting motor and the like, and also can comprise a mowing height adjusting mechanism and other components for optimizing or adjusting mowing effect.
The walking module is used for driving the mower to walk and steer in a working area and generally comprises a wheel set arranged on the mower and a driving motor for driving the wheel set to walk. In this embodiment, the walking module includes two driving wheels 21 located at both sides of the rear portion of the body and two universal wheels 31 located at the front portion of the body.
The boundary detection module is used for detecting the relative position relationship between the mower and the boundary line, and the relative position relationship may specifically include one or more of a distance, an angle, and an inner and outer direction of the boundary line. The boundary detection module can be of various compositions and principles, such as infrared type, ultrasonic type, collision detection type, magnetic induction type and the like, and the arrangement positions and the number of the sensors and the corresponding signal generating devices are also various.
The energy module is used for providing energy for various operations of the mower and comprises a rechargeable battery and a charging connection structure, wherein the charging connection structure is a charging electrode plate which can be exposed out of the mower.
The control module is used for controlling the automatic walking and working of the mower, is electrically connected with the walking module and the boundary detection module, is a core component of the mower, and performs the functions of controlling the working module to start or stop, generating a walking path, controlling the walking module to judge the electric quantity of the energy module according to the walking, and timely instructing the mower to return to a base station for automatic butt joint charging and the like. The control module typically includes a single-chip microcomputer and memory as well as other peripheral circuits.
The lawn mower further comprises various sensors for sensing the walking state of the lawn mower, such as: the sensors for tilting, lifting off the ground, collision, etc. are not described in detail herein.
Therein, the lawn mower 100 and the boundary line defining the working area thereof constitute a self-moving robot system, which further comprises a base station 200. The base station may be located inside or outside the work area and connected to the utility or other power supply system for recharging the mower. The base station can transmit pulse coding signals along the boundary line to form electromagnetic signals near the boundary line, and the control module can control the driving motor to operate according to the change of the electromagnetic signals near the boundary line and the difference of the signals inside and outside the boundary line acquired by the state sensor, so that the mower can timely turn to avoid and smoothly return to the base station along the boundary line for charging when detecting the boundary line. The boundary line comprises a peripheral boundary line 310 for limiting an internal working area and an island boundary line 320 for limiting an obstacle 330, the boundary detection module comprises two boundary line sensors 40 positioned at the front part of the machine body, when the distance S between two lines of the island is smaller than a certain value, the machine cannot correctly identify boundary signals, and the certain value is related to the characteristics of the boundary signals, the characteristics of the boundary line sensors and the like. As a specific example, when S is smaller than the distance L between two boundary line sensors, the machine cannot correctly recognize the boundary signal. Therefore, when the machine starts to run along the boundary with a certain point on the island as a starting point, the machine cannot leave the island. The following is a detailed description of a control method of a lawn mower according to an embodiment of the present invention, and more particularly, a method for quickly identifying a work area when the lawn mower travels.
As shown in fig. 3 to 7, in the present embodiment, the method for identifying the working area of the lawn mower includes the following steps:
s1, the mower walks to the boundary line and adjusts the posture of walking along the boundary line;
s2, recording the current position point as a first point;
s3, walking along the boundary line, and recording the current position point as a second point when a preset condition is reached;
s4, calculating the distance delta d between the first point and the second point;
and S5, determining whether the current boundary line is the target boundary line according to whether the calculated distance delta d is smaller than a threshold value.
The steps are used for the mower to execute the border mode, whether the current walking boundary line is the target boundary line or not can be judged quickly, the target boundary line is the island boundary line in the embodiment, and therefore the situation that the mower walks all the time along the island boundary line is avoided.
In order to facilitate the calculation of the distance between the first point and the second point, the current position point may be recorded as the first point and timing may be started, and when a preset condition is reached, timing may be interrupted and the current position point may be recorded as the second point.
That is, the step S2 specifically includes the following sub-steps:
s21, recording the current position point as a first point;
s22, setting parameters of the first point;
and S23, starting timing.
The step S3 specifically includes the following substeps:
s31, the mower walks along the boundary line;
s32, judging whether a preset condition is reached, if not, continuing to execute the step S31;
and S33, when the preset condition interrupt timing is reached, recording the current position point as a second point.
The step S5 specifically includes the following substeps:
s51, judging whether the calculated distance delta d is smaller than a threshold value, if not, repeatedly executing the steps S3 to S5;
and S52, if the calculated distance delta d is smaller than the threshold value, confirming that the current boundary line is the target boundary line.
According to the above sub-steps, in repeating the steps S3 to S5, the distance between the first point and the second point in each of the steps S3 to S5 is calculated, and as long as the calculated distance Δ d is less than the threshold value, the current boundary line is confirmed as the target boundary line.
When the mower is in different control modes, the mower can be controlled differently according to the judgment result of the steps. And when the mower meets the regression charging condition, if the battery power is detected to be lower than a preset value or the current working plan is finished, entering a regression charging mode along the boundary. When the mower executes the side grass cutting work, the boundary line of the current walking is determined to be the boundary line needing the work execution, and the mower starts to walk for a circle along the boundary line and cut grass.
Specifically, the lawn mower executes the regression charging mode along the boundary, and the closest boundary line needs to be found quickly, and the method for the lawn mower to walk to the boundary line in step S1 may be to execute the straight walking until the boundary line is reached. When the mower reaches the boundary line, the front-back direction of the mower body may form an angle with the boundary line, and the pose of the mower needs to be adjusted, wherein the pose adjustment in the step S1 is to turn the heading of the robot towards the direction of the returning base station, and the direction of the returning base station is to be in butt joint with the base station. For example, in fig. 2, the charging direction is shown above the base station 200, and when the lawnmower reaches the boundary line, the lawnmower turns to the left, and the front-rear direction of the main body is made substantially parallel to the boundary line, so that the lawnmower turns in any direction regardless of the angle at which the lawnmower reaches the boundary line.
The following is a detailed description of the process of the mower identifying the island boundary line 320 and finding the peripheral boundary line 310.
The mower receives the instruction for executing the border mode, and step S1 is executed, namely the mower walks to the border line; the step specifically includes linear walking and/or curvilinear walking, and in this implementation, the step S1 specifically includes: s11, the mower walks to the boundary line, preferably in a straight line, and can quickly find the boundary line; s12, judging whether the mower reaches the boundary line, and if not, continuing to perform the step S11; and S13, if the boundary line is reached, adjusting the posture, namely adjusting the front and back directions of the mower body to be approximately parallel to the boundary line. In this embodiment, the lawn mower requires the return charging, and therefore, the adjustment of the posture thereof includes turning the lawn mower in the return charging direction, the front and rear of the body of the lawn mower being substantially parallel to the boundary line, forming a posture of walking along the boundary line, so that the heading thereof is directed in the return direction,
after the pose is adjusted, in the next step S2, the point that reaches the boundary line initially is set as the first point Pi(i ═ 0), or the current position point is the first point Pi(i-0), the corresponding parameter (0, 0, 0) is set and the timer is started, that is, in step S2, the current location point is recorded as PiSetting up PiStart timing.
In this embodiment, step S31 is specifically to walk along the boundary line and record the left wheel linear velocity and the right wheel linear velocity; correspondingly, the preset condition in step S32 is that the linear velocity of the left wheel is different from the linear velocity of the right wheel, and in step S33, if the linear velocity of the left wheel is detected to be different from the linear velocity of the right wheel, the timing is interrupted and the current position point is recorded as the second point Pi+1。
Specifically, the robot travels along the boundary line and records the linear velocity of the left wheel
And right wheel linear velocity
If it is
Or
If the current position point is changed, the current position point is recorded as Pi+1(i is a positive integer), and interrupting timing; if it is
And
none of the points is changed, meaning that the curvature of the track is not changed, and no new point is recorded.
In step S4, the step of calculating the distance Δ d between the first point and the second point specifically includes the following sub-steps: s41, calculating a second point Pi+1The parameters of (1); s42, calculating point PiAnd point Pi+1The distance Δ d of (a) is determined whether Δ d is smaller than the threshold value in the next step S51, and if Δ d is smaller than the threshold value, it is determined that the current boundary line is an island boundary line, and step S53 is further executed to control the mower to rotate on the ground by a predetermined angle, then move forward, leave the current boundary line, and reach another part of the boundary line, and preferably move forward along a straight line, and the above steps S1 to S5 are repeated. If Δ d is equal to or greater than the threshold value, step S54 is performed, i +1 is set, and the above steps S3 to S5 are repeated.
In the process of repeating the above steps S3 to S5, when the robot detects a preset event, i.e., triggers an interrupt, the judgment loop of the above steps S3 to S5 is skipped. As a specific example, the predetermined event may be the detection of docking with the base station for charging. As another specific example, the predetermined event may be that a return signal is detected, and the determination cycle is skipped when the return signal is confirmed to reach the vicinity of the base station; in another specific example, when the signal sent by the base station is detected, the decision cycle can be skipped; in another specific example, the decision loop can be skipped when the default identifier of the base station is detected. In this embodiment, until the robot detects that the robot is docked with the base station for charging, an interrupt is triggered to execute a charging action.
In the process of repeating steps S3 to S5, a first point P is calculatediWith the first in the process of each of steps S3 to S5The distance Δ d between the two points does not cause the accumulation of the calculation of Δ d, and the accuracy of the calculation result is ensured, wherein the threshold value can be a fixed value.
According to the above steps, the preset condition in step S3 is that the wheel speeds of the driving wheels on both sides of the lawn mower are different, but in other embodiments, the preset condition may be a preset time interval.
In addition, by the method, the edgewise work mode of the mowing robot can be controlled, namely the robot walks for a circle along the boundary line and mows grass at the same time. When the mower is in the working mode, according to the judgment result in the step S5, if the current boundary line is a preset working boundary line, for example, the preset working boundary line is an island boundary line, the mower walks for a circle along the island boundary line and mows the grass at the same time; and if the preset working boundary line is the outer boundary line, the mower walks for a circle along the outer boundary line and mows the grass at the same time. Certainly, when mowing along the boundary line, the mower does not need to steer towards the direction of the returning base station when reaching the boundary line and turns, and can steer towards the side with the larger included angle between the current advancing direction and the boundary line, so that the turning angle of the mower is prevented from being too large, and the turning time is saved.
In order to avoid the erroneous determination caused by the too close distance between the first point and the second point in the initial determination, in step S3, it is determined whether the predetermined condition is reached after the predetermined time of walking along the boundary line, for example, the predetermined condition is determined after the predetermined time of walking along the boundary line is recorded for 10-30 seconds after the first point is recorded.
Certainly, the misjudgment may also be avoided in other manners, for example, in the above steps S3 and S4, it may be defined that the number of times that the mower reaches the preset condition needs to reach the preset value, where the preset value is an integer greater than 1, that is, the mower needs to reach the preset condition multiple times, the current position point when the preset condition is reached each time is recorded as the second point, multiple second points are obtained, the distance between the first point and each second point is calculated, the calculation may be performed every time one second point is recorded, or the calculation may be performed after all the second points are recorded, and the calculation is performed according to whether the calculated distance is smaller than the threshold value or notIt can be divided into a plurality of cases as long as the distance Δ d between any second point and the first pointiIf the boundary line is smaller than the threshold value, determining that the current boundary line is the target boundary line; in other embodiments, a predetermined number of second points are spaced from the first point by less than a threshold, and the current boundary line is determined to be the target boundary line, e.g., a critical ratio (or a specified critical value) exists, as long as Δ d is greater than the predetermined numberiIf the threshold is less than the threshold, islanding is determined, for example, if the critical ratio is 100% (or the critical value is 30), all Δ d are requirediWhen all are smaller than the threshold value, the islanding is determined. In other embodiments, an average of sums of distances between the plurality of second points and the first point is smaller than a threshold, and the current boundary line is determined as the target boundary line, that is, the average
And if the current is less than the threshold value, determining the island is judged. The distance calculated by the two misjudgment avoiding modes is smaller than the threshold, the control of the mower is the same as the scheme, and the detailed description is omitted.
Referring to FIG. 8, a detailed procedure of calculating the distance Δ d between the first point and the second point in step S4 is shown, in which the second point P is calculated in step S41i+1The parameters of (2) can adopt different calculation modes according to the judgment result of the wheel speed difference. Specifically, step S41 includes: s411, calculating the first point PiTo a second point Pi+1Wheel speed difference, angular velocity, mass center linear velocity and track radius; s412, judging whether the wheel speed difference is equal to zero or not; s413, when the wheel speed difference is equal to zero, using a first point PiIs calculated as a second point Pi+1The parameters of (1); s414, calculating the first point P when the wheel speed difference is not equal to zeroiTo a second point Pi+1Angular velocity, linear velocity of mass center, track radius; s415, according to the first point PiIs calculated as a reference circle center OiThe parameters of (1); s416, according to the reference circle center OiIs calculated as a second point Pi+1The parameter (c) of (c).
The calculation of the second point P will be explained in detail belowi+1And a first point PiThe distance between Δ d.
It is known that: from a first point PiTravels to a second point Pi+1Has a time interval of Δ ti(ii) a The mower is in the first point PiTravels to a second point Pi+1In the process, the linear velocity of the left wheel is
The right wheel linear velocity is
The width between the left driving wheel and the right driving wheel of the mower is WcarThese can be considered as walking parameters of the mower,
if it is
I.e. the track of the mower is not a straight line, then:
linear speed of center of mass (midpoint of connecting line of left wheel and right wheel) of mower
Angular velocity of mower
Radius of track
Track direction parameter
Knowing the first point PiParameter (d) of
Wherein
In order to know the parameters of the x-direction of the point,
for the known y-direction parameter of the point, θiIs a known pointAnd (4) angle parameters.
By knowing the first point PiCalculating a reference center point OiParameter (d) of
Wherein
For reference to the x-direction parameter of the center point,
for reference to the y-direction parameter of the center point,
is a reference center point angle parameter. Then:
by reference to the centre point OiCalculating a second point Pi+1Parameter (d) of
Then:
if it is
Namely, the track of the robot is a straight line, then:
according to the calculated second point Pi+1Parameter (d) of
It is possible to obtain:
according to the calculation mode, whether the current boundary line is the island boundary line can be quickly determined, and the algorithm can be used no matter the island boundary line is in any shape, so that the requirements of different users are met, the setting operation is convenient, the occupied memory is small, and the processing speed is higher.
Based on the foregoing method, the present invention further provides a self-moving robot system, including a self-moving robot and a boundary line defining a working area, where the self-moving robot is a lawn mower in this embodiment, and has a walking module for driving the lawn mower to walk and turn in the working area, and a control module connected to the walking module, where the walking module includes a driving wheel moving within a range defined by the boundary line, and the control module is configured to control the walking module to enable the self-moving robot to walk, and the control module includes:
the inspection unit is used for controlling the self-moving robot to reach the boundary line and adjusting the self-moving robot to the pose of walking along the boundary line, repeatedly executing control on the self-moving robot to walk along the boundary line and recording the current position as a first point when preset conditions are reached until the number of times of reaching the preset conditions reaches the preset value, and recording the current position as a second point;
a timing unit for timing the mower from a first point to a second point;
the calculating unit is used for calculating parameters of a second point according to the parameters of the first point and the walking parameters of the self-moving robot, and calculating the distance between the first point and the second point reaching preset conditions at least once based on the parameters of the first point and the parameters of the second point;
and the pushing unit is used for controlling whether the mower leaves the current boundary line or not according to whether the calculated distance is smaller than the threshold value or not.
When the mower is in a low power state and needs to go home, if the calculated distance is smaller than the threshold value, the mower is controlled to leave the current boundary line, the mower can rotate on site by a preset angle and then linearly move forward to leave the current boundary line until the other part of the boundary line is reached, so that the mower can be identified to be in an island boundary line as soon as possible, too long time does not need to be consumed, and the electric quantity is saved.
When the mower is in a working mode, if the calculated distance is smaller than the threshold value, the current boundary line is an island boundary line, and the mower walks for a circle along the island boundary line and executes a working task, such as mowing. And if the current boundary line is the peripheral boundary line, the self-moving robot walks for a circle along the peripheral boundary line and simultaneously executes the work task. When the mower executes the boundary line working mode, grass on the island boundary can be cut, and the island boundary is prevented from being excessively mowed.
The distance between the first point and the second point is calculated, and the walking of the mower is controlled according to the comparison result of the calculated distance and the threshold value, so that the mower is prevented from walking along an island boundary line in a circulating mode, and the automatic work of the mower is ensured to be more reliable.
Referring to fig. 9, another control method of the mower can also realize the quick identification of the working area when the mower walks. In this embodiment, the method for identifying the working area of the lawn mower includes the following steps:
s1', the mower walks to the boundary line and adjusts the posture of walking along the boundary line;
s2', walking along the boundary line, and recording the current position point as a first point when the preset condition is reached;
s3 ', repeating the step S2' until the times of reaching the preset condition reach the preset value, and recording the current position point as a second point;
s4', calculating the distance between the first point and the second point which reach the preset condition at least once;
s5', it is determined whether the current boundary line is the target boundary line, based on whether the calculated distance is less than the threshold value.
The steps are used for the mower to execute the border mode, whether the current walking boundary line is the target boundary line or not can be judged quickly and accurately, the target boundary line is the island boundary line in the embodiment, and therefore the situation that the mower walks along the island boundary line all the time is avoided.
To facilitate the calculation of the distance between the first point and the second point, the time counting may be interrupted when the current position point is recorded as the first point and the time counting is started, and the second point is recorded in step S3'. Similarly, if the calculated distance is greater than or equal to the threshold, the steps S2 'to S5' are repeated, and in the process of repeating the steps S2 'to S5', if the mower detects a preset event, an interrupt is triggered, and the loop of the steps S2 'to S5' is skipped. The preset event may be the same as the preset event in the control method of the first lawn mower, or may be another event.
In the above steps S3 'and S4', the number of times the mower reaches the preset condition reaches the preset value, the current position point every time the preset condition is reached is recorded as the first point, a plurality of first points are obtained, and the distance between each of the first points and the second point is calculated. In this embodiment, the preset value k may be set to 30, that is, the lawn mower needs to record 30 first points, and the second point is the 31 st recorded point. In the present embodiment, it is preferable to calculate the distance { Δ d between each first point and the second point separately1,Δd2,...,ΔdkAt step S5', the { Δ d } values are compared1,Δd2,...,ΔdkDetermining whether the current boundary is an island boundary line or not according to the relation between the current boundary and a threshold; if yes, leaving the current boundary line; if not, the process returns to step S2'.
In the actual control process, any delta d is only needediAnd if the current is less than the threshold value, determining the island is judged. In other aspects, it may be that the distance between a predetermined number of first points and second points is less than the threshold, i.e., there is a critical ratio (or specified critical value) as long as Δ d is greater than the numberiIf the threshold is less than the threshold, islanding is determined, for example, if the critical ratio is 100% (or the critical value is 30), all Δ d are requirediWhen all are smaller than the threshold value, the islanding is determined. In other embodiments, the average value
And if the sum of the distances between the first points and the second points is smaller than the threshold value, the island is judged.
In the above control method, if the calculated distance is greater than the threshold value, the control is the same as the control method of the first mower, the predetermined condition may be a predetermined time interval, or the wheel speeds of the driving wheels on both sides of the mower are different. Further, the specific method of adjusting the posture of walking along the boundary line may refer to the control method of the first lawnmower. In addition, the calculation of the distance between the first point and the second point may also refer to the calculation step in the first lawn mower control method, and will not be described herein again.
The embodiment also relates to a mower system, which comprises a mower and a boundary line defining a working area, wherein the mower is provided with a walking module for driving the mower and a control module connected with the walking module, the walking module comprises a driving wheel moving in a range limited by the boundary line, the control module is used for controlling the walking module to enable the mower to walk, and the control module comprises: the inspection unit is used for controlling the self-moving robot to reach the boundary line and adjusting the self-moving robot to a pose of walking along the boundary line, then controlling the self-moving robot to walk along the boundary line, recording a current position point reaching a preset condition within preset times as a first point, and recording the current position point as a second point when the times of reaching the preset condition are greater than a preset value; the calculating unit is used for calculating parameters of a second point according to the parameters of the first point reaching the preset condition at least once and the walking parameters of the self-moving robot, and calculating the distance between the first point and the second point based on the parameters of the first point and the parameters of the second point; and the pushing unit is used for controlling whether the self-moving robot leaves the current boundary line or not according to whether the calculated distance is smaller than a threshold value or not.
The control module further comprises a timing unit for timing the mower from the first point to the second point.
According to the control method and the mower system, the distance between the at least one first point and the second point is calculated, and the mower is controlled to walk according to the comparison result of the calculated distance and the threshold value, so that the mower is prevented from walking along an island boundary line in a circulating mode, and the mower is ensured to work more reliably automatically.
It should be understood that although the present description refers to embodiments, not every embodiment contains only a single technical solution, and such description is for clarity only, and those skilled in the art should make the description as a whole, and the technical solutions in the embodiments can also be combined appropriately to form other embodiments understood by those skilled in the art.
The above-listed detailed description is only a specific description of a possible embodiment of the present invention, and they are not intended to limit the scope of the present invention, and equivalent embodiments or modifications made without departing from the technical spirit of the present invention should be included in the scope of the present invention.
Claims (23)
1. A control method of a self-moving robot is characterized by comprising the following steps:
s1, the self-moving robot walks to the boundary line and adjusts the posture of walking along the boundary line;
s2, recording the current position point as a first point;
s3, walking along the boundary line, and recording the current position point as a second point when a preset condition is reached;
s4, calculating the distance between the first point and the second point;
and S5, determining whether the current boundary line is the target boundary line according to whether the calculated distance is smaller than the threshold value.
2. The control method of self-moving robot as claimed in claim 1, wherein the current position point is recorded as a first point and timing is started in the step S2, the walking is performed along the boundary line in the step S3, and when the preset condition is reached, timing is interrupted and the current position point is recorded as a second point.
3. The method of controlling a self-propelled robot as claimed in any one of claims 1 to 2, wherein if the calculated distance is equal to or greater than the threshold value, the steps S3 to S5 are repeated, and in the process of repeating the steps S3 to S5, the distance between the first point and the second point in each of the steps S3 to S5 is calculated.
4. The method as claimed in claim 3, wherein in the process of repeating the steps S3 to S5, if the self-moving robot detects a predetermined event, an interrupt is triggered to jump out of the loop of the steps S3 to S5.
5. The method of claim 3, wherein in step S3, the control unit determines whether a predetermined condition is reached after walking along the boundary line for a predetermined time.
6. The self-propelled robot control method of any one of claims 1 to 2, wherein in the steps S3 and S4, the number of times the self-propelled robot reaches the preset condition reaches a preset value, the current position point at each time the preset condition is reached is recorded as a second point, a plurality of second points are obtained, and the distance between the first point and each of the second points is calculated.
7. The control method of a self-moving robot according to claim 6, wherein the distance between any of the second points and the first point is less than a threshold value, and the current boundary line is determined as the target boundary line.
8. The control method of a self-moving robot according to claim 6, wherein the distance between a preset number of second points and the first point is less than a threshold value, and the current boundary line is determined as the target boundary line.
9. The control method of a self-moving robot according to claim 6, wherein an average value of sums of distances between the plurality of second points and the first point is smaller than a threshold value, and a current boundary line is determined as a target boundary line.
10. The method of controlling a self-propelled robot as claimed in any one of claims 1 to 2, wherein if the calculated distance is greater than the threshold value, the self-propelled robot rotates in place by a predetermined angle and then moves straight ahead, leaving the current boundary line, until reaching another part of the boundary line, and the above steps S1 to S5 are repeated.
11. The method according to any one of claims 1 to 2, wherein the predetermined condition is a predetermined time interval.
12. The method according to any one of claims 1 to 2, wherein the predetermined condition is that wheel speeds of driving wheels on both sides of the mobile robot are different.
13. The method according to any one of claims 1 to 2, wherein the self-moving robot is in a regression charging mode, and the adjusting to the posture of walking along the boundary line in step S2 includes turning a heading of the self-moving robot toward a direction of a regression base station so that a front-rear direction of the self-moving robot is parallel to an extending direction of the boundary line.
14. The method of controlling a self-moving robot as claimed in any one of claims 1 to 2, wherein the self-moving robot is in an operation mode, and the self-moving robot walks along the boundary line for one turn and performs the operation task at the same time, based on the determination result in the step S5, if the target boundary line is a preset operation boundary line.
15. The control method of the self-moving robot as claimed in claim 14, wherein the adjusting to the pose of walking along the boundary line in the step S1 includes turning the heading of the self-moving robot toward the side where the current traveling direction makes a larger angle with the boundary line.
16. The method for controlling a self-moving robot according to any one of claims 1 to 2, wherein calculating the distance between the first point and the second point comprises:
s41, calculating parameters of the second point;
and S42, calculating the distance between the first point and the second point.
17. The control method of the self-moving robot according to claim 16, wherein calculating the parameter of the second point includes:
s411, calculating wheel speed difference, angular speed, mass center linear speed and track radius of driving wheels at two sides of the self-moving robot from a first point to a second point;
s412, judging whether the wheel speed difference of the driving wheels on the two sides is equal to zero or not;
and S413, calculating the parameter of the second point by using the parameter of the first point when the wheel speed difference is equal to zero.
18. The control method of a self-moving robot according to claim 17, wherein calculating the parameter of the second point further comprises:
s414, when the wheel speed difference is not equal to zero, calculating the angular velocity, the mass center linear velocity and the track radius from the first point to the second point;
s415, calculating a parameter of a reference circle center according to the parameter of the first point;
and S416, calculating parameters of the second point according to the parameters of the circle center.
19. The control method of a self-moving robot as claimed in claim 16, wherein if the wheel speed difference between the driving wheels on both sides is not equal to zero, the calculation formula of the parameter of the reference circle center and the parameter of the current position point is as follows:
if the wheel speed difference of the driving wheels on the two sides is equal to zero, the calculation formula of the parameters of the current position point is as follows:
the distance between the second point and the first point is calculated as follows:
in the above-mentioned formula,
is the first point x-direction parameter,
is a first point y-direction parameter, thetaiIs a first point angle parameter, RiRadius of track of self-moving robot, diriIs the track direction, omega, of a self-moving robotiIs the angular velocity of the self-moving robot; Δ tiFor the time interval from the mobile robot traveling from the first point to the second point,
for reference to the x-direction parameter of the circle center,
for reference to the y-direction parameter of the circle center,
in order to refer to the parameter of the angle of the circle center,
for the x-direction parameter of the current location point,
for the y-direction parameter of the current position point, θi+1Δ d is the distance between the first point and the second point, which is the second point angle parameter.
20. A self-moving robot system comprising a self-moving robot and a boundary line defining a working area, the self-moving robot having a walking module for driving the self-moving robot and a control module connected to the walking module, the walking module including a driving wheel moving within a range defined by the boundary line, the control module being configured to control the walking module to make the self-moving robot walk, the control module comprising:
the inspection unit is used for controlling the self-moving robot to reach the boundary line and adjusting the self-moving robot to the pose of walking along the boundary line, repeatedly executing control on the self-moving robot to walk along the boundary line and recording the current position as a first point when preset conditions are reached until the number of times of reaching the preset conditions reaches the preset value, and recording the current position as a second point;
the calculating unit is used for calculating parameters of a second point according to the parameters of the first point and the walking parameters of the self-moving robot, and calculating the distance between the first point and the second point reaching preset conditions at least once based on the parameters of the first point and the parameters of the second point;
and the pushing unit is used for controlling whether the self-moving robot leaves the current boundary line or not according to whether the calculated distance is smaller than a threshold value or not.
21. The self-moving robotic system according to claim 20, wherein said control module further comprises a timing unit for timing said self-moving robot from a first point to a second point.
22. The self-moving robotic system as claimed in claim 20, wherein the predetermined condition is a predetermined time interval.
23. The self-moving robot system as claimed in claim 20, wherein the driving wheels include two, which are respectively located at both sides of the self-moving robot, and the preset condition is that wheel speeds of the two driving wheels are different.
Priority Applications (2)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201910401318.3A CN111941418B (en) | 2019-05-15 | 2019-05-15 | Control method of self-moving robot and self-moving robot system |
| PCT/CN2019/115674 WO2020228263A1 (en) | 2019-05-15 | 2019-11-05 | Control method for self mobile robot and self mobile robot system |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201910401318.3A CN111941418B (en) | 2019-05-15 | 2019-05-15 | Control method of self-moving robot and self-moving robot system |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN111941418A true CN111941418A (en) | 2020-11-17 |
| CN111941418B CN111941418B (en) | 2024-03-08 |
Family
ID=73289275
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201910401318.3A Active CN111941418B (en) | 2019-05-15 | 2019-05-15 | Control method of self-moving robot and self-moving robot system |
Country Status (2)
| Country | Link |
|---|---|
| CN (1) | CN111941418B (en) |
| WO (1) | WO2020228263A1 (en) |
Citations (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2002136454A (en) * | 2000-10-31 | 2002-05-14 | Matsushita Electric Ind Co Ltd | Self-traveling cleaner |
| JP2005339408A (en) * | 2004-05-28 | 2005-12-08 | Toshiba Corp | Self-traveling robot and its control method |
| CN107678429A (en) * | 2017-09-26 | 2018-02-09 | 珠海市微半导体有限公司 | The control method and chip of a kind of robot |
| CN108196555A (en) * | 2018-03-09 | 2018-06-22 | 珠海市微半导体有限公司 | The control method that autonomous mobile robot is walked along side |
| CN108508891A (en) * | 2018-03-19 | 2018-09-07 | 珠海市微半导体有限公司 | A kind of method of robot reorientation |
| CN108553041A (en) * | 2018-03-19 | 2018-09-21 | 珠海市微半导体有限公司 | A kind of control method robot trapped judgment method and its got rid of poverty |
Family Cites Families (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN104699101A (en) * | 2015-01-30 | 2015-06-10 | 深圳拓邦股份有限公司 | Robot mowing system capable of customizing mowing zone and control method thereof |
| US20190016583A1 (en) * | 2017-07-17 | 2019-01-17 | Ford Global Technologies, Llc | Vehicle platoon refueling |
| CN107608363A (en) * | 2017-10-30 | 2018-01-19 | 北京奇虎科技有限公司 | Avoidance processing method, device and the robot of robot |
| CN108717293B (en) * | 2018-03-22 | 2022-07-05 | 杭州苏珀曼智能科技有限公司 | Roundabout identification method and system |
-
2019
- 2019-05-15 CN CN201910401318.3A patent/CN111941418B/en active Active
- 2019-11-05 WO PCT/CN2019/115674 patent/WO2020228263A1/en active Application Filing
Patent Citations (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2002136454A (en) * | 2000-10-31 | 2002-05-14 | Matsushita Electric Ind Co Ltd | Self-traveling cleaner |
| JP2005339408A (en) * | 2004-05-28 | 2005-12-08 | Toshiba Corp | Self-traveling robot and its control method |
| CN107678429A (en) * | 2017-09-26 | 2018-02-09 | 珠海市微半导体有限公司 | The control method and chip of a kind of robot |
| CN108196555A (en) * | 2018-03-09 | 2018-06-22 | 珠海市微半导体有限公司 | The control method that autonomous mobile robot is walked along side |
| CN108508891A (en) * | 2018-03-19 | 2018-09-07 | 珠海市微半导体有限公司 | A kind of method of robot reorientation |
| CN108553041A (en) * | 2018-03-19 | 2018-09-21 | 珠海市微半导体有限公司 | A kind of control method robot trapped judgment method and its got rid of poverty |
Also Published As
| Publication number | Publication date |
|---|---|
| CN111941418B (en) | 2024-03-08 |
| WO2020228263A1 (en) | 2020-11-19 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN111941419B (en) | Control method of self-moving robot and self-moving robot system | |
| EP3438778B1 (en) | Automatic traveling device and steering method thereof | |
| US11287821B2 (en) | Autonomous working system, an autonomous vehicle and a turning method thereof | |
| WO2017198222A1 (en) | Automatic work system, self-moving device and control method therefor | |
| EP4057099B1 (en) | Universal recharge control method for robot, chip and robot | |
| CN111837587B (en) | Automatic mower and control method thereof | |
| CN106444736B (en) | Automatic return system and control method | |
| WO2020155717A1 (en) | Autonomous mobile robot system | |
| CN109471442B (en) | Processing method for meeting obstacle when robot linearly returns to seat, chip and robot | |
| US20220197299A1 (en) | Recharging method for mobile robot and mobile robot | |
| WO2019223725A1 (en) | Automatic mower and turning method | |
| US20230071262A1 (en) | Robotic mower and method, system and device of path planning thereof | |
| CN111123909A (en) | Walking control method and system of self-walking equipment and self-walking equipment | |
| CN106468920B (en) | Regression charging method and automatic walking equipment thereof | |
| CN111941418A (en) | Control method of self-moving robot and self-moving robot system | |
| CN210202476U (en) | Automatic mower | |
| EP4254117A1 (en) | Self-moving robot charging system and self-moving robot charging method | |
| WO2021139683A1 (en) | Self-moving device | |
| CN114937258A (en) | Control method for mowing robot, and computer storage medium | |
| CN112445213B (en) | Automatic working system, automatic walking equipment, control method of automatic walking equipment, computer equipment and computer readable storage medium | |
| US20220330477A1 (en) | Control device and work machine | |
| WO2021244593A1 (en) | Automatic lawn mower and path-planning method, system and device thereof | |
| CN116300841A (en) | Automatic working system, automatic working method and computer readable storage medium | |
| CN115328112A (en) | Self-moving apparatus, moving trajectory adjusting method, and computer-readable storage medium | |
| CN117008612A (en) | Control method of automatic walking equipment |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| PB01 | Publication | ||
| PB01 | Publication | ||
| SE01 | Entry into force of request for substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| GR01 | Patent grant | ||
| GR01 | Patent grant |