A robot heading correction method, device and robot
By monitoring the positional relationship between the robot and the target baseline and adjusting the heading parameters, the problem of robot navigation deviation is solved and the accuracy of work is ensured.
Patent Information
- Application Number
- CN202111056990.7
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2021-09-09
- Publication Date
- 2024-11-08
- Estimated Expiration
- 2041-09-09
AI Technical Summary
When the robot returns to the charging base station, it is prone to navigation deviation, resulting in abnormal navigation position calculation and working parameters.
By monitoring the positional relationship between the robot and the target baseline, determine whether it is deviated, and obtain the deviation angle, adjust the robot's working heading parameters to correct the deviation.
It realizes correction of deviations during the robot's work process and ensures the accurate work of the robot.
Smart Images

Figure CN113848891B_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the field of robot technology, and more specifically, to a robot heading correction method, device and robot. Background Art
[0002] With the development of artificial intelligence, robots have been widely used in more and more fields. In use, most of the robots have realized the automatic charging function, that is, the robot can automatically enter the charging base station to charge after use, and continue to perform the pre-set work after charging. The pre-charging and post-charging processing processes are set through pre-planning. In the process of pre-planning the use of the robot, it is inevitable that during the actual operation, due to errors or accidents in the operation of the machine itself, the robot's navigation route is not the pre-set route when returning to the base station, for example, it is not parallel to the base station. When leaving the base station, there will be navigation deviations, resulting in the navigation position calculation being inconsistent with the actual position during the robot's operation, and abnormal working parameters. Summary of the invention
[0003] The technical problem to be solved by the present invention is to provide a robot heading correction method, device and robot in view of the above-mentioned technical defects of the prior art.
[0004] The technical solution adopted by the present invention to solve the technical problem is: construct a robot heading correction method, which is characterized by comprising the following steps:
[0005] S1, control the robot to exit the charging base station;
[0006] S2. During the movement of the robot, the positional relationship between the robot and the target baseline is monitored through monitoring points to determine whether the robot deviates from the target baseline according to the positional relationship; wherein the target baseline is used to set a preset exit path for the robot;
[0007] S3. When it is determined that the robot deviates from the target baseline, control the robot to stop moving in the current direction, and obtain a first distance between the robot and the charging base station;
[0008] S4, obtaining a vertical distance between the monitoring point and a target alignment line of the robot as a second distance, wherein the target alignment line is used to align with the target baseline when the robot moves along the preset exit path;
[0009] S5. Acquire a deviation angle of the robot according to the first distance and the second distance, so as to adjust a working heading parameter of the robot according to the deviation angle during the working process of the robot.
[0010] Preferably, the target reference line comprises a closed loop surrounding the boundary of the target working area;
[0011] In step S3, the robot deviates from the target baseline including:
[0012] The robot is inside the closed loop or outside the closed loop.
[0013] Preferably, the monitoring points include a first monitoring point and a second monitoring point respectively placed on both sides of the target alignment line;
[0014] In the step S2, the monitoring of the positional relationship between the robot and the target reference line through the monitoring point includes:
[0015] Acquire the positional relationship between the first monitoring point, the second monitoring point and the closed loop;
[0016] When one of the first monitoring point and the second monitoring point is within the closed loop, it is determined that the robot is within the closed loop when the other monitoring point enters the closed loop;
[0017] The vertical distance between the monitoring point entering the closed loop after acquisition and the target alignment line is the second distance;
[0018] or
[0019] When one of the first monitoring point and the second monitoring point is outside the closed loop, and the other monitoring point enters outside the closed loop, it is determined that the robot is outside the closed loop;
[0020] The vertical distance between the monitoring point that enters the closed loop after acquisition and the target alignment line is the second distance.
[0021] Preferably, the first monitoring point and the second monitoring point are symmetrically arranged along the target alignment line; and / or
[0022] The first monitoring point and the second monitoring point are both boundary sensors arranged on the robot body.
[0023] Preferably, in step S5, adjusting the working heading parameter of the robot according to the deviation angle includes:
[0024] When the robot is in the closed loop, the robot deviates from the deviation angle in a first direction, wherein the first direction is opposite to the circling direction of the closed loop;
[0025] When the robot is outside the closed loop, it deviates from the deviation angle in a second direction, where the second direction is the same as the circumferential direction of the closed loop.
[0026] Preferably, the robot heading correction method of the present invention further includes:
[0027] S21, obtaining the real-time distance between the robot and the charging base station;
[0028] S22. When it is determined that the robot has not deviated from the target baseline, determine whether the real-time distance is less than a preset distance. If so, execute step S2; if not, end the heading correction.
[0029] Preferably, in the step S21, the obtaining of the real-time distance between the robot and the charging base station comprises:
[0030] The number of pulses corresponding to the internal motor of the robot since leaving the station is recorded, so as to obtain the real-time distance between the robot and the charging base station according to the number of pulses.
[0031] In addition, the present invention also constructs a robot heading correction device, comprising:
[0032] A first execution unit, used to control the robot to exit the charging base station;
[0033] A second execution unit is used to monitor the positional relationship between the robot and a target baseline through monitoring points during the movement of the robot, wherein the target baseline is used to set a preset exit path of the robot;
[0034] A first judging unit, configured to judge whether the robot deviates from the target reference line according to the positional relationship, and output a positive result when it is judged that the robot deviates from the target reference line;
[0035] a third execution unit, configured to control the robot to stop moving in a current direction and obtain a distance between the current position of the robot and the charging base station as a first distance when the first judgment unit outputs a positive result;
[0036] a first acquisition unit, configured to acquire a vertical distance between the monitoring point and a target alignment line of the robot as a second distance, wherein the target alignment line is used to align with the target reference line when the robot moves along the preset exit path;
[0037] The fourth execution unit is used to obtain the deviation angle of the robot according to the first distance and the second distance, so as to adjust the working heading parameters of the robot according to the deviation angle during the working process of the robot.
[0038] Preferably, the target reference line comprises a closed loop surrounding the boundary of the target working area;
[0039] The first judgment unit is used to determine whether the robot is inside the closed loop or outside the closed loop to determine whether the robot deviates from the target reference line.
[0040] Preferably, the fourth execution unit includes a first adjustment unit and a second adjustment unit;
[0041] The first adjustment unit is used to deviate from the deviation angle along a first direction when the robot is in the closed loop, and the first direction is opposite to the circling direction of the closed loop;
[0042] The second adjustment unit is used for deviating from the deviation angle along a second direction when the robot is outside the closed loop, and the second direction is the same as the circling direction of the closed loop.
[0043] Preferably, the robot heading correction device of the present invention further includes a second acquisition unit and a second judgment unit;
[0044] The second acquisition unit is used to acquire the real-time position of the robot to acquire the real-time distance between the robot and the charging base station;
[0045] The first judgment unit is further configured to output a negative result when determining that the robot has not deviated from the target baseline;
[0046] The second judgment unit is used to judge whether the real-time distance is less than the preset distance when the first judgment unit outputs a negative result, and drive the second execution unit to act when an affirmative result is output, and end the heading correction when a negative result is output.
[0047] In addition, the present invention also constructs a robot, including a memory and a processor;
[0048] The memory is used to store computer programs;
[0049] The processor is used to execute the computer program to implement the robot heading correction method as described in any one of the above.
[0050] A robot heading correction method, device and robot implementing the present invention have the following beneficial effects: achieving deviation correction during the robot's working process and ensuring the robot's accurate working. BRIEF DESCRIPTION OF THE DRAWINGS
[0051] The present invention will be further described below with reference to the accompanying drawings and embodiments, in which:
[0052] Figure 1 It is a program flow chart of an embodiment of a robot heading correction method of the present invention;
[0053] Figure 2It is a process schematic diagram of a first embodiment of a robot heading correction method of the present invention;
[0054] Figure 3 is a program flow chart of another embodiment of a robot heading correction method of the present invention;
[0055] Figure 4 yes Figure 3 A schematic diagram of the process of the embodiment;
[0056] Figure 5 is a program flow chart of another embodiment of a robot heading correction method of the present invention;
[0057] Figure 6 yes Figure 5 A schematic diagram of the process of the embodiment;
[0058] Figure 7 is a program flow chart of another embodiment of a robot heading correction method of the present invention;
[0059] Figure 8 It is a logic block diagram of an embodiment of a robot heading correction device of the present invention;
[0060] Fig. 9 It is a logic block diagram of another embodiment of a robot heading correction device of the present invention. DETAILED DESCRIPTION
[0061] In order to have a clearer understanding of the technical features, purposes and effects of the present invention, specific embodiments of the present invention are now described in detail with reference to the accompanying drawings.
[0062] like Figure 1As shown, in a first embodiment of a robot heading correction method of the present invention, the following steps are included: S1, controlling the robot to exit the charging base station; S2, during the movement of the robot, monitoring the positional relationship between the robot and the target baseline through the monitoring point, so as to determine whether the robot deviates from the target baseline according to the positional relationship; wherein the target baseline is used to set the preset exit path of the robot; specifically, the robot can be controlled to exit charging after the base station is charged, that is, the robot exits the charging base station to end charging. When the robot exits the charging base station, the movement route of the robot is monitored. It can be determined by setting a monitoring point and judging the positional relationship between the moving position of the robot and the target baseline during the movement of the robot according to the monitoring signal of the monitoring point, so as to finally determine whether the robot deviates from the target baseline during the movement. Among them, the target baseline is preset, and when the robot is working normally, the exit path of the robot is set by the target baseline. For example, the robot is set to exit along the target baseline, or to exit parallel to the target baseline. It can be understood that when the robot exits, its ideal exit path is based on the target baseline as the reference line, and the relationship between the exit path and the target baseline satisfies the preset fixed relationship. In a specific embodiment, the robot is a lawn mowing robot, the target baseline is the boundary wire of the lawn mowing robot, and the monitoring point is an electromagnetic sensor symmetrically arranged on the lawn mowing robot. In the specific working process, the base station will energize the boundary wire and send a boundary signal, and a corresponding electromagnetic field will be formed inside and outside the boundary wire. The electromagnetic sensor on the lawn mowing robot senses the size and direction of the magnetic field to determine the distance between the lawn mowing robot and the boundary wire, and whether it is inside or outside the boundary line. If the directions of the magnetic field detected by the two sensors are both inside the boundary, the robot is judged to be inside the boundary and deviates from the target baseline. If the directions of the magnetic field detected by the two sensors are both outside the boundary, the robot is judged to be outside the boundary and deviates from the target baseline. If the directions of the magnetic field detected by the two sensors are one inside the boundary and one outside the boundary, the robot is judged to be on the boundary line, and at this time, it can be correspondingly judged that the robot has not deviated from the target baseline.
[0063] S3. When it is determined that the robot deviates from the target baseline, the robot is controlled to stop moving in the current direction, and a first distance between the robot and the charging base station is obtained; specifically, once it is determined that the actual moving path of the robot deviates from the target baseline, the robot is controlled to stop moving, and the distance between the current position of the robot and the charging base station is obtained as the first distance.
[0064] S4. Obtain the vertical spacing between the monitoring point and the target alignment line of the robot as the second distance, wherein the target alignment line is used to align with the target baseline when the robot moves along the preset exit path; specifically, the target alignment line of the robot can be set, and when the robot moves normally along the preset exit path, its target alignment line is aligned with the target baseline. The target alignment line of the robot can be the center line of the robot, that is, when the robot moves normally along the preset exit path, its center line is aligned with the target baseline. It can also be understood that the target alignment line corresponds to the robot body, and the target baseline corresponds to the plane on which the robot moves. It can be understood that the first distance is the distance that the robot moves along the target alignment line of the robot. In one embodiment, two monitoring points can be symmetrically set on the robot body with the target alignment line, and the second distance is half of the spacing between the two monitoring points. In practical applications, the monitoring point setting can be fixed, and the second distance can be obtained.
[0065] S5. Obtain the deviation angle of the robot according to the first distance and the second distance, so as to adjust the working heading parameters of the robot according to the deviation angle during the working process of the robot. Specifically, after obtaining the above-mentioned first distance and second distance, a trigonometric function relationship can be established according to the first distance and the second distance to obtain the angle between the robot and the target baseline, which is the deviation angle of the robot from its preset exit path when it actually exits the station. Figure 2 In a specific embodiment shown, A is a robot, and point O corresponds to the position of the charging base station, that is, the starting position of the robot's exit. Under normal circumstances, when the robot moves along the preset exit path, its target alignment line D should be aligned with the target reference line C. When it deviates during its actual operation, it monitors the deviation of the robot through the monitoring point B. When it is just judged that the deviation occurs, the monitoring point B just deviates from the target reference line C. At this time, the distance L between the current position of the robot and the starting position O of the robot movement is calculated, and the vertical distance H between the monitoring point B and the target alignment line D of the robot is obtained. If the vertical distance is symmetrically set at the monitoring point (corresponding sensor), half of the distance between the two monitoring points can be directly taken. At this time, the deviation angle θ at this time can be obtained by using the trigonometric function tgθ=H / L. Once the deviation angle θ is obtained, the working parameters of the robot can be adjusted according to the angle, that is, compensation is performed in the robot according to the deviation angle θ. Among them, the distance L between the current position of the robot and the starting position O of the robot movement can be obtained by real-time monitoring to obtain the position relationship between the robot and the charging base station.
[0066] Optionally, the target baseline includes a closed loop surrounding the boundary of the target working area; in step S3, the robot deviates from the target baseline including: the robot is inside the closed loop or outside the closed loop. Specifically, usually according to the actual application, the corresponding target working area will be set according to the work content of the robot. The boundary line of the target working area is usually a closed loop. During the operation of the lawn mowing robot, the closed loop corresponds to the boundary wire of the lawn mowing robot. That is, the closed loop (corresponding boundary wire) is the corresponding target baseline. When exiting normally, the robot should exit along the boundary line of the target working area. When it deviates from the boundary line, for example, when it is completely inside or outside the closed loop, it is considered that it has deviated, that is, it has deviated from the target baseline.
[0067] Optionally, the monitoring points include a first monitoring point and a second monitoring point respectively placed on both sides of the target alignment line; Figure 3 As shown, in one embodiment, in step S2, the positional relationship between the robot and the target baseline is monitored through monitoring points; including: S211, obtaining the positional relationship between the first monitoring point and the second monitoring point and the closed loop; S212, when one of the first monitoring point and the second monitoring point is in the closed loop, the robot is determined to be in the closed loop when the other monitoring point enters the closed loop; S213, the vertical distance between the monitoring point that enters the closed loop and the target alignment line is obtained as the second distance; specifically, the monitoring points set by the robot include the first monitoring point and the second monitoring point set on both sides of the robot. When the robot exits along the preset exit path, since the target alignment line of the robot is aligned with the target baseline of the operation, one of the first monitoring point and the second monitoring point should be in the closed loop and the other outside the closed loop. The process of determining the positional relationship between the robot's running direction and the target baseline through the monitoring points can be that when a monitoring point that was originally outside the closed loop enters the closed loop, the robot is determined to be in the closed loop, that is, a deviation has occurred. At this time, the second distance obtained is the vertical distance between the monitoring point that enters the closed loop and the target alignment line. As Figure 4 As shown, in a specific embodiment, when the robot moves along the preset exit path, its target alignment line D should be aligned with the target reference line C (corresponding to the closed loop line of the boundary line of the working area). At this time, of the two monitoring points B1 and B2, the monitoring point B2 should be inside the closed loop line, and the monitoring point B1 should be outside the closed loop line. When the monitoring point B1 enters the closed loop line during the deviation operation, it is determined that the deviation occurs, and the vertical distance between the monitoring point B1 at this time, that is, the monitoring point that enters the closed loop line later, and the target alignment line D is obtained as the second distance H. The deviation angle θ is obtained according to the trigonometric function.
[0068] like Figure 5As shown, in another embodiment, in step S2, the positional relationship between the robot and the target baseline is monitored through monitoring points; including: S221, obtaining the positional relationship between the first monitoring point and the second monitoring point and the closed loop; S222, when one of the first monitoring point and the second monitoring point is outside the closed loop, and the other monitoring point enters outside the closed loop, it is determined that the robot is outside the closed loop; S223, the vertical distance between the monitoring point that enters outside the closed loop and the target alignment line is obtained as the second distance. Specifically, the monitoring points set by the robot include the first monitoring point and the second monitoring point set on both sides of the robot. When the robot exits along the preset exit path, since the target alignment line of the robot is aligned with the target baseline of the operation, one of the first monitoring point and the second monitoring point should be inside the closed loop and the other outside the closed loop. The process of determining the positional relationship between the robot's running direction and the target baseline through the monitoring points can be that when a monitoring point that was originally inside the closed loop enters outside the closed loop, it is determined that the robot is outside the closed loop, that is, a deviation has occurred. At this time, the second distance obtained is the vertical distance between the monitoring point that enters outside the closed loop and the target alignment line. As Figure 6 As shown, in a specific embodiment, when the robot moves along the preset exit path, its target alignment line D should be aligned with the target reference line C (corresponding to the closed loop line of the boundary line of the working area). At this time, of the two monitoring points B1 and B2, the monitoring point B1 should be inside the closed loop line, and the monitoring point B2 should be outside the closed loop line. When the monitoring point B1 enters outside the closed loop line during the deviation operation, it is determined that the deviation occurs, and the vertical distance between the monitoring point B1 at this time, that is, the monitoring point that enters outside the closed loop line later, and the target alignment line D is obtained as the second distance H. The deviation angle θ is obtained according to the trigonometric function.
[0069] Optionally, the first monitoring point and the second monitoring point are symmetrically arranged along the target alignment line. In a specific application, the target alignment line is usually set as the center line position of the robot, and the two monitoring points are symmetrically arranged along the center line of the robot.
[0070] Optionally, the first monitoring point and the second monitoring point are both boundary sensors disposed on the robot body. Specifically, the monitoring points can be monitored by boundary sensors on the robot body.
[0071] Optionally, in step S5, the robot's working heading parameters are adjusted according to the deviation angle, including: when the robot is in a closed loop, the deviation angle is deviated in a first direction, and the first direction is opposite to the encircling direction of the closed loop; when the robot is outside the closed loop, the deviation angle is deviated in a second direction, and the second direction is the same as the encircling direction of the closed loop. Specifically, in the specific working heading parameter adjustment process, the heading parameters of the current robot are compensated according to the deviation angle, and the compensation process can be related to whether the robot deviates inside the closed loop or outside the closed loop. When the robot deviates inside the closed loop, it compensates in the first direction, that is, compensates in the direction of deviating from the closed loop, which can also be understood as deviating in the direction opposite to the encircling direction of the closed loop at this point. When the robot deviates outside the closed loop, it compensates in the second direction, that is, compensates in the direction close to the closed loop, which can also be understood as deviating in the same direction as the encircling direction of the other loop at this point.
[0072] Optional, such as Figure 7 As shown, the robot heading correction method of the present invention also includes: S21, when it is determined that the robot has not deviated from the target baseline, the real-time distance between the robot and the charging base station is obtained, and it is determined whether the real-time distance is less than the preset distance. If so, step S2 is executed, and if not, the heading correction is terminated. Specifically, when the robot leaves the station, its exit distance usually needs to be preset, and it needs to enter the working state after leaving the station for a certain distance. Therefore, when monitoring whether the robot has deviated when leaving the station, its exit distance is monitored. When its exit distance still does not deviate after meeting certain conditions, it can be considered that the robot is leaving the station normally, and no heading correction is required, and the heading correction is terminated.
[0073] Optionally, in step S21, the real-time distance between the robot and the charging base station is obtained; including: recording the number of pulses corresponding to the internal motor of the robot since it leaves the station, so as to obtain the real-time distance between the robot and the charging base station according to the number of pulses. Specifically, the robot's exit distance can be obtained by collecting the number of pulses generated when the robot's motor rotates since it leaves the station, the number of pulses per rotation is fixed, the radius of the wheel is fixed, the circumference of the wheel's advance in one circle is calculated according to the radius, the number of circles the wheel runs in the process of advancing is determined according to the number of pulses, and the actual advance distance of the robot is calculated according to the circumference of the wheel, which corresponds to the real-time distance L.
[0074] like Figure 8 As shown, in one embodiment, a robot heading correction device of the present invention includes:
[0075] The first execution unit 110 is used to control the robot to exit the charging base station;
[0076] The second execution unit 120 is used to monitor the positional relationship between the robot and the target baseline through the monitoring points during the movement of the robot, wherein the target baseline is used to set a preset exit path of the robot;
[0077] A first judging unit 130, configured to judge whether the robot deviates from the target reference line according to the position relationship, and output a positive result when it is judged that the robot deviates from the target reference line;
[0078] The third execution unit 140 is used to control the robot to stop moving in the current direction when the first judgment unit outputs a positive result, and obtain the distance between the current position of the robot and the charging base station as the first distance;
[0079] A first acquisition unit 150 is used to acquire a vertical distance between the monitoring point and a target alignment line of the robot as a second distance, wherein the target alignment line is used to align with the target reference line when the robot moves along a preset exit path;
[0080] The fourth execution unit 160 is used to obtain the deviation angle of the robot according to the first distance and the second distance, so as to adjust the working heading parameters of the robot during the working process of the robot according to the deviation angle.
[0081] Optionally, the target reference line includes a closed loop surrounding a boundary of the target working area;
[0082] The first judgment unit is used to judge whether the robot is inside or outside the closed loop to judge whether the robot deviates from the target reference line.
[0083] Optionally, the fourth execution unit includes a first adjustment unit and a second adjustment unit;
[0084] The first adjustment unit is used for deviating the robot in a first direction by a deviation angle when the robot is in a closed loop, and the first direction is opposite to the circling direction of the closed loop;
[0085] The second adjustment unit is used for deviating the robot by a deviation angle along a second direction when the robot is outside the closed loop, and the second direction is the same as the circling direction of the closed loop.
[0086] Optional, such as Fig. 9 As shown, in one embodiment, the robot heading correction device of the present invention further includes a second acquisition unit 170 and a second judgment unit 180;
[0087] The first judgment unit 130 is also used to output a negative result when it is determined that the robot has not deviated from the target baseline;
[0088] The second acquisition unit 170 is used to acquire the real-time position of the robot to obtain the real-time distance between the robot and the charging base station;
[0089] The second judgment unit 180 is used to judge whether the real-time distance is less than the preset distance when the first judgment unit outputs a negative result, and drive the second execution unit to act when an affirmative result is output, and end the heading correction when a negative result is output.
[0090] Specifically, the specific coordination operation process between the various units of the robot heading correction device here can refer to the above-mentioned robot heading correction method, which will not be repeated here.
[0091] A robot of the present invention comprises a memory and a processor; the memory is used to store a computer program; the processor is used to execute the computer program to implement the robot heading correction method as claimed in any one of claims 1 to 7. Specifically, according to an embodiment of the present invention, the process described above with reference to the flowchart can be implemented as a computer software program. For example, an embodiment of the present invention includes a robot, which includes a computer program carried on a computer readable medium, and the computer program includes a program code for executing the method shown in the flowchart.
[0092] It can be understood that the above embodiments only express the preferred implementation modes of the present invention, and the descriptions thereof are relatively specific and detailed, but they cannot be understood as limiting the patent scope of the present invention. It should be pointed out that, for ordinary technicians in this field, the above technical features can be freely combined without departing from the concept of the present invention, and several deformations and improvements can be made, which all belong to the protection scope of the present invention. Therefore, all equivalent changes and modifications made to the scope of the claims of the present invention should belong to the coverage of the claims of the present invention.
Claims
1. A robot heading correction method, characterized in that: The following steps are involved: S1, control the robot to exit the charging base station; S2. During the movement of the robot, the positional relationship between the robot and the target baseline is monitored through monitoring points to determine whether the robot deviates from the target baseline according to the positional relationship; wherein the target baseline is used to set a preset exit path for the robot; and the target baseline includes a closed loop surrounding the boundary of a target working area; S3. When it is determined that the robot deviates from the target baseline, control the robot to stop moving in the current direction, and obtain a first distance between the robot and the charging base station; the robot deviating from the target baseline includes: the robot is inside the closed loop or outside the closed loop; S4, obtaining a vertical distance between the monitoring point and a target alignment line of the robot as a second distance, wherein the target alignment line is used to align with the target baseline when the robot moves along the preset exit path; S5. Acquire a deviation angle of the robot according to the first distance and the second distance, so as to adjust a working heading parameter of the robot according to the deviation angle during the working process of the robot; Wherein, the monitoring points include a first monitoring point and a second monitoring point respectively placed on both sides of the target alignment line; In the step S2, the monitoring of the positional relationship between the robot and the target reference line through the monitoring point includes: Acquire the positional relationship between the first monitoring point, the second monitoring point and the closed loop; When one of the first monitoring point and the second monitoring point is within the closed loop, it is determined that the robot is within the closed loop when the other monitoring point enters the closed loop; The vertical distance between the monitoring point entering the closed loop after acquisition and the target alignment line is the second distance; or When one of the first monitoring point and the second monitoring point is outside the closed loop, and the other monitoring point enters outside the closed loop, it is determined that the robot is outside the closed loop; The vertical distance between the monitoring point that enters the closed loop after acquisition and the target alignment line is the second distance.
2. The robot heading correction method according to claim 1, characterized in that: The first monitoring point and the second monitoring point are symmetrically arranged along the target alignment line; and / or The first monitoring point and the second monitoring point are both boundary sensors arranged on the robot body.
3. The robot heading correction method according to claim 1, characterized in that: In the step S5, adjusting the working heading parameters of the robot according to the deviation angle includes: When the robot is in the closed loop, the robot deviates from the deviation angle in a first direction, wherein the first direction is opposite to the circling direction of the closed loop; When the robot is outside the closed loop, it deviates from the deviation angle in a second direction, where the second direction is the same as the circumferential direction of the closed loop.
4. The robot heading correction method according to claim 1, characterized in that: The method further comprises: S21, obtaining the real-time distance between the robot and the charging base station; S22. When it is determined that the robot has not deviated from the target baseline, determine whether the real-time distance is less than a preset distance. If so, execute step S2; if not, end the heading correction.
5. The robot heading correction method according to claim 4, characterized in that: In the step S21, the real-time distance between the robot and the charging base station is obtained; including: The number of pulses corresponding to the internal motor of the robot since leaving the station is recorded, so as to obtain the real-time distance between the robot and the charging base station according to the number of pulses.
6. A robot heading correction device, characterized in that: Used to implement the robot heading correction method according to any one of claims 1 to 5, the device comprises: A first execution unit, used to control the robot to exit the charging base station; A second execution unit is used to monitor the positional relationship between the robot and a target baseline through monitoring points during the movement of the robot, wherein the target baseline is used to set a preset exit path of the robot; A first judging unit, configured to judge whether the robot deviates from the target reference line according to the positional relationship, and output a positive result when it is judged that the robot deviates from the target reference line; a third execution unit, configured to control the robot to stop moving in a current direction and obtain a distance between the current position of the robot and the charging base station as a first distance when the first judgment unit outputs a positive result; a first acquisition unit, configured to acquire a vertical distance between the monitoring point and a target alignment line of the robot as a second distance, wherein the target alignment line is used to align with the target reference line when the robot moves along the preset exit path; The fourth execution unit is used to obtain the deviation angle of the robot according to the first distance and the second distance, so as to adjust the working heading parameters of the robot according to the deviation angle during the working process of the robot.
7. The robot heading correction device according to claim 6, characterized in that: The target reference line includes a closed loop line surrounding the boundary of the target working area; The first judgment unit is used to determine whether the robot is inside the closed loop or outside the closed loop to determine whether the robot deviates from the target reference line.
8. The robot heading correction device according to claim 7, characterized in that: The fourth execution unit includes a first adjustment unit and a second adjustment unit; The first adjustment unit is used to deviate from the deviation angle along a first direction when the robot is in the closed loop, and the first direction is opposite to the circling direction of the closed loop; The second adjustment unit is used for deviating from the deviation angle along a second direction when the robot is outside the closed loop, and the second direction is the same as the circling direction of the closed loop.
9. The robot heading correction device according to claim 6, characterized in that: It also includes a second acquisition unit and a second judgment unit; The second acquisition unit is used to acquire the real-time position of the robot to acquire the real-time distance between the robot and the charging base station; The first judgment unit is further configured to output a negative result when determining that the robot has not deviated from the target baseline; The second judgment unit is used to judge whether the real-time distance is less than the preset distance when the first judgment unit outputs a negative result, and drive the second execution unit to act when an affirmative result is output, and end the heading correction when a negative result is output.
10. A robot, characterized in that: including memory and processor; The memory is used to store computer programs; The processor is used to execute the computer program to implement the robot heading correction method as described in any one of claims 1 to 5.
