WO2015158240A1 - Obstacle avoidance walking method of self-moving robot - Google Patents

Obstacle avoidance walking method of self-moving robot Download PDF

Info

Publication number
WO2015158240A1
WO2015158240A1 PCT/CN2015/076510 CN2015076510W WO2015158240A1 WO 2015158240 A1 WO2015158240 A1 WO 2015158240A1 CN 2015076510 W CN2015076510 W CN 2015076510W WO 2015158240 A1 WO2015158240 A1 WO 2015158240A1
Authority
WO
WIPO (PCT)
Prior art keywords
point
obstacle
axis
walking
self
Prior art date
Application number
PCT/CN2015/076510
Other languages
French (fr)
Chinese (zh)
Inventor
汤进举
Original Assignee
科沃斯机器人有限公司
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by 科沃斯机器人有限公司 filed Critical 科沃斯机器人有限公司
Priority to US15/304,039 priority Critical patent/US10248126B2/en
Priority to EP15779458.7A priority patent/EP3133457B1/en
Priority to JP2016562594A priority patent/JP6622215B2/en
Priority to KR1020167031679A priority patent/KR102329060B1/en
Publication of WO2015158240A1 publication Critical patent/WO2015158240A1/en
Priority to US16/275,216 priority patent/US11112800B2/en
Priority to US17/393,082 priority patent/US11768496B2/en

Links

Images

Classifications

    • AHUMAN NECESSITIES
    • A47FURNITURE; DOMESTIC ARTICLES OR APPLIANCES; COFFEE MILLS; SPICE MILLS; SUCTION CLEANERS IN GENERAL
    • A47LDOMESTIC WASHING OR CLEANING; SUCTION CLEANERS IN GENERAL
    • A47L9/00Details or accessories of suction cleaners, e.g. mechanical means for controlling the suction or for effecting pulsating action; Storing devices specially adapted to suction cleaners or parts thereof; Carrying-vehicles specially adapted for suction cleaners
    • A47L9/28Installation of the electric equipment, e.g. adaptation or attachment to the suction cleaner; Controlling suction cleaners by electric means
    • A47L9/2836Installation of the electric equipment, e.g. adaptation or attachment to the suction cleaner; Controlling suction cleaners by electric means characterised by the parts which are controlled
    • A47L9/2852Elements for displacement of the vacuum cleaner or the accessories therefor, e.g. wheels, casters or nozzles
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1656Programme controls characterised by programming, planning systems for manipulators
    • B25J9/1664Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
    • B25J9/1666Avoiding collision or forbidden zones
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0219Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory ensuring the processing of the whole working surface
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0214Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory in accordance with safety or protection criteria, e.g. avoiding hazardous areas
    • AHUMAN NECESSITIES
    • A47FURNITURE; DOMESTIC ARTICLES OR APPLIANCES; COFFEE MILLS; SPICE MILLS; SUCTION CLEANERS IN GENERAL
    • A47LDOMESTIC WASHING OR CLEANING; SUCTION CLEANERS IN GENERAL
    • A47L11/00Machines for cleaning floors, carpets, furniture, walls, or wall coverings
    • A47L11/24Floor-sweeping machines, motor-driven
    • AHUMAN NECESSITIES
    • A47FURNITURE; DOMESTIC ARTICLES OR APPLIANCES; COFFEE MILLS; SPICE MILLS; SUCTION CLEANERS IN GENERAL
    • A47LDOMESTIC WASHING OR CLEANING; SUCTION CLEANERS IN GENERAL
    • A47L11/00Machines for cleaning floors, carpets, furniture, walls, or wall coverings
    • A47L11/40Parts 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/4011Regulation of the cleaning machine by electric means; Control systems and remote control systems therefor
    • AHUMAN NECESSITIES
    • A47FURNITURE; DOMESTIC ARTICLES OR APPLIANCES; COFFEE MILLS; SPICE MILLS; SUCTION CLEANERS IN GENERAL
    • A47LDOMESTIC WASHING OR CLEANING; SUCTION CLEANERS IN GENERAL
    • A47L11/00Machines for cleaning floors, carpets, furniture, walls, or wall coverings
    • A47L11/40Parts 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/4061Steering means; Means for avoiding obstacles; Details related to the place where the driver is accommodated
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J11/00Manipulators not otherwise provided for
    • B25J11/008Manipulators for service tasks
    • B25J11/0085Cleaning
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/0003Home robots, i.e. small robots for domestic use
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1674Programme controls characterised by safety, monitoring, diagnostic
    • B25J9/1676Avoiding collision or forbidden zones
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/02Control of position or course in two dimensions
    • AHUMAN NECESSITIES
    • A47FURNITURE; DOMESTIC ARTICLES OR APPLIANCES; COFFEE MILLS; SPICE MILLS; SUCTION CLEANERS IN GENERAL
    • A47LDOMESTIC WASHING OR CLEANING; SUCTION CLEANERS IN GENERAL
    • A47L2201/00Robotic cleaning machines, i.e. with automatic control of the travelling movement or the cleaning operation
    • A47L2201/04Automatic control of the travelling movement; Automatic obstacle detection
    • YGENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y10TECHNICAL SUBJECTS COVERED BY FORMER USPC
    • Y10STECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y10S901/00Robots
    • Y10S901/01Mobile robot

