CN112198876A - Map-contained full-coverage sweeping modular control method suitable for sweeping robot - Google Patents
Map-contained full-coverage sweeping modular control method suitable for sweeping robot Download PDFInfo
- Publication number
- CN112198876A CN112198876A CN202011045425.6A CN202011045425A CN112198876A CN 112198876 A CN112198876 A CN 112198876A CN 202011045425 A CN202011045425 A CN 202011045425A CN 112198876 A CN112198876 A CN 112198876A
- Authority
- CN
- China
- Prior art keywords
- current
- coordinate
- line
- sweeping
- route
- 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
- 238000010408 sweeping Methods 0.000 title claims abstract description 76
- 238000000034 method Methods 0.000 title claims abstract description 61
- 238000004891 communication Methods 0.000 claims abstract description 18
- 230000008569 process Effects 0.000 claims description 30
- 238000012937 correction Methods 0.000 claims description 12
- 230000008859 change Effects 0.000 claims description 9
- 238000004364 calculation method Methods 0.000 claims description 4
- 238000013459 approach Methods 0.000 claims description 3
- 238000011065 in-situ storage Methods 0.000 claims description 3
- 230000009467 reduction Effects 0.000 claims description 3
- 238000004140 cleaning Methods 0.000 abstract description 4
- 241001417527 Pempheridae Species 0.000 description 3
- 230000004048 modification Effects 0.000 description 3
- 238000012986 modification Methods 0.000 description 3
- 230000005540 biological transmission Effects 0.000 description 1
- 230000008878 coupling Effects 0.000 description 1
- 238000010168 coupling process Methods 0.000 description 1
- 238000005859 coupling reaction Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000002054 transplantation Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
-
- A—HUMAN NECESSITIES
- A47—FURNITURE; DOMESTIC ARTICLES OR APPLIANCES; COFFEE MILLS; SPICE MILLS; SUCTION CLEANERS IN GENERAL
- A47L—DOMESTIC WASHING OR CLEANING; SUCTION CLEANERS IN GENERAL
- A47L11/00—Machines for cleaning floors, carpets, furniture, walls, or wall coverings
- A47L11/24—Floor-sweeping machines, motor-driven
-
- A—HUMAN NECESSITIES
- A47—FURNITURE; DOMESTIC ARTICLES OR APPLIANCES; COFFEE MILLS; SPICE MILLS; SUCTION CLEANERS IN GENERAL
- A47L—DOMESTIC WASHING OR CLEANING; SUCTION CLEANERS IN GENERAL
- A47L11/00—Machines for cleaning floors, carpets, furniture, walls, or wall coverings
- A47L11/40—Parts or details of machines not provided for in groups A47L11/02 - A47L11/38, or not restricted to one of these groups, e.g. handles, arrangements of switches, skirts, buffers, levers
-
- A—HUMAN NECESSITIES
- A47—FURNITURE; DOMESTIC ARTICLES OR APPLIANCES; COFFEE MILLS; SPICE MILLS; SUCTION CLEANERS IN GENERAL
- A47L—DOMESTIC WASHING OR CLEANING; SUCTION CLEANERS IN GENERAL
- A47L11/00—Machines for cleaning floors, carpets, furniture, walls, or wall coverings
- A47L11/40—Parts or details of machines not provided for in groups A47L11/02 - A47L11/38, or not restricted to one of these groups, e.g. handles, arrangements of switches, skirts, buffers, levers
- A47L11/4011—Regulation of the cleaning machine by electric means; Control systems and remote control systems therefor
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0268—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means
-
- A—HUMAN NECESSITIES
- A47—FURNITURE; DOMESTIC ARTICLES OR APPLIANCES; COFFEE MILLS; SPICE MILLS; SUCTION CLEANERS IN GENERAL
- A47L—DOMESTIC WASHING OR CLEANING; SUCTION CLEANERS IN GENERAL
- A47L2201/00—Robotic cleaning machines, i.e. with automatic control of the travelling movement or the cleaning operation
- A47L2201/04—Automatic control of the travelling movement; Automatic obstacle detection
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
The invention discloses a modular control method with map for full-coverage sweeping suitable for a sweeping robot, belonging to the field of control methods. When an error occurs in a single module, the operation of the machine is not influenced, and the machine can execute the original sweeping logic without map control to wait for the map module to be restarted successfully. When transplanting operation is carried out between different models, chip pin configuration in the motion module is modified, the cost of function increasing time is low, only a communication module needs to be modified according to a function adding module, different environments can be adapted to in cleaning, the coverage efficiency and the coverage rate are far higher than those of a random collision type, the collision of a machine with a wall and furniture is greatly reduced in a route navigation mode, and the damage to the environment and products is reduced.
Description
Technical Field
The invention relates to the field of control methods, in particular to a full-coverage sweeping modular control method with a map, which is suitable for a sweeping robot.
Background
The existing sweeping robot cleaning scheme with map without divided modules has the following defects:
(1) the fault-tolerant rate is low, the calculation amount of a program which is not modularized is large, the coupling between program functions is high, and once errors occur, the sweeper cannot work and needs to be manually restarted.
(2) The transplantation difficulty is high, all parts related to chips in a program need to be modified for different models, and the time cost is high.
(3) The cost of function modification time is high, when a function needs to be added or deleted, the whole program needs to be modified, and the design workload is large.
Disclosure of Invention
The invention aims to provide a full-coverage sweeping modular control method with a map, which is suitable for a sweeping robot and solves the technical problem that when an existing sweeping robot has an error in a program, the robot stops in place and needs to be manually restarted. The method aims to create a set of complete modular system for sweeping the floor sweeper with a map, and the algorithm divides the whole control flow into a plurality of different modules, and the modules process the work together, so that the fault tolerance and the portability of the system are improved. When an error occurs in a single module, the operation of the machine is not influenced, and the machine can execute the original sweeping logic without map control to wait for the map module to be restarted successfully.
A map-contained full-coverage sweeping modular control method suitable for a sweeping robot comprises a motion module, a communication module and a map module, wherein the motion module is connected with the map module through the communication module, the control method comprises the steps of acquiring coordinate data of the sweeping robot in real time by using a code disc and a gyroscope, continuously receiving surrounding swept marks after the sweeping robot walks for a certain distance, starting triggering a search command by the motion module to transmit to the map module and starting to receive a path to an uncleaned grid coordinate, starting to search after receiving a search command by the map module, sending the path to the motion module after the search is finished, sending a sweeping finish mark to the motion module when the map module does not continuously search for the uncleaned grid, starting to perform wall-following operation after receiving the mark by the motion module, marking wall-following points by the map module in the wall-following process, and continuously comparing the current coordinate of the sweeping robot with the coordinate of the starting wall-following point, if the robot returns to the starting wall-following point along the wall, sending a wall-following completion command to the motion module, and simultaneously sending a path returning to the original point, wherein the motion module stops following the wall and returns to the original point along the path returning to the original point after receiving the wall-following completion command.
Further, the specific control process of the motion module is as follows:
the coordinate of the destination is obtained from the map module through the communication module, the current coordinate is obtained through the code disc and the gyroscope, the angle between the target point and the current position is calculated through a trigonometric function according to the two coordinates, then the sweeping robot is adjusted to move towards the target in a straight line mode, calculation is carried out through the pythagorean theorem, the sum of the square of the X-axis coordinate of the coordinate axis and the square of the X-axis coordinate is smaller than 2560, and the target point which is reached is judged at the same time.
Further, the specific process of the map module search is as follows:
the map module waits for receiving a search instruction, acquires a current coordinate point when receiving the search instruction, lists the current coordinate point in a search queue, dequeues the head coordinate of the search queue, then judging whether the dequeue coordinate is an uncleaned grid block or not, if so, forming a walking path according to the enqueue coordinate, then sending the path to a motion module, if the grid block is not cleaned, continuously searching whether the information of the upper, lower, left and right grids of the dequeuing coordinate is not the cleaned grid block, if one grid is not cleaned, judging whether the grid is an obstacle or not, if not, forming a walking path according to the coordinates of enqueue, and then sending the path to a motion module, and if the paths are not the uncleaned grid blocks, continuously repeating the step of searching whether the grid blocks at the periphery are uncleaned or not until the uncleaned grid blocks are found or a walk-along-the-wall instruction is entered.
Further, the concrete control process of the sweeping robot along the wall is as follows: the motion module judges whether the current mode is a wall-following walking mode or not, if not, the judgment is continued, if so, a coordinate point which starts to follow the wall is recorded, a coordinate point which is closest to a far point is recorded, then the current coordinate distance which starts to follow the wall is judged to be smaller than the radius of the machine body, if not, the walking is carried out while the judgment is carried out, when the current coordinate distance starts to follow the wall and is smaller than the radius of the machine body, a wall-following finishing command is sent to the motion module, a path which returns to the original point is sent to the motion module, and the original point.
Further, the specific process of forming the walking path is as follows:
establishing a rectangular coordinate system, and planning a linear walking route in the rectangular coordinate system, wherein the linear walking route is that the route is always parallel to an X coordinate axis or a Y coordinate axis, and the route is determined by a straight line and a path direction in the coordinate system; the sweeping robot performs sweeping walking along a planned straight walking route, and moves backwards when collision or falling occurs; after backing, planning a next straight walking route, wherein the position of the sweeping robot rotates in situ by 90 degrees and then the direction is the planned straight walking route, if collision and falling occur in the rotating process, entering a wall-following walking mode or a bow sweeping route, and if collision and falling do not occur in the rotating process; and after the steering is finished, smoothly cutting into the next line through the radius steering control robot, and executing straight walking control along the line according to the distance between the current coordinate and the next line and the orientation angle of the next line. The target running angle of the robot gradually approaches the orientation angle of the next line along with the gradual reduction of the distance between the robot and the next line, so that smooth cut-in to the next straight line can be realized, and if the robot runs off, the robot enters into the wall to run along the wall when collision or falling occurs in radius steering control; if the robot walks along the wall, the robot performs motion navigation by using a wall-following algorithm, enters a bow-sweeping line mode when collision or falling occurs during the wall-following walking, monitors a trigger change event, and enters a straight-walking mode after the trigger change event is monitored.
Further, if the line is horizontal to the X axis, the line function is y ═ b, and the orientation angle is composed of two angles of 0 ° and 180 °; if the line is horizontal to the Y axis, its line function is x ═ b, oriented both from 90 ° and-90 °.
Furthermore, the bow-sweeping line has four bow-shaped overall trends, the first bow-shaped overall trend is that each line is horizontal to the X axis and is swept along the positive direction of the Y axis, the second bow-shaped overall trend is that each line is horizontal to the X axis and is swept along the negative direction of the X axis, the third bow-shaped overall trend is that each line is horizontal to the Y axis and is swept along the positive direction of the X axis, and the fourth bow-shaped overall trend is that each line is horizontal to the X axis and is swept along the negative direction of the Y axis.
Furthermore, in the control of the pantograph-sweeping line, adjustable parameters of the line spacing LS and current coordinates (x1, y1) are set, and according to the current type of the overall trend of the pantograph, four methods for changing the line are provided, wherein if the overall trend of the first pantograph is: if y1-b > LS, then the new route is y b + LS, and the route orientation angle is reversed by 180 °, if the second bow overall trend is: if the current route is y-b, and b-y1> LS, the new route is y-b-LS, and the orientation angle of the route is reversed by 180 °, if the third bow-shaped overall trend is: if x1-b > LS, then the new route is x b + LS, and the route orientation angle is reversed by 180 °, if the fourth bow overall trend is: the current route is x-b, if b-x1> LS, the new route is x-b-LS, and the route orientation is reversed by 180 °.
Further, triggering a change event includes cutting into the next line, returning to the current line after a distance along the wall, a walk time exceeding a set value, if the current swipe direction is the positive Y-axis direction but the current machine Y coordinate is less than the initial Y coordinate minus 0.5 times the swipe pitch, if the current swipe direction is the negative Y-axis direction but the current machine Y coordinate is greater than the initial Y coordinate plus 0.5 times the swipe pitch, if the current swipe direction is the positive X-axis direction but the current machine X coordinate is less than the initial X coordinate minus 0.5 times the swipe pitch, and if the current swipe direction is the negative X-axis direction but the current machine X coordinate is greater than the initial X coordinate plus 0.5 times the swipe pitch, wherein the set value is 20 seconds.
Further, when the sweep line enters the straight walking mode, the straight walking control process along the line is that firstly, the offset distance between the sweep line and the target line is calculated according to the trend type of the current line and the current coordinates (x1, y1), and if the current trend is the overall trend of the first type of arch form or the overall trend of the second type of arch form: b is the current route, and if the orientation of the current route is 0 degrees, the distance d from the current position to the target route is y 1-b; if the current line orientation is 180 degrees, the distance d between the current position and the target line is b-y 1; if the current trend is a third overall trend or a fourth overall trend: b is the current route, and if the current route is oriented to 90 degrees, the distance d from the current position to the target route is b-x 1; if the current line orientation is-90 degrees, the distance d between the current position and the target line is x 1-b; if d is larger than 0, it represents that the current position deviates to the left relative to the orientation direction of the target line, and the right correction is needed, otherwise, the left correction is needed; the specific process of correction is as follows: calculating a correction angle a according to d: if d is more than LS, a is 90, if d is less than LS, a is-90, otherwise, a is d/LS multiplied by 90, the current target operation angle A is the current line angle-a, a deviation value Delta S of the current angle and the target operation angle is obtained according to a gyroscope, a difference COF of the duty ratio between two wheels is calculated according to an angle PID, and the expression of the angle PID is as follows:
COF=Kp×ΔSn+Ki×∑ΔS+Kd×(ΔSn-ΔSn-1)
and respectively calculating and setting the duty ratio of two wheels according to the duty ratio difference COF and the maximum duty ratio value, and driving the machine to move.
By adopting the technical scheme, the invention has the following technical effects:
according to the invention, the operation of the modules is not influenced mutually, when an error occurs in the upper layer module, the work of the motion module is not influenced, the machine can still normally work in a map-free mode, the transportability is high, when transplanting operation is carried out among different machine types, only the configuration of chip pins in the motion module needs to be modified, the cost of function time is low, only the communication module needs to be modified according to the function addition module, different environments can be adapted in cleaning, the coverage efficiency and the coverage rate are far higher than those of a random collision mode, the collision of the machine with walls and furniture is greatly reduced in a route navigation mode, and the damage to the environment and the product is reduced.
Drawings
FIG. 1 is a flow chart of a control method of the present invention.
FIG. 2 is a flow chart of a map module search according to the present invention.
FIG. 3 is a flow chart of a communication module control according to the present invention.
FIG. 4 is a flow chart of the navigation of the target point by the motion module according to the present invention.
FIG. 5 is a flowchart of the wall-following control of the present invention.
Detailed Description
In order to make the objects, technical solutions and advantages of the present invention more apparent, preferred embodiments are given and the present invention is described in further detail. It should be noted, however, that the numerous details set forth in the description are merely for the purpose of providing the reader with a thorough understanding of one or more aspects of the present invention, which may be practiced without these specific details.
A map-contained full-coverage sweeping modular control method suitable for a sweeping robot is disclosed, as shown in figure 1, a system for realizing the control method comprises a motion module, a communication module and a map module, wherein the motion module is connected with the map module through the communication module, the control method comprises the steps of using a code disc and a gyroscope to obtain coordinate data of the sweeping robot in real time, the sweeping robot walks for a certain distance and continuously receives a surrounding swept mark, the motion module starts to trigger a search command to be transmitted to the map module and starts to receive a path to an uncleaned grid coordinate, the map module starts to search after receiving the search command, the path is transmitted to the motion module after the search is finished, the map module issues a sweeping finish mark to the motion module when the uncleaned grid is not continuously searched by the map module, and the motion module starts to operate along a wall after receiving the mark, the map module marks a point beginning to follow the wall in the wall following process, continuously compares the current coordinate of the sweeping robot with the coordinate of the point beginning to follow the wall, sends a wall following completion command to the motion module if the robot returns to the point beginning to follow the wall along the wall, and simultaneously sends a path returning to the original point, and the motion module stops following the wall and returns to the original point along the path returning to the original point after receiving the wall following completion command.
The method aims to create a set of complete modular system for sweeping the floor sweeper with a map, and the algorithm divides the whole control flow into a plurality of different modules, and the modules process the work together, so that the fault tolerance and the portability of the system are improved. The operation of the machine is not influenced when a single module has an error, and the machine can execute the original cleaning logic without map control to wait for the map module to be restarted successfully so as to solve the problem that the robot needs to be manually restarted when stopping in place when a program has an error. In addition, the system is convenient to transplant after modularization, and different machine types only need to modify the control part of the machine in the motion module.
The algorithm continuously calculates the machine coordinate in the moving process through the motion module, transmits the machine coordinate to the map module through the communication module, and the map module sends out a specific motion instruction to the motion module according to map information, so that the cooperative work among the modules is completed.
As shown in fig. 4, the specific control process of the motion module is as follows:
the coordinate of the destination is obtained from the map module through the communication module, the current coordinate is obtained through the code disc and the gyroscope, the angle between the target point and the current position is calculated through a trigonometric function according to the two coordinates, then the sweeping robot is adjusted to move towards the target in a straight line mode, calculation is carried out through the pythagorean theorem, the sum of the square of the X-axis coordinate of the coordinate axis and the square of the X-axis coordinate is smaller than 2560, and the target point which is reached is judged at the same time. When the map module sends the walking path to the motion module, the total number of coordinate points in the path to be sent is the number of coordinates to be sent, except the coordinates X and Y of the target point. In order to ensure that the motion module can correctly receive each coordinate point, the current receiving number sent by the motion module is firstly received before sending, and the next coordinate point is continuously sent when the receiving number is judged to be larger than the current transmission number.
As shown in fig. 3, the work flow of the communication module, since there is more than one module communicating with the communication module, each module must carry its own module ID when transmitting information for distinction. The communication type is divided into data receiving and transmitting, the request type is carried when the information is transmitted, when the request type is 1, the communication module transmits the information to the requesting module, and when the request type is 0, the communication module prepares to receive the information.
As shown in fig. 5, the concrete control process of the sweeping robot along the wall is as follows: the motion module judges whether the current mode is a wall-following walking mode or not, if not, the judgment is continued, if so, a coordinate point which starts to follow the wall is recorded, a coordinate point which is closest to a far point is recorded, then the current coordinate distance which starts to follow the wall is judged to be smaller than the radius of the machine body, if not, the walking is carried out while the judgment is carried out, when the current coordinate distance starts to follow the wall and is smaller than the radius of the machine body, a wall-following finishing command is sent to the motion module, a path which returns to the original point is sent to the motion module, and the original point.
As shown in fig. 2, the specific process of the map module search is as follows:
the map module waits for receiving a search instruction, acquires a current coordinate point when receiving the search instruction, lists the current coordinate point in a search queue, dequeues the head coordinate of the search queue, then judging whether the dequeue coordinate is an uncleaned grid block or not, if so, forming a walking path according to the enqueue coordinate, then sending the path to a motion module, if the grid block is not cleaned, continuously searching whether the information of the upper, lower, left and right grids of the dequeuing coordinate is not the cleaned grid block, if one grid is not cleaned, judging whether the grid is an obstacle or not, if not, forming a walking path according to the coordinates of enqueue, and then sending the path to a motion module, and if the paths are not the uncleaned grid blocks, continuously repeating the step of searching whether the grid blocks at the periphery are uncleaned or not until the uncleaned grid blocks are found or a walk-along-the-wall instruction is entered.
The process of forming the walking path is as follows: establishing a rectangular coordinate system, and planning a linear walking route in the rectangular coordinate system, wherein the linear walking route is that the route is always parallel to an X coordinate axis or a Y coordinate axis, and the route is determined by a straight line and a path direction in the coordinate system; the sweeping robot performs sweeping walking along a planned straight walking route, and moves backwards when collision or falling occurs; after backing, planning a next straight walking route, wherein the position of the sweeping robot rotates in situ by 90 degrees and then the direction is the planned straight walking route, if collision and falling occur in the rotating process, entering a wall-following walking mode or a bow sweeping route, and if collision and falling do not occur in the rotating process; and after the steering is finished, smoothly cutting into the next line through the radius steering control robot, and executing straight walking control along the line according to the distance between the current coordinate and the next line and the orientation angle of the next line. The target running angle of the robot gradually approaches the orientation angle of the next line along with the gradual reduction of the distance between the robot and the next line, so that smooth cut-in to the next straight line can be realized, and if the robot runs off, the robot enters into the wall to run along the wall when collision or falling occurs in radius steering control; if the robot walks along the wall, the robot performs motion navigation by using a wall-following algorithm, enters a bow-sweeping line mode when collision or falling occurs during the wall-following walking, monitors a trigger change event, and enters a straight-walking mode after the trigger change event is monitored.
If the line is horizontal to the X axis, the line function is y ═ b, and the orientation angle is formed by 0 degrees and 180 degrees; if the line is horizontal to the Y axis, its line function is x ═ b, oriented both from 90 ° and-90 °.
The bow-sweeping line has four kinds of bow-shaped overall tendency, the first kind of bow-shaped overall tendency is that each line is horizontal to the X axis and is swept along the positive direction of the Y axis, the second kind of bow-shaped overall tendency is that each line is horizontal to the X axis and is swept along the negative direction of the X axis, the third kind of bow-shaped overall tendency is that each line is horizontal to the Y axis and is swept along the positive direction of the X axis, and the fourth kind of bow-shaped overall tendency is that each line is horizontal to the X axis and is swept along the negative direction of the Y axis.
In the control of the arched scanning line, adjustable parameters of a line spacing LS and current coordinates (x1, y1) are set, four methods for changing the line are provided according to the current arched trend type, and if the line is the first arched overall trend: if y1-b > LS, then the new route is y b + LS, and the route orientation angle is reversed by 180 °, if the second bow overall trend is: if b-y1> LS, then the new route is y-b-LS, and the route orientation angle is reversed by 180 °, if the third bow overall trend is: if x1-b > LS, then the new route is x b + LS, and the route orientation angle is reversed by 180 °, if the fourth bow overall trend is: the current route is x-b, if b-x1> LS, the new route is x-b-LS, and the route orientation is reversed by 180 °.
Triggering a change event includes cutting into the next line, returning to the current line after a distance along the wall, a walk time exceeding a set value, if the current swipe direction is the positive Y-axis direction, but the current machine Y coordinate is less than the initial Y coordinate minus 0.5 times the swipe pitch, if the current swipe direction is the negative Y-axis direction, but the current machine Y coordinate is greater than the initial Y coordinate plus 0.5 times the swipe pitch, if the current swipe direction is the positive X-axis direction, but the current machine X coordinate is less than the initial X coordinate minus 0.5 times the swipe pitch, and if the current swipe direction is the negative X-axis direction, but the current machine X coordinate is greater than the initial X coordinate plus 0.5 times the swipe pitch, where the set value is 20 seconds.
When the sweep line enters the straight walking mode, the straight walking control process along the line is that firstly, the offset distance between the sweep line and the target line is calculated according to the trend type of the current line and the current coordinates (x1, y1), and if the current trend is the overall trend of the first type of the bow-shaped or the overall trend of the second type of the bow-shaped: b is the current route, and if the orientation of the current route is 0 degrees, the distance d from the current position to the target route is y 1-b; if the current line orientation is 180 degrees, the distance d between the current position and the target line is b-y 1; if the current trend is a third overall trend or a fourth overall trend: b is the current route, and if the current route is oriented to 90 degrees, the distance d from the current position to the target route is b-x 1; if the current line orientation is-90 degrees, the distance d between the current position and the target line is x 1-b; if d is larger than 0, it represents that the current position deviates to the left relative to the orientation direction of the target line, and the right correction is needed, otherwise, the left correction is needed; the specific process of correction is as follows: calculating a correction angle a according to d: if d is more than LS, a is 90, if d is less than LS, a is-90, otherwise, a is d/LS multiplied by 90, the current target operation angle A is the current line angle-a, a deviation value Delta S of the current angle and the target operation angle is obtained according to a gyroscope, a difference COF of the duty ratio between two wheels is calculated according to an angle PID, and the expression of the angle PID is as follows:
COF=Kp×ΔSn+Ki×∑ΔS+Kd×(ΔSn-ΔSn-1)
and respectively calculating and setting the duty ratio of two wheels according to the duty ratio difference COF and the maximum duty ratio value, and driving the machine to move.
The foregoing is only a preferred embodiment of the present invention, and it should be noted that those skilled in the art can make various improvements and modifications without departing from the principle of the present invention, and these improvements and modifications should also be construed as the protection scope of the present invention.
Claims (10)
1. A modular control method for full-coverage sweeping with a map, which is suitable for a sweeping robot, is characterized in that: the system for realizing the control method comprises a motion module, a communication module and a map module, wherein the motion module is connected with the map module through the communication module, the control method comprises the steps of acquiring coordinate data of the sweeping robot in real time by using a code disc and a gyroscope, the sweeping robot walks for a certain distance and continuously receives a mark which is swept around, the motion module starts to trigger a search command to be transmitted to the map module and starts to wait for receiving a path to an uncleaned grid coordinate, the map module starts to search after receiving the search command, sends the path to the motion module after completing the search, sends a sweep completion mark to the motion module when the map module does not continuously search the uncleaned grid, the motion module starts to perform wall-following operation after receiving the mark, marks a point which starts to follow the wall in the wall-following process by the map module, and continuously compares the current coordinate of the sweeping robot with the coordinate of the point which starts to follow the, if the machine returns to the point of starting to follow the wall along the wall, a command of finishing along the wall is sent to the motion module, meanwhile, a path of returning to the original point is sent, and the motion module stops following the wall when receiving the command of finishing along the wall and returns to the original point along the path of returning to the original point.
2. The modular control method for full-coverage sweeping with a map suitable for the sweeping robot as claimed in claim 1, wherein the modular control method comprises the following steps: the specific control process of the motion module is as follows:
the coordinate of the destination is obtained from the map module through the communication module, the current coordinate is obtained through the code disc and the gyroscope, the angle between the target point and the current position is calculated through a trigonometric function according to the two coordinates, then the sweeping robot is adjusted to move towards the target in a straight line mode, calculation is carried out through the pythagorean theorem, the sum of the square of the X-axis coordinate of the coordinate axis and the square of the X-axis coordinate is smaller than 2560, and the target point which is reached is judged at the same time.
3. The modular control method for full-coverage sweeping suitable for the sweeping robot with the map as claimed in claim 2, characterized in that: the specific process of the map module search is as follows:
the map module waits for receiving a search instruction, acquires a current coordinate point when receiving the search instruction, lists the current coordinate point in a search queue, dequeues the head coordinate of the search queue, then judging whether the dequeue coordinate is an uncleaned grid block or not, if so, forming a walking path according to the enqueue coordinate, then sending the path to a motion module, if the grid block is not cleaned, continuously searching whether the information of the upper, lower, left and right grids of the dequeuing coordinate is not the cleaned grid block, if one grid is not cleaned, judging whether the grid is an obstacle or not, if not, forming a walking path according to the coordinates of enqueue, and then sending the path to a motion module, and if the paths are not the uncleaned grid blocks, continuously repeating the step of searching whether the grid blocks at the periphery are uncleaned or not until the uncleaned grid blocks are found or a walk-along-the-wall instruction is entered.
4. The modular control method for full-coverage sweeping suitable for the sweeping robot with the map as claimed in claim 3, is characterized in that: the concrete control process of the sweeping robot along the wall is as follows: the motion module judges whether the current mode is a wall-following walking mode or not, if not, the judgment is continued, if so, a coordinate point which starts to follow the wall is recorded, a coordinate point which is closest to a far point is recorded, then the current coordinate distance which starts to follow the wall is judged to be smaller than the radius of the machine body, if not, the walking is carried out while the judgment is carried out, when the current coordinate distance starts to follow the wall and is smaller than the radius of the machine body, a wall-following finishing command is sent to the motion module, a path which returns to the original point is sent to the motion module, and the original point.
5. The modular control method for full-coverage sweeping suitable for the sweeping robot with the map as claimed in claim 3, is characterized in that: the specific process of forming the walking path is as follows:
establishing a rectangular coordinate system, and planning a linear walking route in the rectangular coordinate system, wherein the linear walking route is that the route is always parallel to an X coordinate axis or a Y coordinate axis, and the route is determined by a straight line and a path direction in the coordinate system; the sweeping robot performs sweeping walking along a planned straight walking route, and moves backwards when collision or falling occurs; after backing, planning a next straight walking route, wherein the position of the sweeping robot rotates in situ by 90 degrees and then the direction is the planned straight walking route, if collision and falling occur in the rotating process, entering a wall-following walking mode or a bow sweeping route, and if collision and falling do not occur in the rotating process; and after the steering is finished, smoothly cutting into the next line through the radius steering control robot, and executing straight walking control along the line according to the distance between the current coordinate and the next line and the orientation angle of the next line. The target running angle of the robot gradually approaches the orientation angle of the next line along with the gradual reduction of the distance between the robot and the next line, so that smooth cut-in to the next straight line can be realized, and if the robot runs off, the robot enters into the wall to run along the wall when collision or falling occurs in radius steering control; if the robot walks along the wall, the robot performs motion navigation by using a wall-following algorithm, enters a bow-sweeping line mode when collision or falling occurs during the wall-following walking, monitors a trigger change event, and enters a straight-walking mode after the trigger change event is monitored.
6. The modular control method for full-coverage sweeping suitable for the sweeping robot with the map as claimed in claim 5, is characterized in that: if the line is horizontal to the X axis, the line function is y ═ b, and the orientation angle is formed by 0 degrees and 180 degrees; if the line is horizontal to the Y axis, its line function is x ═ b, oriented both from 90 ° and-90 °.
7. The modular control method for full-coverage sweeping suitable for the sweeping robot with the map as claimed in claim 5, is characterized in that: the bow-sweeping line has four kinds of bow-shaped overall tendency, the first kind of bow-shaped overall tendency is that each line is horizontal to the X axis and is swept along the positive direction of the Y axis, the second kind of bow-shaped overall tendency is that each line is horizontal to the X axis and is swept along the negative direction of the X axis, the third kind of bow-shaped overall tendency is that each line is horizontal to the Y axis and is swept along the positive direction of the X axis, and the fourth kind of bow-shaped overall tendency is that each line is horizontal to the X axis and is swept along the negative direction of the Y axis.
8. The modular control method for full-coverage sweeping suitable for the sweeping robot with the map as claimed in claim 5, is characterized in that: in the control of the arched scanning line, adjustable parameters of a line spacing LS and current coordinates (x1, y1) are set, four methods for changing the line are provided according to the current arched trend type, and if the line is the first arched overall trend: if y1-b > LS, then the new route is y b + LS, and the route orientation angle is reversed by 180 °, if the second bow overall trend is: if the current route is y-b, and b-y1> LS, the new route is y-b-LS, and the orientation angle of the route is reversed by 180 °, if the third bow-shaped overall trend is: if x1-b > LS, then the new route is x b + LS, and the route orientation angle is reversed by 180 °, if the fourth bow overall trend is: the current route is x-b, if b-x1> LS, the new route is x-b-LS, and the route orientation is reversed by 180 °.
9. The modular control method for full-coverage sweeping suitable for the sweeping robot with the map as claimed in claim 5, is characterized in that: triggering a change event includes cutting into the next line, returning to the current line after a distance along the wall, a walk time exceeding a set value, if the current swipe direction is the positive Y-axis direction, but the current machine Y coordinate is less than the initial Y coordinate minus 0.5 times the swipe pitch, if the current swipe direction is the negative Y-axis direction, but the current machine Y coordinate is greater than the initial Y coordinate plus 0.5 times the swipe pitch, if the current swipe direction is the positive X-axis direction, but the current machine X coordinate is less than the initial X coordinate minus 0.5 times the swipe pitch, and if the current swipe direction is the negative X-axis direction, but the current machine X coordinate is greater than the initial X coordinate plus 0.5 times the swipe pitch, where the set value is 20 seconds.
10. The modular control method for full-coverage sweeping suitable for the sweeping robot with the map as claimed in claim 5, is characterized in that: when the sweep line enters the straight walking mode, the straight walking control process along the line is that firstly, the offset distance between the sweep line and the target line is calculated according to the trend type of the current line and the current coordinates (x1, y1), and if the current trend is the overall trend of the first type of the bow-shaped or the overall trend of the second type of the bow-shaped: b is the current route, and if the orientation of the current route is 0 degrees, the distance d from the current position to the target route is y 1-b; if the current line orientation is 180 degrees, the distance d between the current position and the target line is b-y 1; if the current trend is a third overall trend or a fourth overall trend: b is the current route, and if the current route is oriented to 90 degrees, the distance d from the current position to the target route is b-x 1; if the current line orientation is-90 degrees, the distance d between the current position and the target line is x 1-b; if d is larger than 0, it represents that the current position deviates to the left relative to the orientation direction of the target line, and the right correction is needed, otherwise, the left correction is needed; the specific process of correction is as follows: calculating a correction angle a according to d: if d is greater than LS, a is 90, if d < -LS, a is-90, otherwise, a is d/LS multiplied by 90, the current target operation angle A is the current line angle-a, a deviation value Delta S of the current angle and the target operation angle is obtained according to a gyroscope, a difference COF of the duty ratio between two wheels is calculated according to an angle PID, and the expression of the angle PID is as follows:
COF=Kp×ΔSn+Ki×∑ΔS+Kd×(ΔSn-ΔSn-1)
and respectively calculating and setting the duty ratio of two wheels according to the duty ratio difference COF and the maximum duty ratio value, and driving the machine to move.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011045425.6A CN112198876B (en) | 2020-09-28 | 2020-09-28 | Map full-coverage sweeping modular control method suitable for sweeping robot |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011045425.6A CN112198876B (en) | 2020-09-28 | 2020-09-28 | Map full-coverage sweeping modular control method suitable for sweeping robot |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112198876A true CN112198876A (en) | 2021-01-08 |
CN112198876B CN112198876B (en) | 2023-10-03 |
Family
ID=74007817
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011045425.6A Active CN112198876B (en) | 2020-09-28 | 2020-09-28 | Map full-coverage sweeping modular control method suitable for sweeping robot |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112198876B (en) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113100669A (en) * | 2021-04-08 | 2021-07-13 | 云鲸智能(深圳)有限公司 | Cleaning robot, method of controlling the same, and computer-readable storage medium |
CN114593696A (en) * | 2022-01-27 | 2022-06-07 | 深圳市无限动力发展有限公司 | Sweeping coverage rate measuring method, device, equipment and medium |
CN115444325A (en) * | 2022-07-21 | 2022-12-09 | 深圳银星智能集团股份有限公司 | Secondary cleaning method, device, cleaning robot and storage medium |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2013152675A1 (en) * | 2012-04-13 | 2013-10-17 | 科沃斯机器人科技(苏州)有限公司 | Self-moving ground treatment robot and cleaning work control method thereof |
CN106970623A (en) * | 2017-04-18 | 2017-07-21 | 杭州匠龙机器人科技有限公司 | Intelligent cleaning device and its trellis paths operational method |
CN107368079A (en) * | 2017-08-31 | 2017-11-21 | 珠海市微半导体有限公司 | Robot cleans the planing method and chip in path |
CN107390698A (en) * | 2017-08-31 | 2017-11-24 | 珠海市微半导体有限公司 | The benefit of sweeping robot sweeps method and chip |
CN108354524A (en) * | 2017-01-26 | 2018-08-03 | 好样科技有限公司 | Automatic cleaning machine and control method thereof |
CN109298717A (en) * | 2018-11-24 | 2019-02-01 | 珠海市微半导体有限公司 | The cleaning method and chip and Intelligent cleaning robot of intelligent robot |
CN109582015A (en) * | 2018-11-07 | 2019-04-05 | 深圳乐动机器人有限公司 | A kind of method, apparatus and robot of interior cleaning planning |
WO2019144867A1 (en) * | 2018-01-26 | 2019-08-01 | 广东宝乐机器人股份有限公司 | Method for improving corner coverage rate of moving robot |
WO2019206133A1 (en) * | 2018-04-25 | 2019-10-31 | 科沃斯机器人股份有限公司 | Cleaning robot and method for traveling along edge, and readable medium |
-
2020
- 2020-09-28 CN CN202011045425.6A patent/CN112198876B/en active Active
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2013152675A1 (en) * | 2012-04-13 | 2013-10-17 | 科沃斯机器人科技(苏州)有限公司 | Self-moving ground treatment robot and cleaning work control method thereof |
CN108354524A (en) * | 2017-01-26 | 2018-08-03 | 好样科技有限公司 | Automatic cleaning machine and control method thereof |
CN106970623A (en) * | 2017-04-18 | 2017-07-21 | 杭州匠龙机器人科技有限公司 | Intelligent cleaning device and its trellis paths operational method |
CN107368079A (en) * | 2017-08-31 | 2017-11-21 | 珠海市微半导体有限公司 | Robot cleans the planing method and chip in path |
CN107390698A (en) * | 2017-08-31 | 2017-11-24 | 珠海市微半导体有限公司 | The benefit of sweeping robot sweeps method and chip |
WO2019144867A1 (en) * | 2018-01-26 | 2019-08-01 | 广东宝乐机器人股份有限公司 | Method for improving corner coverage rate of moving robot |
WO2019206133A1 (en) * | 2018-04-25 | 2019-10-31 | 科沃斯机器人股份有限公司 | Cleaning robot and method for traveling along edge, and readable medium |
CN109582015A (en) * | 2018-11-07 | 2019-04-05 | 深圳乐动机器人有限公司 | A kind of method, apparatus and robot of interior cleaning planning |
CN109298717A (en) * | 2018-11-24 | 2019-02-01 | 珠海市微半导体有限公司 | The cleaning method and chip and Intelligent cleaning robot of intelligent robot |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113100669A (en) * | 2021-04-08 | 2021-07-13 | 云鲸智能(深圳)有限公司 | Cleaning robot, method of controlling the same, and computer-readable storage medium |
CN114593696A (en) * | 2022-01-27 | 2022-06-07 | 深圳市无限动力发展有限公司 | Sweeping coverage rate measuring method, device, equipment and medium |
CN115444325A (en) * | 2022-07-21 | 2022-12-09 | 深圳银星智能集团股份有限公司 | Secondary cleaning method, device, cleaning robot and storage medium |
Also Published As
Publication number | Publication date |
---|---|
CN112198876B (en) | 2023-10-03 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN112198876A (en) | Map-contained full-coverage sweeping modular control method suitable for sweeping robot | |
CN108286949B (en) | Movable three-dimensional detection robot system | |
CN107992054A (en) | A kind of method and system of the positioning of robot | |
CN109978272B (en) | Path planning system and method based on multiple omnidirectional mobile robots | |
CN110554699A (en) | Robot control system and control method | |
CN104062902A (en) | Delta robot time optimal trajectory planning method | |
US20220063099A1 (en) | Framework of robotic online motion planning | |
CN109557929B (en) | The motion control method and device of mobile robot | |
CN105183009A (en) | Trajectory control method for redundant mechanical arm | |
CN113534816B (en) | Mobile robot navigation tracking method | |
CN111915106B (en) | Path generation method and device, crystal face machine and storage medium | |
CN113282083B (en) | Unmanned vehicle formation experiment platform based on robot operating system | |
CN113739802B (en) | Unmanned bulldozer path planning method, system, storage medium and equipment | |
CN108189034A (en) | A kind of robot continuous path implementation method | |
Clark et al. | Dynamic networks for motion planning in multi-robot space systems | |
CN114055467B (en) | Space pose online simulation system based on five-degree-of-freedom robot | |
CN111759241B (en) | Sweeping path planning and navigation control method for sweeping robot | |
CN112814341B (en) | Cooperative control-based building construction brick laying robot system and control method | |
CN117655468A (en) | Portal frame arc welding robot path planning method and system | |
CN115805503A (en) | Automatic grinding decision planning device and method for intelligent grinding robot | |
CN115284293A (en) | Space station mechanical arm multi-mode path planning system and method suitable for complex tasks | |
CN114527764A (en) | Path walking method, system and terminal equipment | |
Xu et al. | Research on motion trajector planning of industrial robot based on ROS | |
US20230109223A1 (en) | Intelligent clear path | |
CN113219974A (en) | Automatic navigation robot multi-machine obstacle avoidance method, system, medium and 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 |