Definitions

  • the invention relates to a self-moving robot obstacle avoiding walking method, belonging to the technical field of small household appliance manufacturing.
  • FIG. 1 is a schematic diagram of an existing self-moving robot for obstacle avoidance walking. As shown in FIG. 1, if the movement direction of the self-moving robot is divided into the movement in the horizontal direction (X-axis) and the vertical direction (Y-axis), FIG.
  • FIG. 1 shows the self-moving robot scanning along the X-axis direction, in Y.
  • the self-moving robots travel along the reciprocating paths of Y1, Y2, and Y3, respectively, and when encountering the obstacle A4, bypass the obstacle and reciprocate in the vertical direction, encountering an obstacle each time in the vertical direction. After A4, the bypass action is performed.
  • the walking mode of the existing self-moving robot leads to the path on the right side of the obstacle A4, which is repeatedly repeated many times. This large number of repeated walking greatly prolongs the walking time of the robot and seriously affects the working efficiency.
  • the technical problem to be solved by the present invention lies in the deficiencies of the prior art, and provides a self-moving robot obstacle avoiding walking method, which has a clear judgment on the position of the obstacle, a simple walking route, and greatly improves the working efficiency of the self-mobile robot.
  • a self-moving robot obstacle avoiding walking method in which the horizontal direction is the X axis and the vertical direction is the Y axis to establish a plane rectangular coordinate system in the walking area of the self-moving robot, the method specifically includes the following steps:
  • Step 100 The mobile robot walks along the Y axis.
  • the obstacle point is the upward obstacle point, and the effective uplink obstacle point is the uplink recording point;
  • the obstacle point is the downward obstacle point, and the effective downlink obstacle point is the downlink recording point;
  • Step 200 Divide the uplink record point and the downlink record point into the current uplink record point and the previous uplink record point, the current downlink record point, and the previous downlink record point according to the stored sequence;
  • Step 300 If the current obstacle point is an uplink obstacle point, determine whether the current uplink obstacle point exists before Recording a point in a previous uplink, and the coordinate of the preceding uplink recording point on the Y axis is smaller than the coordinate of the current uplink obstacle point on the Y axis; if the current obstacle point is a downward obstacle point, determining the current downlink obstacle Whether there is a previous downlink recording point before the point, and the coordinate of the previous downlink recording point on the Y axis is greater than the coordinate of the current downlink obstacle point on the Y axis;
  • Step 400 If the determination result is yes, the previous uplink recording point or the previous downward recording point is a turning point, and the mobile robot walks along the X axis toward the turning point in the obstacle point to the X-axis coordinate of the turning point. Deleting the turning point coordinates, performing the traversal walking of the area between the current obstacle point, and returning to step 100; if the judgment result is no, the self-moving robot moves a displacement amount M1 along the X axis;
  • Step 500 The mobile robot moves in the reverse direction of the original Y-axis walking direction, and returns to step 100;
  • Step 600 Cycle step 100 to step 500 until the traversal walking of the walking area is completed.
  • the uplink obstacle point and the downlink obstacle point may be partially stored or may be stored in the whole. Specifically, when the part is stored, the step 100 specifically includes:
  • the upside obstacle point is a valid up obstacle point; if the current downhole obstacle point and any previous down record point Y coordinate are not The same, the downside obstacle point is a valid downside obstacle point.
  • the step 100 specifically includes: any uplink obstacle points are effective uplink obstacle points; and any downlink obstacle points are effective downlink obstacle points.
  • the step 400 specifically includes: if the judgment result is yes, compare the difference between the X-axis coordinate of the uplink record point or the downlink record point satisfying the judgment condition and the X-axis coordinate of the obstacle point, and use the difference record with the largest difference.
  • the point or down record point is the foldback point.
  • the step 400 specifically includes: if the determination result is yes, delete all the uplink record points or the downlink record point coordinates that satisfy the judgment condition.
  • the step 400 specifically includes: if the obstacle is detected again after the mobile robot has not reached the X-axis coordinate of the turning point, the folding point coordinates are deleted and the process proceeds to step 500.
  • the walking manner in which the robot performs the traversal walking from the turning point to the current obstacle point is the same as the walking manner in the step 600 in which the traversing walking of the walking area is completed.
  • the method further includes a step 410: determining whether the self-moving robot can walk along the original Y-axis walking direction. If the determination result is yes, the self-moving robot walks along the original Y-axis walking direction, and returns to step 100; Otherwise, proceed to step 500.
  • the step 410 determines whether the specific content of the mobile robot can walk along the original Y-axis walking direction is:
  • the mobile robot first walks along the original Y-axis walking direction. If no obstacle is detected after walking for a distance, then It is judged that the self-moving robot can walk along the original Y-axis walking direction; otherwise, it is judged that the self-moving robot cannot walk along the original Y-axis traveling direction.
  • the side view sensor is provided on the side of the mobile robot.
  • the step 410 determines whether the self-moving robot can walk along the original Y-axis travel direction: the self-mobile robot judges whether it can be along the original Y according to the feedback signal of the side-view sensor.
  • the axis travels in the direction of walking.
  • the invention also provides a self-moving robot obstacle avoiding walking method, in which the horizontal direction is the X axis and the vertical direction is the Y axis to establish a plane rectangular coordinate system in the walking region of the self-moving robot, and along the X axis or The direction of the Y axis is walking in the forward direction;
  • the method specifically includes the following steps:
  • Step 1000 The mobile robot walks along the Y axis.
  • the position is set as an obstacle point, and the coordinates of the position are stored to form a recording point;
  • Step 2000 determining whether a record point is stored first, and the coordinate of the record point on the Y axis is within a numerical interval formed by coordinates of the current obstacle point and the previous obstacle point in the Y axis;
  • Step 3000 If the judgment result is yes, the recording point is a turning point, and the moving robot walks from the current obstacle point along the X axis toward the turning point to the X-axis coordinate of the turning point, deletes the turning point coordinate, and executes the point to After the traversal of the region between the current obstacle points, the process returns to step 1000;
  • the self-moving robot moves a displacement amount M1 along the X axis
  • Step 4000 The mobile robot moves in the reverse direction of the original Y-axis walking direction, and returns to step 1000;
  • Step 5000 Loop step 1000 to step 4000 until the Y-axis traverse walk of the walking area is completed.
  • the present invention has the advantages that when the self-moving robot encounters an obstacle during the walking of the work, the determination of the coordinates can be avoided at one time, and the area between the obstacle and the boundary of the walking area is respectively completed.
  • Homework the prior art requires repeated avoidance of walking around obstacles during the work. Therefore, the present invention has a clear judgment on the position of the obstacle, and the walking route is simple, which greatly improves the working efficiency of the self-mobile robot.
  • FIG. 1 is a schematic diagram of an existing self-moving robot for avoiding obstacles
  • FIG. 2 is a schematic diagram of an obstacle avoidance walking of a mobile robot according to an embodiment of the present invention
  • FIG. 3 is a schematic diagram of a self-moving robot obstacle avoidance walking according to an embodiment of the present invention.
  • FIG. 4 is a schematic diagram of an obstacle avoidance walking of a self-mobile robot according to an embodiment of the present invention.
  • FIG. 2 is a schematic diagram of an obstacle avoidance walking of a mobile robot according to an embodiment of the present invention.
  • the specific obstacle avoidance walking process of the present invention is as follows. First, in the walking area of the self-moving robot, a plane rectangular coordinate system is established with the horizontal direction being the X axis and the vertical direction being the Y axis, and walking along the X and Y axis directions is positive walking, otherwise it is reverse walk.
  • the obstacle avoidance walking process of the present invention will be described by taking the walking robot in the Y-axis direction as an example.
  • the self-moving robot travels in the walking area 100 from the lower left corner O of the area, and travels forward in the Y-axis direction, and when it moves to the upper edge P of the walking area 100, an obstacle is detected.
  • the obstacle may be the border of the walking area or the borderless cliff boundary, etc., at this time, the coordinates of the point are stored as (X 0 , Y P ), after the moving robot moves the M1 distance along the X-axis direction, along the Y Walking in the opposite direction in the axial direction.
  • the mobile robot When it moves to the lower edge Q of the walking area 100, an obstacle is detected, and at this time, the coordinates of the point are stored as (X Q , Y Q ).
  • the mobile robot automatically detects and determines whether there is a recording point whose Y coordinate value is within the Y-axis coordinate interval (Y Q , Y P ) formed by the stored current coordinate point Q and the stored previous coordinate point P. . As shown in Fig.
  • the moving robot moves to point A, an obstacle is detected, and the coordinates of the point are stored as (X A , Y A ), and the coordinates of the point A' of the previous obstacle point of point A are (X A' , Y Q ), and there is no obstacle recording point where the Y-axis coordinate is between Y A and Y Q , then the moving robot continues to travel along the Y-axis after shifting the M1 distance along the X-axis direction at point A, so that the reciprocating "bow""Glyph path, while recording the coordinates of each point where the obstacle is detected.
  • the walking path of the self-moving robot is: O ⁇ P ⁇ Q ⁇ A ⁇ B ⁇ F ⁇ G ⁇ C ⁇ D ⁇ N ⁇ E ⁇ C ⁇ G.
  • the record point is a turn-back point, and the self-moving robot returns from the current obstacle point to the turn-back point, wherein if there are multiple record points satisfying the judgment condition, all the record points satisfying the judgment condition are compared.
  • the difference between the X-axis coordinate and the X-axis coordinate at the obstacle point, and the record point with the largest difference is the fold-back point; if not, the self-moving robot reverses the Y1 distance after shifting the M1 distance from the current obstacle point along the X-axis Exercise, returning to the regular reciprocating "bow" walking style.
  • the present invention provides a self-moving robot obstacle avoiding walking method.
  • a plane orthogonal coordinate system is established with a horizontal direction as an X axis and a vertical direction as a Y axis. Walking in the direction of the X-axis or the Y-axis for forward walking;
  • the method specifically includes the following steps:
  • Step 1000 The mobile robot walks along the Y axis.
  • the position is set as an obstacle point, and the coordinates of the position are stored to form a recording point;
  • Step 2000 determining whether a record point is stored first, and the coordinate of the record point on the Y axis is within a numerical interval formed by coordinates of the current obstacle point and the previous obstacle point in the Y axis;
  • Step 3000 If the judgment result is yes, the recording point is a turning point, and the moving robot walks from the current obstacle point along the X axis toward the turning point to the X-axis coordinate of the turning point, deletes the turning point coordinate, and executes the point to After the traversal of the region between the current obstacle points, the process returns to step 1000;
  • the self-moving robot moves a displacement amount M1 along the X axis
  • Step 4000 The mobile robot moves in the reverse direction of the original Y-axis walking direction, and returns to step 1000;
  • Step 5000 Loop step 1000 to step 4000 until the Y-axis traverse walk of the walking area is completed.
  • FIG. 3 is a schematic diagram of the obstacle avoidance walking of the self-mobile robot according to the second embodiment of the present invention.
  • it is also required to establish a plane rectangular coordinate system in the horizontal direction of the X-axis and the vertical direction as the Y-axis in the walking area of the self-moving robot, and set along the X and Y axes. Walking in the direction is positive walking, otherwise walking in reverse.
  • the coordinates of the point where the self-moving robot walks along the Y-axis in the forward direction and hit the obstacle correspond to the coordinates of the upward obstacle point; the coordinates of the point where the mobile robot moves backward along the Y-axis and touch the obstacle are the downward obstacles. Point coordinates.
  • the coordinates of the point correspond to the coordinates of the right-hand obstacle point; the coordinates of the point at which the mobile robot moves backward along the X-axis and hit the obstacle are Left line obstacle point coordinates.
  • the coordinates of the upward obstacle point and the descending obstacle point are stored separately from the mobile robot, and the points with the same Y-axis coordinates are stored only once in the up-going obstacle point or the descending obstacle point.
  • the coordinates (X O , Y P ) of the upward obstacle point P are detected when the mobile robot walks to the P point, and there is no uplink record equal to the P-point Y-axis coordinate Y P before the P point.
  • point P is a valid up-going obstacle point, storing P point coordinates as an up-record point, and in the walking area between point P and point A, all the upward obstacle points have the same Y-axis coordinate as the P-point Y-axis coordinate Therefore, the upward obstacle points in the area are invalid upward obstacle points, and the coordinates are not stored. For the same reason, among the downward obstacle points in the area, only the coordinates of the downward obstacle point Q (X Q , Y) Q ) Store.
  • the coordinates of the point (X A , Y A ) are compared with the stored coordinates of the upstream recorded point, and the stored upstream recording point at this time only the point P, because the a point Y coordinate Y a point P Y-axis coordinate Y P are not equal, the coordinates (X-a, Y a) impairment point a is stored in the uplink is an uplink recording point, and because Y a, The coordinate value is less than Y P , and the mobile robot translates the M1 distance along the X axis at A.
  • the self-moving robot first determines whether it can continue to travel along the walking direction before the shift, and the original direction is the Y-axis positive direction. If yes, continue to walk along the Y axis. If not, walk backwards along the Y axis. At this time, the mobile robot obviously cannot travel in the positive direction along the Y axis. Therefore, the mobile robot moves backward along the Y axis. Move down the Y axis.
  • the Y-axis coordinates of all the upward obstacle points are the same as the A-axis Y-axis coordinates, so the coordinates of the upward obstacle points in the area are not stored, when the self-mobile robot walks to B1
  • the obstacle is detected, and the coordinates at B1 are also compared with the previously stored coordinates of the upper recorded point. Since the Y coordinate of point P and point A is greater than or equal to the Y coordinate of point B1, the self-moving robot is at B1. Move the M1 distance along the X axis and move to point B. At this point, at point B, the self-moving robot needs to determine whether it can move upward along the original Y-axis direction.
  • the self-moving robot can move upward along the original Y-axis direction, so the self-moving robot continues to move to point C.
  • the C point coordinates are compared with the previously recorded P point and the Y axis coordinate of point A, and it is obvious that the Y axis coordinate of point A is smaller than the Y axis coordinate of point C.
  • the point A is used as the turning point, and the moving robot moves from the point C in the X-axis direction to the point D which is the same as the X-axis coordinate of the point A, and then travels in the Y-axis direction.
  • the record of point A is deleted at this time. Then the reciprocating "bow" shaped path moves from point D to point E.
  • the coordinate point is no longer stored when the mobile robot detects the obstacle, until the movement to point E (excluding point E) restarts the storage. Obstacles.
  • the self-moving robot needs to determine whether it can move downward along the original Y-axis direction, and if so, continue moving from point E to point G; if not, along the Y-axis Move up (not shown). Then resume the normal reciprocating "bow" shaped path from point G.
  • the walking path of the self-moving robot is: O ⁇ P ⁇ Q ⁇ A ⁇ B ⁇ C ⁇ D ⁇ N ⁇ E ⁇ G.
  • the second embodiment has two differences.
  • the concept of up and down is defined for the direction in which the mobile robot travels along the Y axis.
  • the coordinates of the obstacle points with the same Y coordinate in the upward obstacle point need not be stored, but only The obstacle points with different Y-axis coordinates are stored to form a recording point.
  • the self-moving robot During the movement of the self-moving robot, it is only necessary to judge whether the Y-axis coordinate of a certain recording point is smaller than the Y-axis coordinate of the current obstacle point in the previously recorded upstream recording point, and if so, the self-moving robot from the current obstacle point Return to the X-axis coordinate of the record point; if not, the self-moving robot translates the M1 distance along the X-axis from the current obstacle point. Second: when the mobile robot detects the obstacle M1 distance, it adds a judgment on whether the self-mobile robot can continue walking according to the walking direction before the translation, and if so, continues to walk according to the walking direction before the translation, if no , then walk in the opposite direction of the walking direction before translation. Adding such a judging step in the present embodiment can further simplify the walking path and improve the working efficiency of the self-mobile robot.
  • the concept of the uplink and the downlink is defined for the direction in which the mobile robot travels along the Y axis, and in order to reduce the amount of data storage, the Y coordinate of the uplink obstacle point or the downlink obstacle point is the same.
  • the obstacle point is stored only once, but the travel path shown in Fig. 3 can also be realized by storing all the obstacle point coordinates.
  • the mobile robot moves the M1 distance of the obstacle after the obstacle is moved, and the walking obstacle is not limited to the limiting condition, for example, Excluding the restriction condition, the walking path shown in FIG. 2 can be completed since the mobile robot always walks in a reciprocating "bow" shape path.
  • FIG. 4 is a schematic diagram of an obstacle avoidance walking of a self-mobile robot according to an embodiment of the present invention. As shown in Fig. 4, this embodiment is a further optimization based on the foregoing two embodiments.
  • point A is used as the turning point. It should be moved in the X-axis direction at the point C to the same position as the X-axis coordinate of point A, but the blocking of the obstacle M is detected. At this time, the turning point A is deleted.
  • the walking path of the self-moving robot is: A ⁇ B ⁇ C ⁇ B ⁇ D.
  • the third embodiment further increases the step of further judging and controlling the self-moving robot during the walking along the Y-axis or the X-axis direction, and the obstacles are required to be turned according to the control method, and the steps provided in the first and second embodiments are provided.
  • the control method is improved.
  • the above method is also applicable when the self-moving robot walks in the X-axis direction.
  • the rectangular coordinate system is established in the horizontal direction as the X-axis and the vertical direction as the Y-axis to facilitate the description of the walking path, but the present invention is not limited to the horizontal direction and the vertical direction, and the coordinate system can be established in other two perpendicular directions. , such as east-west direction and north-south direction.
  • the present invention provides a self-moving robot obstacle avoiding walking method.
  • a plane rectangular coordinate system is established with a horizontal direction as an X axis and a vertical direction as a Y axis.
  • the method specifically includes The following steps:
  • Step 100 The mobile robot walks along the Y axis.
  • the obstacle point is the upward obstacle point, and the effective uplink obstacle point is the uplink recording point;
  • the obstacle point is the downward obstacle point, and the effective downlink obstacle point is the downlink recording point;
  • Step 200 Divide the uplink record point and the downlink record point into the current uplink record point and the previous uplink record point, the current downlink record point, and the previous downlink record point according to the stored sequence;
  • Step 300 If the current obstacle point is an uplink obstacle point, determine whether there is a previous uplink recording point before the current uplink obstacle point, and the coordinate of the previous uplink recording point on the Y axis is smaller than the current uplink obstacle point. The coordinate on the Y axis; if the current obstacle point is a downward obstacle point, it is determined whether there is a previous downlink recording point before the current downlink obstacle point, and the coordinate of the previous downlink recording point on the Y axis is greater than the current downlink The coordinates of the obstacle point on the Y axis;
  • Step 400 If the determination result is yes, the previous uplink recording point or the previous downward recording point is a turning point, and the mobile robot walks along the X axis toward the turning point in the obstacle point to the X-axis coordinate of the turning point. Deleting the turning point coordinates, performing the traversal walking of the area between the current obstacle point, and returning to step 100; if the judgment result is no, the self-moving robot moves a displacement amount M1 along the X axis;
  • Step 500 The mobile robot moves in the reverse direction of the original Y-axis walking direction, and returns to step 100;
  • Step 600 Cycle step 100 to step 500 until the traversal walking of the walking area is completed.
  • the step 100 specifically includes:
  • the upside obstacle point is a valid up obstacle point; if the current downhole obstacle point and any previous down record point Y coordinate are not The same, the downside obstacle point is a valid downside obstacle point.
  • the step 100 specifically includes:
  • Any upside obstacle points are effective upside obstacle points; any downside obstacle points are effective downside obstacle points.
  • the step 400 specifically includes: if the judgment result is yes, compare the difference between the X-axis coordinate of the uplink record point or the downlink record point satisfying the judgment condition and the X-axis coordinate of the obstacle point, and use the difference record with the largest difference.
  • the point or down record point is the foldback point.
  • the step 400 specifically includes: if the determination result is yes, delete all the uplink record points or the downlink record point coordinates that satisfy the judgment condition.
  • the step 400 specifically includes: if the obstacle is detected again after the mobile robot has not reached the X-axis coordinate of the turning point, the folding point coordinates are deleted and the process proceeds to step 500.
  • the walking manner in which the robot performs the traversal walking from the turning point to the current obstacle point is the same as the walking manner in the step 600 in which the traversing walking of the walking area is completed.
  • the method further includes a step 410: determining whether the self-moving robot can walk along the original Y-axis walking direction. If the determination result is yes, the self-moving robot walks along the original Y-axis walking direction, and returns to step 100; Otherwise, proceed to step 500.
  • the step 410 determines whether the specific content of the mobile robot can walk along the original Y-axis walking direction is:
  • the self-moving robot first walks along the original Y-axis walking direction. If no obstacle is detected after walking for a certain distance, it is judged that the self-moving robot can walk along the original Y-axis walking direction. Otherwise, it is judged that the self-moving robot cannot walk along the original Y-axis. Walking in the direction.
  • the side view sensor is provided on the side of the mobile robot.
  • the step 410 determines whether the self-moving robot can walk along the original Y-axis travel direction: the self-mobile robot judges whether it can be along the original Y according to the feedback signal of the side-view sensor.
  • the axis travels in the direction of walking.
  • the advantage of the present invention is that when the self-moving robot encounters an obstacle during the walking of the work, the obstacle can be avoided by the judgment of the coordinate, and the obstacle is surrounded and walked separately.

Abstract

An obstacle avoidance walking method of a self-moving robot, comprising: step 1000: a self-moving robot walks along a Y-axis, identifies the position of an obstacle as an obstacle point, and stores the coordinates of the point as a recorded point; step 2000: determining whether a recorded point was previously stored, the coordinates on the Y-axis of the previously stored recorded point being within a numerical value interval formed by the coordinates on the Y-axis of the current obstacle point and a previous obstacle point; step 3000: if yes, then the recorded point is a turning point, and the self-moving robot walks along the X-axis from the current obstacle point toward the turning point to the coordinates on the X-axis of the turning point, deleting the coordinates of the turning point, walking in an area between the point and the current obstacle point, and returning to step 1000; and if not, then the self-moving robot moves a displacement M1 along the X-axis; step 4000: walking in a direction opposite to the original Y-axis walking direction, and returning to step 1000; step 5000: repeating step 1000 to step 4000 until the Y-axis is traversed. The method accurately determines an obstacle position and provides a concise route, and greatly improves the working efficiency of the self-moving robot.

Description

自移动机器人避障行走方法Self-moving robot obstacle avoiding walking method 技术领域Technical field
本发明涉及一种自移动机器人避障行走方法,属于小家电制造技术领域。The invention relates to a self-moving robot obstacle avoiding walking method, belonging to the technical field of small household appliance manufacturing.
背景技术Background technique
自移动机器人以其操作方便行走自如得到广泛的应用,可以实现包括擦窗、扫地、空气净化等在内的多种用途。自移动机器人在作业过程中,往往会遇到障碍物,在其自移动行走过程中能够准确有效地躲避障碍,可以大大提供其工作效率。以擦窗机器人为例,现有技术CN02137830.4中,提供一种自动吸尘器的可清扫区域和障碍物区域的识别方法。图1为现有自移动机器人避障行走示意图。结合图1所示,如果将自移动机器人的运动方向分为水平方向(X轴)和竖直方向(Y轴)上的运动,图1所示为自移动机器人沿X轴方向扫描,在Y轴方向上的避障行走示意图。如图1所示,自移动机器人分别沿Y1、Y2和Y3的往复路径行走,当遇到障碍物A4时,绕过障碍物并沿竖直方向往复行走,每次竖直方向遇到障碍物A4后,都执行绕过的动作。现有自移动机器人的行走方式,导致了位于障碍物A4右侧的路径,被反复多次的重复,这种大量的重复行走,大大延长了机器人的行走时间,严重影响其工作效率。The self-moving robot is widely used for its easy operation and can be used for a variety of purposes including window cleaning, sweeping, and air purification. Self-moving robots often encounter obstacles during the operation process, and can accurately and effectively avoid obstacles during their self-moving walking process, which can greatly provide their work efficiency. Taking the window cleaning robot as an example, in the prior art CN02137830.4, a method for identifying a cleanable area and an obstacle area of an automatic vacuum cleaner is provided. FIG. 1 is a schematic diagram of an existing self-moving robot for obstacle avoidance walking. As shown in FIG. 1, if the movement direction of the self-moving robot is divided into the movement in the horizontal direction (X-axis) and the vertical direction (Y-axis), FIG. 1 shows the self-moving robot scanning along the X-axis direction, in Y. Schematic diagram of obstacle avoidance walking in the axial direction. As shown in Fig. 1, the self-moving robots travel along the reciprocating paths of Y1, Y2, and Y3, respectively, and when encountering the obstacle A4, bypass the obstacle and reciprocate in the vertical direction, encountering an obstacle each time in the vertical direction. After A4, the bypass action is performed. The walking mode of the existing self-moving robot leads to the path on the right side of the obstacle A4, which is repeatedly repeated many times. This large number of repeated walking greatly prolongs the walking time of the robot and seriously affects the working efficiency.
发明内容Summary of the invention
本发明所要解决的技术问题在于针对现有技术的不足,提供一种自移动机器人避障行走方法,对障碍物位置判断明确,行走路线简洁,大大提高了自移动机器人的工作效率。The technical problem to be solved by the present invention lies in the deficiencies of the prior art, and provides a self-moving robot obstacle avoiding walking method, which has a clear judgment on the position of the obstacle, a simple walking route, and greatly improves the working efficiency of the self-mobile robot.
本发明的所要解决的技术问题是通过如下技术方案实现的:The technical problem to be solved by the present invention is achieved by the following technical solutions:
一种自移动机器人避障行走方法,在所述自移动机器人的行走区域内,以水平方向为X轴,竖直方向为Y轴建立平面直角坐标系,该方法具体包括如下步骤:A self-moving robot obstacle avoiding walking method, in which the horizontal direction is the X axis and the vertical direction is the Y axis to establish a plane rectangular coordinate system in the walking area of the self-moving robot, the method specifically includes the following steps:
步骤100:自移动机器人沿Y轴行走,当自移动机器人沿Y轴正向行走检测到障碍物时,设该位置障碍点为上行障碍点,存储有效的上行障碍点为上行记录点;当自移动机器人沿Y轴反向行走检测到障碍物时,设该位置障碍点为下行障碍点,存储有效的下行障碍点为下行记录点;Step 100: The mobile robot walks along the Y axis. When the mobile robot detects the obstacle along the Y axis, the obstacle point is the upward obstacle point, and the effective uplink obstacle point is the uplink recording point; When the mobile robot detects the obstacle along the Y-axis, the obstacle point is the downward obstacle point, and the effective downlink obstacle point is the downlink recording point;
步骤200:将上行记录点和下行记录点根据存储的先后顺序分为当前上行记录点和在先上行记录点、当前下行记录点和在先下行记录点;Step 200: Divide the uplink record point and the downlink record point into the current uplink record point and the previous uplink record point, the current downlink record point, and the previous downlink record point according to the stored sequence;
步骤300:若所述当前障碍点为上行障碍点,判断当前的上行障碍点之前是否存 在一在先上行记录点,且该在先上行记录点在Y轴上的坐标小于当前的上行障碍点在Y轴上的坐标;若所述当前障碍点为下行障碍点,判断当前的下行障碍点之前是否存在一在先下行记录点,且该在先下行记录点在Y轴上的坐标大于当前的下行障碍点在Y轴上的坐标;Step 300: If the current obstacle point is an uplink obstacle point, determine whether the current uplink obstacle point exists before Recording a point in a previous uplink, and the coordinate of the preceding uplink recording point on the Y axis is smaller than the coordinate of the current uplink obstacle point on the Y axis; if the current obstacle point is a downward obstacle point, determining the current downlink obstacle Whether there is a previous downlink recording point before the point, and the coordinate of the previous downlink recording point on the Y axis is greater than the coordinate of the current downlink obstacle point on the Y axis;
步骤400:若判断结果为是,则该在先上行记录点或在先下行记录点为折返点,自移动机器人在该障碍点处沿X轴朝折返点方向行走至折返点X轴坐标处,删除折返点坐标,执行该点到当前障碍点之间区域的遍历行走后,返回步骤100;若判断结果为否,自移动机器人沿X轴移动一个位移量M1;Step 400: If the determination result is yes, the previous uplink recording point or the previous downward recording point is a turning point, and the mobile robot walks along the X axis toward the turning point in the obstacle point to the X-axis coordinate of the turning point. Deleting the turning point coordinates, performing the traversal walking of the area between the current obstacle point, and returning to step 100; if the judgment result is no, the self-moving robot moves a displacement amount M1 along the X axis;
步骤500:自移动机器人沿原Y轴行走方向的反向行走,返回步骤100;Step 500: The mobile robot moves in the reverse direction of the original Y-axis walking direction, and returns to step 100;
步骤600:循环步骤100至步骤500,直至完成行走区域的遍历行走。Step 600: Cycle step 100 to step 500 until the traversal walking of the walking area is completed.
上行障碍点和下行障碍点可以部分存储也可以全部存储,具体来说,部分存储时,所述步骤100具体还包括:The uplink obstacle point and the downlink obstacle point may be partially stored or may be stored in the whole. Specifically, when the part is stored, the step 100 specifically includes:
若当前上行障碍点与任一在先上行记录点Y轴坐标均不相同,则该上行障碍点为有效的上行障碍点;若当前下行障碍点与任一在先下行记录点Y轴坐标均不相同,则该下行障碍点为有效的下行障碍点。If the current obstacle obstacle point is not the same as the Y coordinate of any preceding uplink record point, the upside obstacle point is a valid up obstacle point; if the current downhole obstacle point and any previous down record point Y coordinate are not The same, the downside obstacle point is a valid downside obstacle point.
全部存储时,所述步骤100具体还包括:任一上行障碍点均为有效上行障碍点;任一下行障碍点均为有效下行障碍点。When all are stored, the step 100 specifically includes: any uplink obstacle points are effective uplink obstacle points; and any downlink obstacle points are effective downlink obstacle points.
所述步骤400具体还包括:若判断结果为是,比较所有满足判断条件的上行记录点或下行记录点中X轴坐标与该障碍点处X轴坐标的差值,以差值最大的上行记录点或下行记录点为折返点。The step 400 specifically includes: if the judgment result is yes, compare the difference between the X-axis coordinate of the uplink record point or the downlink record point satisfying the judgment condition and the X-axis coordinate of the obstacle point, and use the difference record with the largest difference. The point or down record point is the foldback point.
为了减少存储量,所述步骤400具体还包括,若判断结果为是,删除所有满足判断条件的上行记录点或下行记录点坐标。In order to reduce the amount of storage, the step 400 specifically includes: if the determination result is yes, delete all the uplink record points or the downlink record point coordinates that satisfy the judgment condition.
所述步骤400具体还包括:如果自移动机器人还未走到折返点X轴坐标处再次检测到障碍物,则删除折返点坐标后进入步骤500。The step 400 specifically includes: if the obstacle is detected again after the mobile robot has not reached the X-axis coordinate of the turning point, the folding point coordinates are deleted and the process proceeds to step 500.
在所述步骤400中,机器人执行从折返点到当前障碍点之间区域的遍历行走的行走方式与步骤600中完成行走区域的遍历行走的行走方式相同。In the step 400, the walking manner in which the robot performs the traversal walking from the turning point to the current obstacle point is the same as the walking manner in the step 600 in which the traversing walking of the walking area is completed.
所述步骤400后还包括步骤410:判断自移动机器人是否可以沿原Y轴行走方向行走,若判断结果为是,则自移动机器人沿原Y轴行走方向行走,返回步骤100;若判断结果为否,则进入步骤500。After the step 400, the method further includes a step 410: determining whether the self-moving robot can walk along the original Y-axis walking direction. If the determination result is yes, the self-moving robot walks along the original Y-axis walking direction, and returns to step 100; Otherwise, proceed to step 500.
所述步骤410判断自移动机器人是否可以沿原Y轴行走方向行走的具体内容为:The step 410 determines whether the specific content of the mobile robot can walk along the original Y-axis walking direction is:
自移动机器人先沿原Y轴行走方向行走,若行走一段距离后未检测到障碍物,则 判断自移动机器人可以沿原Y轴行走方向行走,否则,判断自移动机器人不可以沿原Y轴行走方向行走。The mobile robot first walks along the original Y-axis walking direction. If no obstacle is detected after walking for a distance, then It is judged that the self-moving robot can walk along the original Y-axis walking direction; otherwise, it is judged that the self-moving robot cannot walk along the original Y-axis traveling direction.
自移动机器人的侧部设有侧视传感器,所述步骤410判断自移动机器人是否可以沿原Y轴行走方向行走的具体内容为:自移动机器人根据侧视传感器的反馈信号判断是否可以沿原Y轴行走方向行走。The side view sensor is provided on the side of the mobile robot. The step 410 determines whether the self-moving robot can walk along the original Y-axis travel direction: the self-mobile robot judges whether it can be along the original Y according to the feedback signal of the side-view sensor. The axis travels in the direction of walking.
本发明还提供一种自移动机器人避障行走方法,在所述自移动机器人的行走区域内,以水平方向为X轴,竖直方向为Y轴建立平面直角坐标系,且沿着X轴或Y轴的方向行走为正向行走;The invention also provides a self-moving robot obstacle avoiding walking method, in which the horizontal direction is the X axis and the vertical direction is the Y axis to establish a plane rectangular coordinate system in the walking region of the self-moving robot, and along the X axis or The direction of the Y axis is walking in the forward direction;
该方法具体包括如下步骤:The method specifically includes the following steps:
步骤1000:自移动机器人沿Y轴行走,当自移动机器人检测到障碍物时,设该位置为障碍点,存储该位置的坐标形成记录点;Step 1000: The mobile robot walks along the Y axis. When the obstacle is detected by the mobile robot, the position is set as an obstacle point, and the coordinates of the position are stored to form a recording point;
步骤2000:判断是否在先存储有一记录点,且该记录点在Y轴上的坐标位于当前障碍点与前一障碍点在Y轴向上的坐标所构成的数值区间内;Step 2000: determining whether a record point is stored first, and the coordinate of the record point on the Y axis is within a numerical interval formed by coordinates of the current obstacle point and the previous obstacle point in the Y axis;
步骤3000:若判断结果为是,则该记录点为折返点,自移动机器人自当前障碍点处沿X轴朝折返点方向行走至折返点X轴坐标处,删除折返点坐标,执行该点到当前障碍点之间区域的遍历行走后,返回步骤1000;Step 3000: If the judgment result is yes, the recording point is a turning point, and the moving robot walks from the current obstacle point along the X axis toward the turning point to the X-axis coordinate of the turning point, deletes the turning point coordinate, and executes the point to After the traversal of the region between the current obstacle points, the process returns to step 1000;
若判断结果为否,自移动机器人沿X轴移动一个位移量M1;If the judgment result is no, the self-moving robot moves a displacement amount M1 along the X axis;
步骤4000:自移动机器人沿原Y轴行走方向的反向行走,返回步骤1000;Step 4000: The mobile robot moves in the reverse direction of the original Y-axis walking direction, and returns to step 1000;
步骤5000:循环步骤1000到步骤4000,直至完成行走区域的Y轴遍历行走。Step 5000: Loop step 1000 to step 4000 until the Y-axis traverse walk of the walking area is completed.
综上所述,本发明的优点在于,当自移动机器人在作业行走过程中遇到障碍物时,可以通过对坐标的判断一次性躲避,分别完成对障碍物四周与行走区域边界之间区域的作业;而现有技术则需要在作业过程中反复躲避围绕障碍物行走。因此,本发明对障碍物位置判断明确,行走路线简洁,大大提高了自移动机器人的工作效率。In summary, the present invention has the advantages that when the self-moving robot encounters an obstacle during the walking of the work, the determination of the coordinates can be avoided at one time, and the area between the obstacle and the boundary of the walking area is respectively completed. Homework; the prior art requires repeated avoidance of walking around obstacles during the work. Therefore, the present invention has a clear judgment on the position of the obstacle, and the walking route is simple, which greatly improves the working efficiency of the self-mobile robot.
下面结合附图和具体实施例,对本发明的技术方案进行详细地说明。The technical solutions of the present invention will be described in detail below with reference to the accompanying drawings and specific embodiments.
附图说明DRAWINGS
图1为现有自移动机器人避障行走示意图;1 is a schematic diagram of an existing self-moving robot for avoiding obstacles;
图2为本发明实施例一自移动机器人避障行走示意图;2 is a schematic diagram of an obstacle avoidance walking of a mobile robot according to an embodiment of the present invention;
图3为本发明实施例二自移动机器人避障行走示意图;3 is a schematic diagram of a self-moving robot obstacle avoidance walking according to an embodiment of the present invention;
图4为本发明实施例三自移动机器人避障行走示意图。 4 is a schematic diagram of an obstacle avoidance walking of a self-mobile robot according to an embodiment of the present invention.
具体实施方式detailed description
实施例一Embodiment 1
图2为本发明实施例一自移动机器人避障行走示意图。如图2所示,本发明的具体避障行走过程如下所述。首先,在所述自移动机器人的行走区域内,以水平方向为X轴、竖直方向为Y轴建立平面直角坐标系,且沿着X、Y轴方向行走为正向行走,否则为反向行走。FIG. 2 is a schematic diagram of an obstacle avoidance walking of a mobile robot according to an embodiment of the present invention. As shown in FIG. 2, the specific obstacle avoidance walking process of the present invention is as follows. First, in the walking area of the self-moving robot, a plane rectangular coordinate system is established with the horizontal direction being the X axis and the vertical direction being the Y axis, and walking along the X and Y axis directions is positive walking, otherwise it is reverse walk.
结合图2所示,在本实施例中,仅以自移动机器人沿Y轴方向行走为例,对本发明的避障行走过程进行说明。具体来说,自移动机器人在行走区域100内,从该区域的左下角O点处出发,沿Y轴向上正向行走,当其运动到行走区域100的上方边缘P点时,检测到障碍物,该障碍物可能是行走区域的边框或无框悬崖边界等,此时,存储该点的坐标,为(X0,YP),自移动机器人沿X轴方向平移M1距离后,沿Y轴向下反向行走。当其运动到行走区域100的下方边缘Q点时,检测到障碍物,此时,存储该点的坐标,为(XQ,YQ)。自移动机器人自动检测,判断是否存在一个记录点,该记录点的Y坐标值处于存储的当前坐标点Q与存储的前一坐标点P所构成的Y轴坐标区间(YQ,YP)内。如图2所示,显然不存在这个记录点,则自移动机器人在Q点处沿X轴方向平移M1距离后,继续沿Y轴向上正向行走,如此往复“弓”字形路径,同时对每个检测到障碍物的坐标点都进行记录,并判断是否存在一记录点的Y轴坐标处于存储的当前坐标点与前一坐标点所构成的Y轴坐标区间内。当自移动机器人运动到A点时,检测到障碍物,存储该点的坐标,为(XA,YA),A点的前一障碍点A’点的坐标为(XA’,YQ),也没有Y轴坐标位于YA和YQ之间的障碍物记录点,则自移动机器人在A点处沿X轴方向平移M1距离后,继续沿Y轴向下行走,如此往复“弓”字形路径,同时对每个检测到障碍物的点的坐标点都进行记录。当自移动机器人运动到C点时,该点的坐标为(XC,YP),其前一个检测到障碍物的点为F点,该点的坐标为(XB,YQ),显然,在所存储的记录点中A点、B1点和B2点的Y坐标值在C点和F点Y坐标值之间,且A点的X轴坐标值XA小于B点的X轴坐标值XB,则A点为折返点,自移动机器人在C点沿X轴反向行走到与A点X坐标相等的D点,此时为防止之后自移动机器人再次返回重复行走,删除A、B点及与其Y坐标相等的各记录点,开始由D点到C点之间区域的遍历行走,在此过程中自移动机器人检测到障碍物时不再存储坐标点,直到再次运动到C点X轴以后重新开始存储检测到障碍物时的坐标点,重新回到常规的往复“弓”字形行走模式。在本实施例中由D点到C点障碍物区域的遍历行走所采用的行走模式同样为往复“弓”字形行走,需要说明的是, 此处并不限于“弓”字形行走,采用其它行走模式,如“回”字形行走,同样可以达到相同的技术效果。如图2所示,自移动机器人的行走路径为:O→P→Q→A→B→F→G→C→D→N→E→C→G。As shown in Fig. 2, in the present embodiment, the obstacle avoidance walking process of the present invention will be described by taking the walking robot in the Y-axis direction as an example. Specifically, the self-moving robot travels in the walking area 100 from the lower left corner O of the area, and travels forward in the Y-axis direction, and when it moves to the upper edge P of the walking area 100, an obstacle is detected. Object, the obstacle may be the border of the walking area or the borderless cliff boundary, etc., at this time, the coordinates of the point are stored as (X 0 , Y P ), after the moving robot moves the M1 distance along the X-axis direction, along the Y Walking in the opposite direction in the axial direction. When it moves to the lower edge Q of the walking area 100, an obstacle is detected, and at this time, the coordinates of the point are stored as (X Q , Y Q ). The mobile robot automatically detects and determines whether there is a recording point whose Y coordinate value is within the Y-axis coordinate interval (Y Q , Y P ) formed by the stored current coordinate point Q and the stored previous coordinate point P. . As shown in Fig. 2, it is obvious that there is no such recording point, and since the mobile robot shifts the M1 distance in the X-axis direction at the Q point, it continues to walk forward in the Y-axis direction, thus reciprocating the "bow"-shaped path, and simultaneously Each coordinate point at which the obstacle is detected is recorded, and it is judged whether or not the Y-axis coordinate of a recorded point is within the Y-axis coordinate interval formed by the stored current coordinate point and the previous coordinate point. When the moving robot moves to point A, an obstacle is detected, and the coordinates of the point are stored as (X A , Y A ), and the coordinates of the point A' of the previous obstacle point of point A are (X A' , Y Q ), and there is no obstacle recording point where the Y-axis coordinate is between Y A and Y Q , then the moving robot continues to travel along the Y-axis after shifting the M1 distance along the X-axis direction at point A, so that the reciprocating "bow""Glyph path, while recording the coordinates of each point where the obstacle is detected. When the moving robot moves to point C, the coordinates of the point are (X C , Y P ), and the point at which the previous obstacle is detected is point F, and the coordinates of the point are (X B , Y Q ), obviously The Y coordinate value of the A point, the B1 point, and the B2 point in the stored recording point is between the C point and the F point Y coordinate value, and the X-axis coordinate value X A of the point A is smaller than the X-axis coordinate value of the B point. X B , then point A is the turning point, and the moving robot moves backward at the point C along the X axis to the point D which is equal to the X coordinate of point A. At this time, to prevent the self-moving robot from returning to the repeated walking again, delete A and B. The point and each recording point equal to its Y coordinate start the traversal walking from the point D to the point C. During this process, the coordinate point is no longer stored when the mobile robot detects the obstacle until it moves to point C again. The axis then resumes storing the coordinate points when the obstacle is detected, and returns to the conventional reciprocating "bow" type walking mode. In the present embodiment, the walking mode adopted by the traversal walking from the point D to the point C is also a reciprocating "bow"-shaped walking. It should be noted that the walking is not limited to the "bow" shape, and other walking is adopted. Patterns, such as the "back" shape walk, can also achieve the same technical effect. As shown in FIG. 2, the walking path of the self-moving robot is: O→P→Q→A→B→F→G→C→D→N→E→C→G.
也就是说,在实施例一中,通过记录障碍点的坐标,形成记录点,在自移动机器人的运动过程中,判断是否存在一记录点的Y轴坐标处于当前障碍点与前一障碍点Y轴坐标区间内,如果存在,该记录点为折返点,自移动机器人从当前障碍点回到折返点,其中,若存在多个满足判断条件的记录点,则比较所有满足判断条件的记录点中X轴坐标与该障碍点处X轴坐标的差值,以差值最大的记录点为折返点;如果不存在,自移动机器人从当前障碍点沿X轴平移M1距离后,沿Y轴反向运动,重新回到常规的往复“弓”字形行走方式。That is to say, in the first embodiment, by recording the coordinates of the obstacle point, a recording point is formed, and during the movement of the self-moving robot, it is judged whether or not there is a Y-axis coordinate of a recording point at the current obstacle point and the previous obstacle point Y. In the axis coordinate interval, if present, the record point is a turn-back point, and the self-moving robot returns from the current obstacle point to the turn-back point, wherein if there are multiple record points satisfying the judgment condition, all the record points satisfying the judgment condition are compared. The difference between the X-axis coordinate and the X-axis coordinate at the obstacle point, and the record point with the largest difference is the fold-back point; if not, the self-moving robot reverses the Y1 distance after shifting the M1 distance from the current obstacle point along the X-axis Exercise, returning to the regular reciprocating "bow" walking style.
综上所述,本发明提供一种自移动机器人避障行走方法,在所述自移动机器人的行走区域内,以水平方向为X轴,竖直方向为Y轴建立平面直角坐标系,且沿着X轴或Y轴的方向行走为正向行走;In summary, the present invention provides a self-moving robot obstacle avoiding walking method. In the walking region of the self-moving robot, a plane orthogonal coordinate system is established with a horizontal direction as an X axis and a vertical direction as a Y axis. Walking in the direction of the X-axis or the Y-axis for forward walking;
该方法具体包括如下步骤:The method specifically includes the following steps:
步骤1000:自移动机器人沿Y轴行走,当自移动机器人检测到障碍物时,设该位置为障碍点,存储该位置的坐标形成记录点;Step 1000: The mobile robot walks along the Y axis. When the obstacle is detected by the mobile robot, the position is set as an obstacle point, and the coordinates of the position are stored to form a recording point;
步骤2000:判断是否在先存储有一记录点,且该记录点在Y轴上的坐标位于当前障碍点与前一障碍点在Y轴向上的坐标所构成的数值区间内;Step 2000: determining whether a record point is stored first, and the coordinate of the record point on the Y axis is within a numerical interval formed by coordinates of the current obstacle point and the previous obstacle point in the Y axis;
步骤3000:若判断结果为是,则该记录点为折返点,自移动机器人自当前障碍点处沿X轴朝折返点方向行走至折返点X轴坐标处,删除折返点坐标,执行该点到当前障碍点之间区域的遍历行走后,返回步骤1000;Step 3000: If the judgment result is yes, the recording point is a turning point, and the moving robot walks from the current obstacle point along the X axis toward the turning point to the X-axis coordinate of the turning point, deletes the turning point coordinate, and executes the point to After the traversal of the region between the current obstacle points, the process returns to step 1000;
若判断结果为否,自移动机器人沿X轴移动一个位移量M1;If the judgment result is no, the self-moving robot moves a displacement amount M1 along the X axis;
步骤4000:自移动机器人沿原Y轴行走方向的反向行走,返回步骤1000;Step 4000: The mobile robot moves in the reverse direction of the original Y-axis walking direction, and returns to step 1000;
步骤5000:循环步骤1000到步骤4000,直至完成行走区域的Y轴遍历行走。Step 5000: Loop step 1000 to step 4000 until the Y-axis traverse walk of the walking area is completed.
实施例二Embodiment 2
图3为本发明实施例二自移动机器人避障行走示意图。如图3所示,本实施例也需要在所述自移动机器人的行走区域内,以水平方向为X轴、竖直方向为Y轴建立平面直角坐标系,且设定沿着X、Y轴方向行走为正向行走,否则为反向行走。同时设定自移动机器人沿Y轴正向行走碰到障碍物时所在点的坐标对应为上行障碍点坐标;自移动机器人沿Y轴反向行走碰到障碍物时所在点的坐标对应为下行障碍点坐标。同 样道理,如果自移动机器人沿X轴正向行走碰到障碍物时所在点的坐标对应为右行障碍点坐标;自移动机器人沿X轴反向行走碰到障碍物时所在点的坐标对应为左行障碍点坐标。FIG. 3 is a schematic diagram of the obstacle avoidance walking of the self-mobile robot according to the second embodiment of the present invention. As shown in FIG. 3, in this embodiment, it is also required to establish a plane rectangular coordinate system in the horizontal direction of the X-axis and the vertical direction as the Y-axis in the walking area of the self-moving robot, and set along the X and Y axes. Walking in the direction is positive walking, otherwise walking in reverse. At the same time, the coordinates of the point where the self-moving robot walks along the Y-axis in the forward direction and hit the obstacle correspond to the coordinates of the upward obstacle point; the coordinates of the point where the mobile robot moves backward along the Y-axis and touch the obstacle are the downward obstacles. Point coordinates. Same For example, if the self-moving robot is walking along the X-axis and encounters an obstacle, the coordinates of the point correspond to the coordinates of the right-hand obstacle point; the coordinates of the point at which the mobile robot moves backward along the X-axis and hit the obstacle are Left line obstacle point coordinates.
自移动机器人对上行障碍点和下行障碍点的坐标分别存储,且上行障碍点或下行障碍点中,其Y轴坐标相同的点仅存储一次。结合图3具体来说,自移动机器人行走到P点时检测到上行障碍点P的坐标(XO,YP),且在P点之前不存在与P点Y轴坐标YP相等的上行记录点,则P点为有效的上行障碍点,存储P点坐标为上行记录点,在P点和A点之间的行走区域内,所有的上行障碍点Y轴坐标均与P点Y轴坐标相同,因此该区域内的上行障碍点均为无效的上行障碍点,不对其坐标进行存储,同样的道理,在该区域内的下行障碍点中,仅对下行障碍点Q的坐标(XQ,YQ)进行存储。当自移动机器人沿Y轴正向行走到A处,碰到障碍物时,将该点(XA,YA)的坐标与所存储的上行记录点坐标比较,此时所存储的上行记录点中只有P点,由于A点的Y轴坐标YA与P点Y轴坐标YP不相等,则存储上行障碍点A的坐标(XA,YA)为上行记录点,又由于YA的坐标值小于YP,自移动机器人在A处沿X轴平移M1距离,自移动机器人在平移后首先判断是否可以沿偏移前的行走方向继续行走,此时的原方向即为Y轴正向,如果是,则继续沿Y轴正向行走,如果否,则沿Y轴反向行走,此时自移动机器人显然不能沿Y轴正向行走,因此自移动机器人沿Y轴反向行走,即沿Y轴向下运动。在A点和B1点之间的行走区域内,所有上行障碍点的Y轴坐标均与A点Y轴坐标相同,因此不对该区域内的上行障碍点坐标进行存储,当自移动机器人行走到B1处时,检测到障碍物,同样将B1处的坐标与之前存储的上行记录点坐标进行比较,由于P点和A点的Y坐标大于或等于B1点的Y坐标,所以自移动机器人在B1处沿X轴平移M1距离后移动到B点。此时,在B点,自移动机器人需要判断是否可以沿原来的Y轴方向向上运动,显然此时可以沿原Y轴方向向上运动,因此自移动机器人继续运动到C点。当自移动机器人运动到C点时,将C点坐标和之前记录的P点和A点的Y轴坐标进行比较,显然A点的Y轴坐标小于C点的Y轴坐标。以A点为折返点,自移动机器人从C点沿X轴方向移动到与A点X轴坐标相同的D点后沿Y轴方向行走。此时删除A点的记录。随后往复“弓”字形路径从D点运动到E点,在此过程中自移动机器人检测到障碍物时不再存储坐标点,直到运动到E点以后(不包括E点)重新开始存储有效的障碍点。此时,如前所述在B点处一样,自移动机器人需要判断是否可以沿原来的Y轴方向向下运动,如果是,则从E点继续运动到G点;如果否,则沿Y轴向上运动(图中未示出)。随后自G点恢复正常的往复“弓” 字形路径行走。如图3所示,自移动机器人的行走路径为:O→P→Q→A→B→C→D→N→E→G。The coordinates of the upward obstacle point and the descending obstacle point are stored separately from the mobile robot, and the points with the same Y-axis coordinates are stored only once in the up-going obstacle point or the descending obstacle point. Specifically, in conjunction with FIG. 3, the coordinates (X O , Y P ) of the upward obstacle point P are detected when the mobile robot walks to the P point, and there is no uplink record equal to the P-point Y-axis coordinate Y P before the P point. Point, point P is a valid up-going obstacle point, storing P point coordinates as an up-record point, and in the walking area between point P and point A, all the upward obstacle points have the same Y-axis coordinate as the P-point Y-axis coordinate Therefore, the upward obstacle points in the area are invalid upward obstacle points, and the coordinates are not stored. For the same reason, among the downward obstacle points in the area, only the coordinates of the downward obstacle point Q (X Q , Y) Q ) Store. When the self-moving robot walks forward to the A along the Y-axis, when the obstacle is hit, the coordinates of the point (X A , Y A ) are compared with the stored coordinates of the upstream recorded point, and the stored upstream recording point at this time only the point P, because the a point Y coordinate Y a point P Y-axis coordinate Y P are not equal, the coordinates (X-a, Y a) impairment point a is stored in the uplink is an uplink recording point, and because Y a, The coordinate value is less than Y P , and the mobile robot translates the M1 distance along the X axis at A. The self-moving robot first determines whether it can continue to travel along the walking direction before the shift, and the original direction is the Y-axis positive direction. If yes, continue to walk along the Y axis. If not, walk backwards along the Y axis. At this time, the mobile robot obviously cannot travel in the positive direction along the Y axis. Therefore, the mobile robot moves backward along the Y axis. Move down the Y axis. In the walking area between point A and point B1, the Y-axis coordinates of all the upward obstacle points are the same as the A-axis Y-axis coordinates, so the coordinates of the upward obstacle points in the area are not stored, when the self-mobile robot walks to B1 At the time of the detection, the obstacle is detected, and the coordinates at B1 are also compared with the previously stored coordinates of the upper recorded point. Since the Y coordinate of point P and point A is greater than or equal to the Y coordinate of point B1, the self-moving robot is at B1. Move the M1 distance along the X axis and move to point B. At this point, at point B, the self-moving robot needs to determine whether it can move upward along the original Y-axis direction. Obviously, it can move upward along the original Y-axis direction, so the self-moving robot continues to move to point C. When moving from the mobile robot to point C, the C point coordinates are compared with the previously recorded P point and the Y axis coordinate of point A, and it is obvious that the Y axis coordinate of point A is smaller than the Y axis coordinate of point C. The point A is used as the turning point, and the moving robot moves from the point C in the X-axis direction to the point D which is the same as the X-axis coordinate of the point A, and then travels in the Y-axis direction. The record of point A is deleted at this time. Then the reciprocating "bow" shaped path moves from point D to point E. During this process, the coordinate point is no longer stored when the mobile robot detects the obstacle, until the movement to point E (excluding point E) restarts the storage. Obstacles. At this point, as described above at point B, the self-moving robot needs to determine whether it can move downward along the original Y-axis direction, and if so, continue moving from point E to point G; if not, along the Y-axis Move up (not shown). Then resume the normal reciprocating "bow" shaped path from point G. As shown in FIG. 3, the walking path of the self-moving robot is: O→P→Q→A→B→C→D→N→E→G.
实施例二与实施例一相比,存在两点差异。第一:对自移动机器人沿Y轴行走的方向限定了上行和下行的概念,当自移动机器人沿Y轴正向行走时,上行障碍点中Y轴坐标相同的障碍点坐标无需全部存储,只是将Y轴坐标不同的障碍点存储下来,形成记录点即可。在自移动机器人的运动过程中,只需判断之前存储的上行记录点中,是否存在某一记录点的Y轴坐标比当前障碍点的Y轴坐标小,如果有,自移动机器人从当前障碍点回到该记录点X轴坐标处;如果无,自移动机器人从当前障碍点沿X轴平移M1距离。第二:当自移动机器人检测到障碍物平移M1距离后,增加了对自移动机器人是否可以按照平移前的行走方向继续行走的判断,如果是,则按照平移前的行走方向继续行走,如果否,则按照平移前行走方向的反向行走。在本实施例中增加这样的判断步骤,可以进一步简化行走路径,提高自移动机器人的工作效率。Compared with the first embodiment, the second embodiment has two differences. First: the concept of up and down is defined for the direction in which the mobile robot travels along the Y axis. When the mobile robot is walking in the positive direction along the Y axis, the coordinates of the obstacle points with the same Y coordinate in the upward obstacle point need not be stored, but only The obstacle points with different Y-axis coordinates are stored to form a recording point. During the movement of the self-moving robot, it is only necessary to judge whether the Y-axis coordinate of a certain recording point is smaller than the Y-axis coordinate of the current obstacle point in the previously recorded upstream recording point, and if so, the self-moving robot from the current obstacle point Return to the X-axis coordinate of the record point; if not, the self-moving robot translates the M1 distance along the X-axis from the current obstacle point. Second: when the mobile robot detects the obstacle M1 distance, it adds a judgment on whether the self-mobile robot can continue walking according to the walking direction before the translation, and if so, continues to walk according to the walking direction before the translation, if no , then walk in the opposite direction of the walking direction before translation. Adding such a judging step in the present embodiment can further simplify the walking path and improve the working efficiency of the self-mobile robot.
需要说明的是,尽管在本实施例中对自移动机器人沿Y轴行走的方向限定了上行和下行的概念,且为了减少数据存储量,对上行障碍点或下行障碍点中Y轴坐标相同的障碍点仅存储一次,但对所有障碍点坐标均进行存储同样可以实现图3所示的行走路径。另外,为了优化行走路径,本实施例自移动机器人检测到障碍物平移M1距离后优先沿平移前的行走方向行走,但本实施例中的避障行走方法并不局限于该限制条件,例如,除去该限制条件,自移动机器人始终按照往复“弓”字形路径行走可以完成图2所示的行走路径。It should be noted that although in the present embodiment, the concept of the uplink and the downlink is defined for the direction in which the mobile robot travels along the Y axis, and in order to reduce the amount of data storage, the Y coordinate of the uplink obstacle point or the downlink obstacle point is the same. The obstacle point is stored only once, but the travel path shown in Fig. 3 can also be realized by storing all the obstacle point coordinates. In addition, in order to optimize the walking path, the mobile robot moves the M1 distance of the obstacle after the obstacle is moved, and the walking obstacle is not limited to the limiting condition, for example, Excluding the restriction condition, the walking path shown in FIG. 2 can be completed since the mobile robot always walks in a reciprocating "bow" shape path.
实施例三Embodiment 3
图4为本发明实施例三自移动机器人避障行走示意图。如图4所示,本实施例是在前述两个实施例基础上的进一步优化。当自移动机器人在A点处碰到障碍物后,记录该点坐标,运动到C点又碰到障碍物,而A点的Y轴坐标值小于C点的Y轴坐标值,自移动机器人按照之前的控制方法,以A点为折返点,本来应当在C点处沿X轴方向运动到与A点X轴坐标相同的位置,但检测到障碍物M的阻挡,此时,删除折返点A点的坐标,从C点沿Y轴向下运动到B点,在B点沿X轴平移M1距离后到D点,自D点恢复正常的往复“弓”字形路径行走。如图4所示,自移动机器人的行走路径为:A→B→C→B→D。4 is a schematic diagram of an obstacle avoidance walking of a self-mobile robot according to an embodiment of the present invention. As shown in Fig. 4, this embodiment is a further optimization based on the foregoing two embodiments. When the mobile robot encounters an obstacle at point A, the coordinates of the point are recorded, and the motion moves to point C and encounters an obstacle, and the Y-axis coordinate value of point A is smaller than the Y-axis coordinate value of point C, and the self-moving robot follows In the previous control method, point A is used as the turning point. It should be moved in the X-axis direction at the point C to the same position as the X-axis coordinate of point A, but the blocking of the obstacle M is detected. At this time, the turning point A is deleted. The coordinates of the point move from point C down the Y axis to point B, and at point B, the M1 distance is translated along the X axis to point D, and the normal reciprocating "bow" shaped path is resumed from point D. As shown in FIG. 4, the walking path of the self-moving robot is: A→B→C→B→D.
实施例三进一步增加了自移动机器人在沿Y轴或X轴方向行走过程中,根据控制方法需要转向时遇到障碍物后,进一步的判断和控制步骤,对实施例一、二中提供的 控制方法进行完善。The third embodiment further increases the step of further judging and controlling the self-moving robot during the walking along the Y-axis or the X-axis direction, and the obstacles are required to be turned according to the control method, and the steps provided in the first and second embodiments are provided. The control method is improved.
在上述的三个实施例中,只对自移动机器人沿Y轴方向行走的避障方法进行了描述,显然,当自移动机器人沿X轴方向行走时,上述的方法同样适用。另外,以水平方向为X轴和以竖直方向为Y轴建立直角坐标系方便进行行走路径说明,但本发明并非仅限于水平方向和竖直方向,还可以其它相垂直的两方向建立坐标系,如东西方向和南北方向。In the above three embodiments, only the obstacle avoidance method of walking from the mobile robot in the Y-axis direction has been described. Obviously, the above method is also applicable when the self-moving robot walks in the X-axis direction. In addition, the rectangular coordinate system is established in the horizontal direction as the X-axis and the vertical direction as the Y-axis to facilitate the description of the walking path, but the present invention is not limited to the horizontal direction and the vertical direction, and the coordinate system can be established in other two perpendicular directions. , such as east-west direction and north-south direction.
综合上述,本发明提供一种自移动机器人避障行走方法,在所述自移动机器人的行走区域内,以水平方向为X轴,竖直方向为Y轴建立平面直角坐标系,该方法具体包括如下步骤:In summary, the present invention provides a self-moving robot obstacle avoiding walking method. In the walking region of the self-moving robot, a plane rectangular coordinate system is established with a horizontal direction as an X axis and a vertical direction as a Y axis. The method specifically includes The following steps:
步骤100:自移动机器人沿Y轴行走,当自移动机器人沿Y轴正向行走检测到障碍物时,设该位置障碍点为上行障碍点,存储有效的上行障碍点为上行记录点;当自移动机器人沿Y轴反向行走检测到障碍物时,设该位置障碍点为下行障碍点,存储有效的下行障碍点为下行记录点;Step 100: The mobile robot walks along the Y axis. When the mobile robot detects the obstacle along the Y axis, the obstacle point is the upward obstacle point, and the effective uplink obstacle point is the uplink recording point; When the mobile robot detects the obstacle along the Y-axis, the obstacle point is the downward obstacle point, and the effective downlink obstacle point is the downlink recording point;
步骤200:将上行记录点和下行记录点根据存储的先后顺序分为当前上行记录点和在先上行记录点、当前下行记录点和在先下行记录点;Step 200: Divide the uplink record point and the downlink record point into the current uplink record point and the previous uplink record point, the current downlink record point, and the previous downlink record point according to the stored sequence;
步骤300:若所述当前障碍点为上行障碍点,判断当前的上行障碍点之前是否存在一在先上行记录点,且该在先上行记录点在Y轴上的坐标小于当前的上行障碍点在Y轴上的坐标;若所述当前障碍点为下行障碍点,判断当前的下行障碍点之前是否存在一在先下行记录点,且该在先下行记录点在Y轴上的坐标大于当前的下行障碍点在Y轴上的坐标;Step 300: If the current obstacle point is an uplink obstacle point, determine whether there is a previous uplink recording point before the current uplink obstacle point, and the coordinate of the previous uplink recording point on the Y axis is smaller than the current uplink obstacle point. The coordinate on the Y axis; if the current obstacle point is a downward obstacle point, it is determined whether there is a previous downlink recording point before the current downlink obstacle point, and the coordinate of the previous downlink recording point on the Y axis is greater than the current downlink The coordinates of the obstacle point on the Y axis;
步骤400:若判断结果为是,则该在先上行记录点或在先下行记录点为折返点,自移动机器人在该障碍点处沿X轴朝折返点方向行走至折返点X轴坐标处,删除折返点坐标,执行该点到当前障碍点之间区域的遍历行走后,返回步骤100;若判断结果为否,自移动机器人沿X轴移动一个位移量M1;Step 400: If the determination result is yes, the previous uplink recording point or the previous downward recording point is a turning point, and the mobile robot walks along the X axis toward the turning point in the obstacle point to the X-axis coordinate of the turning point. Deleting the turning point coordinates, performing the traversal walking of the area between the current obstacle point, and returning to step 100; if the judgment result is no, the self-moving robot moves a displacement amount M1 along the X axis;
步骤500:自移动机器人沿原Y轴行走方向的反向行走,返回步骤100;Step 500: The mobile robot moves in the reverse direction of the original Y-axis walking direction, and returns to step 100;
步骤600:循环步骤100至步骤500,直至完成行走区域的遍历行走。Step 600: Cycle step 100 to step 500 until the traversal walking of the walking area is completed.
所述步骤100具体还包括:The step 100 specifically includes:
若当前上行障碍点与任一在先上行记录点Y轴坐标均不相同,则该上行障碍点为有效的上行障碍点;若当前下行障碍点与任一在先下行记录点Y轴坐标均不相同,则该下行障碍点为有效的下行障碍点。If the current obstacle obstacle point is not the same as the Y coordinate of any preceding uplink record point, the upside obstacle point is a valid up obstacle point; if the current downhole obstacle point and any previous down record point Y coordinate are not The same, the downside obstacle point is a valid downside obstacle point.
或者,所述步骤100具体还包括: Alternatively, the step 100 specifically includes:
任一上行障碍点均为有效上行障碍点;任一下行障碍点均为有效下行障碍点。Any upside obstacle points are effective upside obstacle points; any downside obstacle points are effective downside obstacle points.
所述步骤400具体还包括:若判断结果为是,比较所有满足判断条件的上行记录点或下行记录点中X轴坐标与该障碍点处X轴坐标的差值,以差值最大的上行记录点或下行记录点为折返点。The step 400 specifically includes: if the judgment result is yes, compare the difference between the X-axis coordinate of the uplink record point or the downlink record point satisfying the judgment condition and the X-axis coordinate of the obstacle point, and use the difference record with the largest difference. The point or down record point is the foldback point.
所述步骤400具体还包括,若判断结果为是,删除所有满足判断条件的上行记录点或下行记录点坐标。The step 400 specifically includes: if the determination result is yes, delete all the uplink record points or the downlink record point coordinates that satisfy the judgment condition.
所述步骤400具体还包括:如果自移动机器人还未走到折返点X轴坐标处再次检测到障碍物,则删除折返点坐标后进入步骤500。The step 400 specifically includes: if the obstacle is detected again after the mobile robot has not reached the X-axis coordinate of the turning point, the folding point coordinates are deleted and the process proceeds to step 500.
在所述步骤400中,机器人执行从折返点到当前障碍点之间区域的遍历行走的行走方式与步骤600中完成行走区域的遍历行走的行走方式相同。In the step 400, the walking manner in which the robot performs the traversal walking from the turning point to the current obstacle point is the same as the walking manner in the step 600 in which the traversing walking of the walking area is completed.
所述步骤400后还包括步骤410:判断自移动机器人是否可以沿原Y轴行走方向行走,若判断结果为是,则自移动机器人沿原Y轴行走方向行走,返回步骤100;若判断结果为否,则进入步骤500。After the step 400, the method further includes a step 410: determining whether the self-moving robot can walk along the original Y-axis walking direction. If the determination result is yes, the self-moving robot walks along the original Y-axis walking direction, and returns to step 100; Otherwise, proceed to step 500.
所述步骤410判断自移动机器人是否可以沿原Y轴行走方向行走的具体内容为:The step 410 determines whether the specific content of the mobile robot can walk along the original Y-axis walking direction is:
自移动机器人先沿原Y轴行走方向行走,若行走一段距离后未检测到障碍物,则判断自移动机器人可以沿原Y轴行走方向行走,否则,判断自移动机器人不可以沿原Y轴行走方向行走。The self-moving robot first walks along the original Y-axis walking direction. If no obstacle is detected after walking for a certain distance, it is judged that the self-moving robot can walk along the original Y-axis walking direction. Otherwise, it is judged that the self-moving robot cannot walk along the original Y-axis. Walking in the direction.
自移动机器人的侧部设有侧视传感器,所述步骤410判断自移动机器人是否可以沿原Y轴行走方向行走的具体内容为:自移动机器人根据侧视传感器的反馈信号判断是否可以沿原Y轴行走方向行走。The side view sensor is provided on the side of the mobile robot. The step 410 determines whether the self-moving robot can walk along the original Y-axis travel direction: the self-mobile robot judges whether it can be along the original Y according to the feedback signal of the side-view sensor. The axis travels in the direction of walking.
将图1与图2至4对比可知,本发明的优点在于,当自移动机器人在作业行走过程中遇到障碍物时,可以通过对坐标的判断一次性躲避,分别完成对障碍物四周与行走区域边界之间区域的作业;而现有技术则需要在作业过程中反复躲避围绕障碍物行走。因此,本发明对障碍物位置判断明确,行走路线简洁,大大提高了自移动机器人的工作效率。 Comparing FIG. 1 with FIG. 2 to FIG. 4, the advantage of the present invention is that when the self-moving robot encounters an obstacle during the walking of the work, the obstacle can be avoided by the judgment of the coordinate, and the obstacle is surrounded and walked separately. The work in the area between the boundaries of the area; the prior art requires repeated avoidance of walking around the obstacle during the operation. Therefore, the present invention has a clear judgment on the position of the obstacle, and the walking route is simple, which greatly improves the working efficiency of the self-mobile robot.

Claims (11)

  1. 一种自移动机器人避障行走方法,在所述自移动机器人的行走区域内,以水平方向为X轴,竖直方向为Y轴建立平面直角坐标系,其特征在于,该方法具体包括如下步骤:A self-moving robot obstacle avoidance walking method, in which a horizontal coordinate is an X-axis and a vertical direction is a Y-axis to establish a plane rectangular coordinate system in the walking region of the self-moving robot, wherein the method specifically includes the following steps :
    步骤100:自移动机器人沿Y轴行走,当自移动机器人沿Y轴正向行走检测到障碍物时,设该位置障碍点为上行障碍点,存储有效的上行障碍点为上行记录点;当自移动机器人沿Y轴反向行走检测到障碍物时,设该位置障碍点为下行障碍点,存储有效的下行障碍点为下行记录点;Step 100: The mobile robot walks along the Y axis. When the mobile robot detects the obstacle along the Y axis, the obstacle point is the upward obstacle point, and the effective uplink obstacle point is the uplink recording point; When the mobile robot detects the obstacle along the Y-axis, the obstacle point is the downward obstacle point, and the effective downlink obstacle point is the downlink recording point;
    步骤200:将上行记录点和下行记录点根据存储的先后顺序分为当前上行记录点和在先上行记录点、当前下行记录点和在先下行记录点;Step 200: Divide the uplink record point and the downlink record point into the current uplink record point and the previous uplink record point, the current downlink record point, and the previous downlink record point according to the stored sequence;
    步骤300:若所述当前障碍点为上行障碍点,判断当前的上行障碍点之前是否存在一在先上行记录点,且该在先上行记录点在Y轴上的坐标小于当前的上行障碍点在Y轴上的坐标;若所述当前障碍点为下行障碍点,判断当前的下行障碍点之前是否存在一在先下行记录点,且该在先下行记录点在Y轴上的坐标大于当前的下行障碍点在Y轴上的坐标;Step 300: If the current obstacle point is an uplink obstacle point, determine whether there is a previous uplink recording point before the current uplink obstacle point, and the coordinate of the previous uplink recording point on the Y axis is smaller than the current uplink obstacle point. The coordinate on the Y axis; if the current obstacle point is a downward obstacle point, it is determined whether there is a previous downlink recording point before the current downlink obstacle point, and the coordinate of the previous downlink recording point on the Y axis is greater than the current downlink The coordinates of the obstacle point on the Y axis;
    步骤400:若判断结果为是,则该在先上行记录点或在先下行记录点为折返点,自移动机器人在该障碍点处沿X轴朝折返点方向行走至折返点X轴坐标处,删除折返点坐标,执行该点到当前障碍点之间区域的遍历行走后,返回步骤100;若判断结果为否,自移动机器人沿X轴移动一个位移量M1;Step 400: If the determination result is yes, the previous uplink recording point or the previous downward recording point is a turning point, and the mobile robot walks along the X axis toward the turning point in the obstacle point to the X-axis coordinate of the turning point. Deleting the turning point coordinates, performing the traversal walking of the area between the current obstacle point, and returning to step 100; if the judgment result is no, the self-moving robot moves a displacement amount M1 along the X axis;
    步骤500:自移动机器人沿原Y轴行走方向的反向行走,返回步骤100;Step 500: The mobile robot moves in the reverse direction of the original Y-axis walking direction, and returns to step 100;
    步骤600:循环步骤100至步骤500,直至完成行走区域的遍历行走。Step 600: Cycle step 100 to step 500 until the traversal walking of the walking area is completed.
  2. 如权利要求1所述的自移动机器人避障行走方法,其特征在于,所述步骤100具体还包括:The self-moving robot obstacle avoidance walking method according to claim 1, wherein the step 100 specifically includes:
    若当前上行障碍点与任一在先上行记录点Y轴坐标均不相同,则该上行障碍点为有效的上行障碍点;若当前下行障碍点与任一在先下行记录点Y轴坐标均不相同,则该下行障碍点为有效的下行障碍点。If the current obstacle obstacle point is not the same as the Y coordinate of any preceding uplink record point, the upside obstacle point is a valid up obstacle point; if the current downhole obstacle point and any previous down record point Y coordinate are not The same, the downside obstacle point is a valid downside obstacle point.
  3. 如权利要求1所述的自移动机器人避障行走方法,其特征在于,所述步骤100具体还包括:The self-moving robot obstacle avoidance walking method according to claim 1, wherein the step 100 specifically includes:
    任一上行障碍点均为有效上行障碍点;任一下行障碍点均为有效下行障碍点。 Any upside obstacle points are effective upside obstacle points; any downside obstacle points are effective downside obstacle points.
  4. 如权利要求3所述的自移动机器人避障行走方法,其特征在于,所述步骤400具体还包括:若判断结果为是,比较所有满足判断条件的上行记录点或下行记录点中X轴坐标与该障碍点处X轴坐标的差值,以差值最大的上行记录点或下行记录点为折返点。The self-moving robot obstacle avoidance walking method according to claim 3, wherein the step 400 further comprises: if the determination result is yes, comparing all the X-axis coordinates of the uplink record point or the downlink record point satisfying the judgment condition The difference between the X-axis coordinates of the obstacle point and the upstream record point or the downstream record point with the largest difference is the return point.
  5. 如权利要求4所述的自移动机器人壁障行走方法,其特征在于,所述步骤400具体还包括,若判断结果为是,删除所有满足判断条件的上行记录点或下行记录点坐标。The self-moving robot barrier walking method according to claim 4, wherein the step 400 further comprises: if the determination result is yes, deleting all the coordinates of the upstream record point or the downlink record point satisfying the determination condition.
  6. 如权利要求1所述的自移动机器人避障行走方法,其特征在于,所述步骤400具体还包括:如果自移动机器人还未走到折返点X轴坐标处再次检测到障碍物,则删除折返点坐标后进入步骤500。The self-moving robot obstacle avoidance walking method according to claim 1, wherein the step 400 specifically includes: deleting the foldback if the obstacle is detected again from the X-axis coordinate of the returning point of the returning robot. After the point coordinates, the process proceeds to step 500.
  7. 如权利要求1所述的自移动机器人避障行走方法,其特征在于,在所述步骤400中,机器人执行从折返点到当前障碍点之间区域的遍历行走的行走方式与步骤600中完成行走区域的遍历行走的行走方式相同。The self-moving robot obstacle avoidance walking method according to claim 1, wherein in the step 400, the robot performs a walking manner of traversing walking from the turning point to the current obstacle point and completing the walking in step 600. The traversal walking of the area walks in the same way.
  8. 如权利要求1-7任一项所述的自移动机器人避障行走方法,其特征在于,所述步骤400后还包括步骤410:判断自移动机器人是否可以沿原Y轴行走方向行走,若判断结果为是,则自移动机器人沿原Y轴行走方向行走,返回步骤100;若判断结果为否,则进入步骤500。The self-moving robot obstacle avoidance walking method according to any one of claims 1 to 7, wherein the step 400 further comprises a step 410 of: determining whether the self-moving robot can walk along the original Y-axis walking direction, if judging As a result, the mobile robot travels in the original Y-axis traveling direction, and returns to step 100. If the determination result is negative, the process proceeds to step 500.
  9. 如权利要求8所述的自移动机器人避障行走方法,其特征在于,所述步骤410判断自移动机器人是否可以沿原Y轴行走方向行走的具体内容为:The self-moving robot obstacle avoiding walking method according to claim 8, wherein the step 410 determines whether the self-moving robot can walk along the original Y-axis walking direction:
    自移动机器人先沿原Y轴行走方向行走,若行走一段距离后未检测到障碍物,则判断自移动机器人可以沿原Y轴行走方向行走,否则,判断自移动机器人不可以沿原Y轴行走方向行走。The self-moving robot first walks along the original Y-axis walking direction. If no obstacle is detected after walking for a certain distance, it is judged that the self-moving robot can walk along the original Y-axis walking direction. Otherwise, it is judged that the self-moving robot cannot walk along the original Y-axis. Walking in the direction.
  10. 如权利要求8所述的自移动机器人避障行走方法,其特征在于,自移动机器人的侧部设有侧视传感器,所述步骤410判断自移动机器人是否可以沿原Y轴行走方 向行走的具体内容为:The self-moving robot obstacle avoidance walking method according to claim 8, wherein a side view sensor is provided from a side of the mobile robot, and the step 410 determines whether the self-moving robot can travel along the original Y-axis. The specific content of walking is:
    自移动机器人根据侧视传感器的反馈信号判断是否可以沿原Y轴行走方向行走。The self-moving robot judges whether it is possible to walk along the original Y-axis traveling direction based on the feedback signal of the side-view sensor.
  11. 一种自移动机器人避障行走方法,在所述自移动机器人的行走区域内,以水平方向为X轴,竖直方向为Y轴建立平面直角坐标系,且沿着X轴或Y轴的方向行走为正向行走;A self-moving robot obstacle avoiding walking method, in which the horizontal direction is the X axis and the vertical direction is the Y axis to establish a plane rectangular coordinate system in the walking region of the self-moving robot, and the direction along the X axis or the Y axis Walking for positive walking;
    其特征在于,该方法具体包括如下步骤:The method is characterized in that the method specifically includes the following steps:
    步骤1000:自移动机器人沿Y轴行走,当自移动机器人检测到障碍物时,设该位置为障碍点,存储该位置的坐标形成记录点;Step 1000: The mobile robot walks along the Y axis. When the obstacle is detected by the mobile robot, the position is set as an obstacle point, and the coordinates of the position are stored to form a recording point;
    步骤2000:判断是否在先存储有一记录点,且该记录点在Y轴上的坐标位于当前障碍点与前一障碍点在Y轴向上的坐标所构成的数值区间内;Step 2000: determining whether a record point is stored first, and the coordinate of the record point on the Y axis is within a numerical interval formed by coordinates of the current obstacle point and the previous obstacle point in the Y axis;
    步骤3000:若判断结果为是,则该记录点为折返点,自移动机器人自当前障碍点处沿X轴朝折返点方向行走至折返点X轴坐标处,删除折返点坐标,执行该点到当前障碍点之间区域的遍历行走后,返回步骤1000;Step 3000: If the judgment result is yes, the recording point is a turning point, and the moving robot walks from the current obstacle point along the X axis toward the turning point to the X-axis coordinate of the turning point, deletes the turning point coordinate, and executes the point to After the traversal of the region between the current obstacle points, the process returns to step 1000;
    若判断结果为否,自移动机器人沿X轴移动一个位移量M1;If the judgment result is no, the self-moving robot moves a displacement amount M1 along the X axis;
    步骤4000:自移动机器人沿原Y轴行走方向的反向行走,返回步骤1000;Step 4000: The mobile robot moves in the reverse direction of the original Y-axis walking direction, and returns to step 1000;
    步骤5000:循环步骤1000到步骤4000,直至完成行走区域的Y轴遍历行走。 Step 5000: Loop step 1000 to step 4000 until the Y-axis traverse walk of the walking area is completed.
PCT/CN2015/076510 2014-04-14 2015-04-14 Obstacle avoidance walking method of self-moving robot WO2015158240A1 (en)

Priority Applications (6)

Application Number Priority Date Filing Date Title
US15/304,039 US10248126B2 (en) 2014-04-14 2015-04-14 Obstacle avoidance walking method of self-moving robot
EP15779458.7A EP3133457B1 (en) 2014-04-14 2015-04-14 Obstacle avoidance walking method of self-moving robot
JP2016562594A JP6622215B2 (en) 2014-04-14 2015-04-14 Obstacle avoidance traveling method of self-propelled robot
KR1020167031679A KR102329060B1 (en) 2014-04-14 2015-04-14 Obstacle avoidance walking method of self-moving robot
US16/275,216 US11112800B2 (en) 2014-04-14 2019-02-13 Obstacle avoidance walking method of self-moving robot
US17/393,082 US11768496B2 (en) 2014-04-14 2021-08-03 Obstacle-avoidance moving method of self-moving robot

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
CN201410148490.X 2014-04-14
CN201410148490.XA CN104972462B (en) 2014-04-14 2014-04-14 Obstacle avoidance walking method of self-moving robot

Related Child Applications (2)

Application Number Title Priority Date Filing Date
US15/304,039 A-371-Of-International US10248126B2 (en) 2014-04-14 2015-04-14 Obstacle avoidance walking method of self-moving robot
US16/275,216 Continuation US11112800B2 (en) 2014-04-14 2019-02-13 Obstacle avoidance walking method of self-moving robot

Publications (1)

Publication Number Publication Date
WO2015158240A1 true WO2015158240A1 (en) 2015-10-22

Family

ID=54269697

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2015/076510 WO2015158240A1 (en) 2014-04-14 2015-04-14 Obstacle avoidance walking method of self-moving robot

Country Status (6)

Country Link
US (3) US10248126B2 (en)
EP (1) EP3133457B1 (en)
JP (1) JP6622215B2 (en)
KR (1) KR102329060B1 (en)
CN (1) CN104972462B (en)
WO (1) WO2015158240A1 (en)

Cited By (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US10248126B2 (en) 2014-04-14 2019-04-02 Ecovacs Robotics Co., Ltd. Obstacle avoidance walking method of self-moving robot
CN109753074A (en) * 2019-01-28 2019-05-14 北京猎户星空科技有限公司 A kind of robot cruise control method, device, control equipment and storage medium
US10860029B2 (en) 2016-02-15 2020-12-08 RobArt GmbH Method for controlling an autonomous mobile robot
US11175670B2 (en) 2015-11-17 2021-11-16 RobArt GmbH Robot-assisted processing of a surface using a robot
US11188086B2 (en) 2015-09-04 2021-11-30 RobArtGmbH Identification and localization of a base station of an autonomous mobile robot
US11550054B2 (en) 2015-06-18 2023-01-10 RobArtGmbH Optical triangulation sensor for distance measurement
US11709489B2 (en) 2017-03-02 2023-07-25 RobArt GmbH Method for controlling an autonomous, mobile robot
US11768494B2 (en) 2015-11-11 2023-09-26 RobArt GmbH Subdivision of maps for robot navigation
US11789447B2 (en) 2015-12-11 2023-10-17 RobArt GmbH Remote control of an autonomous mobile robot

Families Citing this family (28)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US9519289B2 (en) 2014-11-26 2016-12-13 Irobot Corporation Systems and methods for performing simultaneous localization and mapping using machine vision systems
US9751210B2 (en) 2014-11-26 2017-09-05 Irobot Corporation Systems and methods for performing occlusion detection
CN106155056B (en) * 2016-07-26 2019-09-03 广东宝乐机器人股份有限公司 Self-movement robot traveling method and device
CN106020207B (en) * 2016-07-26 2019-04-16 广东宝乐机器人股份有限公司 Self-movement robot traveling method and device
CN107340768B (en) * 2016-12-29 2020-08-28 珠海市一微半导体有限公司 Path planning method of intelligent robot
CN106959695B (en) 2017-04-24 2019-08-02 广东宝乐机器人股份有限公司 Angle modification method and mobile robot of the mobile robot in working region
CN107505939B (en) * 2017-05-13 2019-07-12 大连理工大学 A kind of complete coverage path planning method of mobile robot
CN107468160A (en) * 2017-08-10 2017-12-15 宁波菜鸟智能科技有限公司 A kind of wired intellective dust collector cleaning method
CN107314773B (en) * 2017-08-18 2019-10-01 广东宝乐机器人股份有限公司 The map creating method of mobile robot and paths planning method based on the map
CN109425352A (en) * 2017-08-25 2019-03-05 科沃斯机器人股份有限公司 Self-movement robot paths planning method
CN107885213A (en) * 2017-11-22 2018-04-06 广东艾可里宁机器人智能装备有限公司 A kind of sweeping robot indoor navigation system and method
CN107807650A (en) * 2017-11-29 2018-03-16 莱克电气股份有限公司 A kind of motion control method of robot, device and equipment
CN108345303A (en) * 2018-01-24 2018-07-31 五邑大学 A kind of novel electric vehicle charging service system based on guiding band and robot
CN108958243A (en) * 2018-06-27 2018-12-07 芜湖市越泽机器人科技有限公司 A kind of robot avoiding barrier control method
CN109077674A (en) * 2018-06-28 2018-12-25 芜湖泰领信息科技有限公司 The automatic obstacle-avoiding method and intelligent sweeping machine of sweeper
CN109582015B (en) * 2018-11-07 2020-11-20 深圳乐动机器人有限公司 Indoor cleaning planning method and device and robot
CN109634276B (en) * 2018-12-13 2021-05-25 中联重科股份有限公司 Agricultural vehicle unmanned control method and system and agricultural vehicle
CN111347415B (en) * 2018-12-21 2021-08-13 广东宝乐机器人股份有限公司 Window cleaning robot movement control method, window cleaning robot movement control system and window cleaning robot
CN112276933A (en) * 2019-07-24 2021-01-29 广东宝乐机器人股份有限公司 Control method of mobile robot and mobile robot
CN112493924B (en) * 2019-08-26 2023-03-10 苏州宝时得电动工具有限公司 Cleaning robot and control method thereof
CN111061263B (en) * 2019-11-27 2023-11-28 小狗电器互联网科技(北京)股份有限公司 Robot obstacle-cleaning and winding method and sweeping robot
CN112549033B (en) * 2020-12-15 2022-12-02 灵动科技(北京)有限公司 Trajectory control method and device, robot and storage medium
SE2150497A1 (en) * 2021-04-22 2022-10-23 Husqvarna Ab Improved obstacle handling for a robotic work tool
CN113296099B (en) * 2021-05-21 2023-09-01 福建盛海智能科技有限公司 Method and terminal for automatically generating avoidance path according to obstacle
CN113589806A (en) * 2021-07-21 2021-11-02 珠海一微半导体股份有限公司 Strategy control method for robot walking in Chinese character' gong
CN114259187B (en) * 2021-12-15 2023-04-07 华帝股份有限公司 Cleaning equipment control method and cleaning equipment
CN114578348B (en) * 2022-05-05 2022-07-29 深圳安德空间技术有限公司 Autonomous intelligent scanning and navigation method for ground penetrating radar based on deep learning
CN115268470B (en) * 2022-09-27 2023-08-18 深圳市云鼠科技开发有限公司 Obstacle position marking method, device and medium for cleaning robot

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5353224A (en) * 1990-12-07 1994-10-04 Goldstar Co., Ltd. Method for automatically controlling a travelling and cleaning operation of vacuum cleaners
US20050273967A1 (en) * 2004-03-11 2005-12-15 Taylor Charles E Robot vacuum with boundary cones
CN102541056A (en) * 2010-12-16 2012-07-04 莱克电气股份有限公司 Obstacle processing method for robot

Family Cites Families (25)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS6093522A (en) * 1983-10-26 1985-05-25 Ootomatsukusu Kk Controller of moving robot
JP3401023B2 (en) * 1991-11-22 2003-04-28 日本輸送機株式会社 Unmanned vehicle control method
JPH05257533A (en) * 1992-03-12 1993-10-08 Tokimec Inc Method and device for sweeping floor surface by moving robot
US6574536B1 (en) * 1996-01-29 2003-06-03 Minolta Co., Ltd. Moving apparatus for efficiently moving on floor with obstacle
US5890250A (en) * 1996-02-02 1999-04-06 Sky Robitics, Inc. Robotic washing apparatus
IL124413A (en) * 1998-05-11 2001-05-20 Friendly Robotics Ltd System and method for area coverage with an autonomous robot
GB2344900A (en) 1998-12-18 2000-06-21 Notetry Ltd Robotic floor cleaning device with obstacle detection
US8412377B2 (en) * 2000-01-24 2013-04-02 Irobot Corporation Obstacle following sensor scheme for a mobile robot
CN1129053C (en) * 2001-01-15 2003-11-26 泰怡凯电器(苏州)有限公司 Method for recognizing cleanable region and barrier region of automatic duster
CN1287722C (en) * 2002-06-21 2006-12-06 泰怡凯电器(苏州)有限公司 Method for identifying automatic dust collector cleanable area and obstacle area
US20050010331A1 (en) * 2003-03-14 2005-01-13 Taylor Charles E. Robot vacuum with floor type modes
JP2004275468A (en) * 2003-03-17 2004-10-07 Hitachi Home & Life Solutions Inc Self-traveling vacuum cleaner and method of operating the same
FR2861855B1 (en) * 2003-11-03 2006-06-30 Wany Sa METHOD AND DEVICE FOR SCANNING A SURFACE STATISTICALLY
JP2005211367A (en) 2004-01-30 2005-08-11 Funai Electric Co Ltd Autonomous traveling robot cleaner
JP2006113952A (en) 2004-10-18 2006-04-27 Funai Electric Co Ltd Charging type travel system
KR20080075051A (en) * 2007-02-10 2008-08-14 삼성전자주식회사 Robot cleaner and control method thereof
KR101281512B1 (en) * 2007-04-06 2013-07-03 삼성전자주식회사 Robot cleaner and control method thereof
KR100963781B1 (en) * 2008-03-31 2010-06-14 엘지전자 주식회사 Controlling method of robot cleaner
BR112012010612A2 (en) * 2009-11-06 2017-08-15 Evolution Robotics Inc MOBILE DEVICE CONFIGURED FOR SURFACE NAVIGATION AND METHOD FOR SURFACE NAVIGATION WITH MOBILE DEVICE
KR101081927B1 (en) * 2010-05-15 2011-11-09 주식회사 일심글로발 Window cleaning apparatus and method for controlling the apparatus's moving
TWM451103U (en) * 2012-10-30 2013-04-21 Agait Technology Corp Walking device
KR102116285B1 (en) * 2013-11-29 2020-06-05 삼성전자주식회사 Cleaning robot and control method thereof
CN110543168B (en) * 2014-04-14 2022-10-04 科沃斯机器人股份有限公司 Walking method of self-moving robot and walking method of sweeping robot
CN104972462B (en) 2014-04-14 2017-04-19 科沃斯机器人股份有限公司 Obstacle avoidance walking method of self-moving robot
CN111419121B (en) * 2014-07-01 2022-11-29 三星电子株式会社 Cleaning robot and control method thereof

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5353224A (en) * 1990-12-07 1994-10-04 Goldstar Co., Ltd. Method for automatically controlling a travelling and cleaning operation of vacuum cleaners
US20050273967A1 (en) * 2004-03-11 2005-12-15 Taylor Charles E Robot vacuum with boundary cones
CN102541056A (en) * 2010-12-16 2012-07-04 莱克电气股份有限公司 Obstacle processing method for robot

Cited By (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US10248126B2 (en) 2014-04-14 2019-04-02 Ecovacs Robotics Co., Ltd. Obstacle avoidance walking method of self-moving robot
US11112800B2 (en) 2014-04-14 2021-09-07 Ecovacs Robotics Co., Ltd. Obstacle avoidance walking method of self-moving robot
US11768496B2 (en) 2014-04-14 2023-09-26 Ecovacs Robotics Co., Ltd. Obstacle-avoidance moving method of self-moving robot
US11550054B2 (en) 2015-06-18 2023-01-10 RobArtGmbH Optical triangulation sensor for distance measurement
US11188086B2 (en) 2015-09-04 2021-11-30 RobArtGmbH Identification and localization of a base station of an autonomous mobile robot
US11768494B2 (en) 2015-11-11 2023-09-26 RobArt GmbH Subdivision of maps for robot navigation
US11175670B2 (en) 2015-11-17 2021-11-16 RobArt GmbH Robot-assisted processing of a surface using a robot
US11789447B2 (en) 2015-12-11 2023-10-17 RobArt GmbH Remote control of an autonomous mobile robot
US10860029B2 (en) 2016-02-15 2020-12-08 RobArt GmbH Method for controlling an autonomous mobile robot
US11709497B2 (en) 2016-02-15 2023-07-25 RobArt GmbH Method for controlling an autonomous mobile robot
US11709489B2 (en) 2017-03-02 2023-07-25 RobArt GmbH Method for controlling an autonomous, mobile robot
CN109753074A (en) * 2019-01-28 2019-05-14 北京猎户星空科技有限公司 A kind of robot cruise control method, device, control equipment and storage medium

Also Published As

Publication number Publication date
CN104972462A (en) 2015-10-14
US20170083022A1 (en) 2017-03-23
EP3133457A4 (en) 2018-01-03
US11112800B2 (en) 2021-09-07
US10248126B2 (en) 2019-04-02
JP2017511549A (en) 2017-04-20
CN104972462B (en) 2017-04-19
US11768496B2 (en) 2023-09-26
US20210365030A1 (en) 2021-11-25
KR102329060B1 (en) 2021-11-19
EP3133457A1 (en) 2017-02-22
JP6622215B2 (en) 2019-12-18
US20190179321A1 (en) 2019-06-13
EP3133457B1 (en) 2019-01-02
KR20170008745A (en) 2017-01-24

Similar Documents

Publication Publication Date Title
WO2015158240A1 (en) Obstacle avoidance walking method of self-moving robot
JP2017511549A5 (en)
CN107390698B (en) Supplementary sweeping method and chip of sweeping robot
US11774980B2 (en) Method for controlling cleaning of robot, chip, and robot cleaner
CN110338715B (en) Method and chip for cleaning floor by intelligent robot and cleaning robot
US20230309776A1 (en) Method for Controlling Cleaning Based on Dense Obstacles
WO2021248846A1 (en) Robot edge treading areal sweep planning method, chip, and robot
WO2021008611A1 (en) Robot trapping detection and de-trapping method
CN107491069B (en) Processing method and chip for robot encountering barrier
US20170075353A1 (en) Local obstacle avoidance walking method of self-moving robot
US20190129433A1 (en) A path planning method of intelligent robot
CN111603099A (en) Cleaning planning method with region traversal priority and chip
CN107505942B (en) Processing method and chip for detecting obstacle by robot
CN106155056A (en) Self-movement robot traveling method and device
CN110477813B (en) Laser type cleaning robot and control method thereof
JP2022506296A (en) Cleaning robot path cleaning method, system and tip
CN113031616A (en) Cleaning robot return path planning method and system and cleaning robot
CN108931980B (en) Marking method and chip of robot built-in map and indoor cleaning robot
KR101970191B1 (en) Apparatus and method for controlling cleaning function and robotic cleaner with the apparatus
WO2024037260A1 (en) Control method of cleaning device, cleaning device, and storage medium
GB2613620A (en) Method for edge cleaning
GB2615512A (en) Method for edge cleaning

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 15779458

Country of ref document: EP

Kind code of ref document: A1

ENP Entry into the national phase

Ref document number: 2016562594

Country of ref document: JP

Kind code of ref document: A

NENP Non-entry into the national phase

Ref country code: DE

ENP Entry into the national phase

Ref document number: 20167031679

Country of ref document: KR

Kind code of ref document: A

REEP Request for entry into the european phase

Ref document number: 2015779458

Country of ref document: EP

WWE Wipo information: entry into national phase

Ref document number: 2015779458

Country of ref document: EP

WWE Wipo information: entry into national phase

Ref document number: 15304039

Country of ref document: US