Method for correcting deviation of traveling direction and related equipment

By combining real-time detection with orientation angle deviation compensation and angular velocity zero-bias drift compensation strategies, the problem of travel direction deviation caused by temperature changes in inertial navigation mobile robots is solved, achieving highly adaptive correction under immediate start-up.

CN114545924BActive Publication Date: 2024-11-19SHENZHEN SILVER STAR INTELLIGENT TECH CO LTD
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202111658436.6
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2021-12-30
Publication Date
2024-11-19
Estimated Expiration
2041-12-30

AI Technical Summary

Technical Problem

In the existing technology, inertial navigation mobile robots have poor adaptability to correct deviations in their travel direction due to the sensitivity of MEMS sensors to temperature changes. In particular, they cannot effectively correct zero-bias changes caused by temperature when instant start-up is required.

Method used

By detecting the deviation in the direction of travel in real time and adopting strategies for compensating for directional angle deviation and angular velocity zero-bias drift, combined with real-time estimation of compensation parameters based on the rate of temperature change, the computational load is reduced, the temperature control calibration process is avoided, and adaptability is improved.

Benefits of technology

It achieves accurate correction of the travel direction when the start-up requirement is met, reduces the running and computing load, improves the adaptability of travel direction offset correction, and avoids additional calibration time.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN114545924B_ABST
    Figure CN114545924B_ABST
Patent Text Reader

Abstract

The present invention relates to the field of robotics, and provides a method for correcting an offset of a moving direction and related equipment, which are used to improve the adaptability of the offset correction of the moving direction of a mobile robot. The method for correcting an offset of a moving direction comprises: when it is detected that the current moving direction is offset from the preset moving direction, determining the current target compensation strategy, the target compensation strategy is a first compensation strategy or a second compensation strategy, the first compensation strategy is directional angle deviation compensation, and the second compensation strategy is angular velocity zero bias drift compensation and directional angle deviation compensation; correcting the current moving direction according to the first compensation strategy or the second compensation strategy to obtain a corrected moving direction; and moving according to the corrected moving direction.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the field of robot technology, and in particular to a method for correcting an offset in a traveling direction and related equipment. Background Art

[0002] Inertial navigation mobile robots rely on micro-electromechanical inertial measurement devices (MEMS-IMUs) to determine their current direction. MEMS sensors are easily affected by temperature changes, and temperature instability is often the most significant factor affecting sensor performance. The most obvious impact of temperature changes on MEMS-IMUs is that they cause changes in the zero bias of the output data, and the change is related to the temperature and the temperature change rate. In order to correct the zero bias changes caused by temperature changes, there are usually two methods: 1. Calibrate the angular velocity zero bias drift compensation: record the zero bias values ​​at different temperatures and temperature change rates, and use parameter identification methods to find the parameters required in the calculation formula related to the zero bias change of the output data and the temperature and temperature change rate; 2. Install a constant temperature on the inertial measurement unit (IMU) sensor.

[0003] Although the method of angular velocity zero bias drift compensation calibration can obtain a more accurate zero bias formula, the zero bias values ​​recorded at different temperatures and temperature change rates are calibrated rather than real-time, and the data flexibility is low; although the method of adding a constant temperature to the inertial measurement unit (IMU) sensor eliminates the temperature change during the use of the IMU, it requires a warm-up time before use and is not suitable for robots that require instant startup. Therefore, the mobile robot has poor adaptability to the offset correction of the travel direction. Summary of the invention

[0004] The invention provides a method for correcting the deviation of a moving direction and related equipment, which are used to improve the adaptability of the deviation correction of the moving direction of a mobile robot.

[0005] A first aspect of the present invention provides a method for correcting an offset in a traveling direction, the method comprising:

[0006] When it is detected that the current traveling direction deviates from the preset traveling direction, a current target compensation strategy is determined, where the target compensation strategy is a first compensation strategy or a second compensation strategy, where the first compensation strategy is angular deviation compensation, and the second compensation strategy is angular velocity zero bias drift compensation and angular deviation compensation;

[0007] According to the first compensation strategy or the second compensation strategy, the current traveling direction is corrected to obtain a corrected traveling direction;

[0008] Proceed in the corrected direction of travel.

[0009] In a feasible implementation manner, when detecting that the current traveling direction deviates from the preset traveling direction, before determining the current target compensation strategy, the method further includes:

[0010] When it is detected that the running time of the re-movement after the pause is greater than the first preset period, the first angular velocity zero bias value at the last pause and the second angular velocity zero bias value at the current moment are obtained;

[0011] By using the first angular velocity zero bias value and the second angular velocity zero bias value, it is detected whether the current traveling direction deviates from the preset traveling direction.

[0012] In a feasible implementation, when the current traveling direction is detected to be offset from the preset traveling direction, the current target compensation strategy is determined, the target compensation strategy is the first compensation strategy or the second compensation strategy, the first compensation strategy is the angular deviation compensation, and the second compensation strategy is the angular velocity zero bias drift compensation and the angular deviation compensation, including:

[0013] When it is detected that the current traveling direction deviates from the preset traveling direction, the slope of the target temperature difference-time curve of the sensor within the second preset time period is obtained;

[0014] Determine whether the slope of the target temperature difference-time curve is greater than a preset threshold;

[0015] If the slope of the target temperature difference-time curve is less than or equal to a preset threshold, a first compensation strategy is determined as the target compensation strategy, wherein the first compensation strategy is directional angle deviation compensation;

[0016] If the slope of the target temperature difference-time curve is greater than a preset threshold, a second compensation strategy is determined as the target compensation strategy, and the second compensation strategy is angular velocity zero bias drift compensation and directional angle deviation compensation.

[0017] In a feasible implementation manner, when detecting that the current traveling direction deviates from the preset traveling direction, obtaining the slope of the target temperature difference-time curve of the sensor within the second preset time period includes:

[0018] When it is detected that the current traveling direction deviates from the preset traveling direction, a plurality of temperature readings of the temperature sensor corresponding to a second preset time period are obtained;

[0019] Performing filtering and noise reduction processing on multiple temperature readings of the temperature sensor to obtain pre-processed temperature readings;

[0020] The target temperature difference-time curve slope is calculated through the pre-processed temperature readings.

[0021] In a feasible implementation manner, the correcting the current traveling direction according to the first compensation strategy or the second compensation strategy to obtain a corrected traveling direction includes:

[0022] According to the first compensation strategy, the gyroscope z-axis zero bias value of the current traveling direction, the first angular velocity zero bias value at the last pause, and the basic direction angle are obtained;

[0023] Calculate the current direction angular deviation value by using the gyroscope z-axis zero bias value of the current traveling direction and the first angular velocity zero bias value during the last pause;

[0024] The basic direction angle of the current traveling direction is compensated by the direction angle deviation value to obtain a corrected traveling direction;

[0025] Alternatively, according to the second compensation strategy, the first angular velocity zero bias value and the basic direction angle at the last pause of the current traveling direction are obtained;

[0026] Calculating the zero bias value after angular velocity zero bias drift compensation by using the first angular velocity zero bias value during the last pause;

[0027] Calculating the current direction angular deviation value by using the first angular velocity zero bias value during the last pause and the zero bias value after the angular velocity zero bias drift compensation;

[0028] The basic direction angle of the current traveling direction is compensated by the current direction angle deviation value to obtain a corrected traveling direction.

[0029] In a feasible implementation manner, the calculating the zero bias value after angular velocity zero bias drift compensation by using the first angular velocity zero bias value during the last pause includes:

[0030] Get the target angular velocity zero bias drift compensation coefficient, the temperature correction value at the last pause, and the current temperature correction value;

[0031] The target angular velocity zero bias drift compensation coefficient, the temperature correction value before the pause, the current temperature correction value and the first angular velocity zero bias value during the last pause are calculated to obtain the zero bias value after the angular velocity zero bias drift compensation.

[0032] In a feasible implementation manner, the step of obtaining the target angular velocity zero bias drift compensation coefficient, the temperature correction value during the last pause, and the current temperature correction value includes:

[0033] Calculate the basic angular velocity zero bias drift compensation coefficient according to the robot's motion state;

[0034] Obtaining an angular velocity zero bias drift compensation coefficient gain, and calculating a target angular velocity zero bias drift compensation coefficient through the basic angular velocity zero bias drift compensation coefficient and the angular velocity zero bias drift compensation coefficient gain;

[0035] Get the temperature correction value at the last pause and the current temperature correction value.

[0036] In a feasible implementation manner, the step of calculating the basic angular velocity zero bias drift compensation coefficient according to the robot motion state includes:

[0037] The robot motion state is monitored, and when it is monitored that the robot motion state meets the preset state condition, the current zero bias value and the last updated zero bias value, as well as the current temperature and the temperature when the zero bias was last updated are obtained, wherein the preset state condition is used to indicate that the pause motion time reaches a third preset period, and the time interval between two pause states is greater than the second preset period;

[0038] The current zero bias value, the last updated zero bias value, the current temperature and the temperature of the last zero bias update are calculated to obtain a basic angular velocity zero bias drift compensation coefficient.

[0039] In a feasible implementation manner, after traveling in the corrected traveling direction, the method further includes:

[0040] Determining whether the time traveled in the corrected traveling direction is greater than a fourth preset time period;

[0041] If the time traveled in the corrected traveling direction is greater than the fourth preset period, the operation is suspended according to the third preset period.

[0042] A second aspect of the present invention provides a method for correcting an offset in a traveling direction, comprising:

[0043] Step 1: When it is detected that the first operation time is greater than the fifth preset period, the operation is suspended according to the third preset period;

[0044] Step 2: When it is detected that the running time after the third preset period of time is suspended and then resumed is greater than the first preset period of time, detect whether the current direction of travel is offset from the preset direction of travel, and determine the current target compensation strategy according to the detection result, the target compensation strategy is the first compensation strategy or the second compensation strategy, the first compensation strategy is the direction angle deviation compensation, and the second compensation strategy is the angular velocity zero bias drift compensation and the direction angle deviation compensation; according to the first compensation strategy or the second compensation strategy, correct the current direction of travel to obtain a corrected direction of travel; travel according to the corrected direction of travel;

[0045] Step three: when it is detected that the running time after traveling in the corrected traveling direction is greater than the fourth preset period, the running is suspended according to the third preset period, and step two is repeated.

[0046] A third aspect of the present invention provides a device for correcting deviation in a travel direction, comprising:

[0047] A determination module, used for determining a current target compensation strategy when detecting that a current traveling direction deviates from a preset traveling direction, the target compensation strategy being a first compensation strategy or a second compensation strategy, the first compensation strategy being angular deviation compensation, and the second compensation strategy being angular velocity zero bias drift compensation and angular deviation compensation;

[0048] A correction module, used for correcting the current traveling direction according to the first compensation strategy or the second compensation strategy to obtain a corrected traveling direction;

[0049] A traveling module is used to travel in the corrected traveling direction.

[0050] A fourth aspect of the present invention provides a device for correcting deviation in a travel direction, comprising:

[0051] The suspension operation module is used to execute step 1: when it is detected that the first operation time is greater than the fifth preset time period, suspend the operation according to the third preset time period;

[0052] The compensation module is used to execute step 2: when it is detected that the running time after resuming running after pausing for the third preset period is greater than the first preset period, detect whether the current travel direction is offset from the preset travel direction, and determine the current target compensation strategy according to the detection result, the target compensation strategy is the first compensation strategy or the second compensation strategy, the first compensation strategy is the direction angle deviation compensation, and the second compensation strategy is the angular velocity zero bias drift compensation and the direction angle deviation compensation; according to the first compensation strategy or the second compensation strategy, correct the current travel direction to obtain a corrected travel direction; and travel according to the corrected travel direction;

[0053] The repeating execution module is used to execute step three: when it is detected that the running time after traveling in the corrected traveling direction is greater than the fourth preset time period, suspend the operation according to the third preset time period and repeat step two.

[0054] The fifth aspect of an embodiment of the present invention provides an intelligent device, comprising: a memory and at least one processor, wherein the memory stores instructions; the at least one processor calls the instructions in the memory so that the intelligent device executes the above-mentioned method for correcting the offset of the direction of travel.

[0055] A sixth aspect of the present invention provides a computer-readable storage medium, in which a computer program is stored. When the computer-readable storage medium is run on a computer, the computer executes the above-mentioned method for correcting the offset of the traveling direction.

[0056] In the technical solution provided by the present invention, by real-time detection of whether the current traveling direction is offset from the preset traveling direction, and performing the traveling direction correction of the first compensation strategy or the second compensation strategy as needed, the operation and calculation load of the pure inertial navigation sweeper is reduced, and by combining the directional angle deviation compensation and the angular velocity zero bias drift compensation, the walking route angle after compensation (i.e., traveling according to the corrected traveling direction) will no longer have obvious deviations, and there is no need to perform a calibration process related to temperature control, and the calibration time is not increased. The compensation parameters are estimated in real time according to the temperature change rate, and the robot has good adaptability, is suitable for robots with instant startup requirements, and improves the adaptability of the deviation correction of the traveling direction. BRIEF DESCRIPTION OF THE DRAWINGS

[0057] Figure 1 A schematic diagram of an embodiment of a method for correcting an offset in a traveling direction according to an embodiment of the present invention;

[0058] Figure 2 A schematic diagram of an embodiment of the present invention is a comparison between a traveling route without compensation and a traveling route after compensation;

[0059] Figure 3 It is a schematic diagram of another embodiment of the method for correcting the deviation of the traveling direction in an embodiment of the present invention;

[0060] Figure 4 It is a schematic diagram of an embodiment of the temperature, temperature difference-time curve slope and gyroscope Z-axis zero bias change curve in an embodiment of the present invention;

[0061] Figure 5 It is a schematic diagram of an embodiment of fitting an exponential function of time by using the slope of the target temperature difference-time curve in an embodiment of the present invention;

[0062] Figure 6 A schematic diagram of an embodiment of the motion effect of the angular velocity zero bias drift compensation strategy in an embodiment of the present invention;

[0063] Figure 7 A schematic diagram of an embodiment of an angular velocity zero bias variation curve implemented by directional angle deviation compensation in an embodiment of the present invention;

[0064] Figure 8 It is a schematic diagram of another embodiment of the method for correcting the deviation of the traveling direction in an embodiment of the present invention;

[0065] Fig. 9It is a structural schematic diagram of a device for correcting deviation in the traveling direction according to an embodiment of the present invention;

[0066] Fig.10 is another structural schematic diagram of the deviation correction device in the traveling direction according to an embodiment of the present invention;

[0067] Fig.11 is another structural schematic diagram of the deviation correction device in the traveling direction according to an embodiment of the present invention;

[0068] Fig.12 FIG. 1 is a schematic diagram of an embodiment of a smart device in an embodiment of the present invention. DETAILED DESCRIPTION

[0069] The embodiment of the present invention provides a method for correcting the deviation of a traveling direction and related equipment, which improves the adaptability of the deviation correction of the traveling direction.

[0070] The terms "first", "second", "third", "fourth", etc. (if any) in the specification and claims of the present invention and the above-mentioned drawings are used to distinguish similar objects, and are not necessarily used to describe a specific order or sequence. It should be understood that the data used in this way can be interchanged where appropriate, so that the embodiments described herein can be implemented in an order other than that illustrated or described herein. In addition, the terms "including" or "having" and any variations thereof are intended to cover non-exclusive inclusions, for example, a process, method, system, product or device that includes a series of steps or units is not necessarily limited to those steps or units that are clearly listed, but may include other steps or units that are not clearly listed or inherent to these processes, methods, products or devices.

[0071] It is understandable that the present invention can be applied to smart devices. As an example but not limitation, the smart device can be a mobile robot. This application is described by taking a mobile robot as an example. Among them, the mobile robot can be any one of a sweeping robot, a sweeping and mopping robot, a mopping robot or a washing robot. The navigation type of the sweeping robot used in the present invention is not limited. It can be a pure inertial navigation sweeping machine or other sweeping machines using navigation equipment. As an example but not limitation, this application is described by taking a pure inertial navigation sweeping machine as an example. The present invention can be applied to methods and devices that simply rely on an inertial measurement unit (IMU) sensor to provide direction information.

[0072] Since the pure inertial navigation sweeper relies on a micro-electromechanical inertial measurement device (MEMS-IMU) to determine the current direction. MEMS sensors are easily affected by temperature changes, and temperature instability is often the most significant factor affecting sensor performance. Within 5 minutes after the sweeper starts working, its internal temperature rises rapidly; after about 30 minutes of operation, when its internal temperature is relatively stable, it can be more than 10°C higher than the ambient temperature. The impact of the heating process on the sensor output cannot be ignored. Therefore, in order to correct the zero bias change caused by temperature changes, thereby causing an offset in the direction of travel, the present invention provides an offset correction method and related equipment for the direction of travel.

[0073] For ease of understanding, the specific process of the embodiment of the present invention is described below. Figure 1 , Figure 1 is a schematic diagram of a method for correcting an offset in a traveling direction provided by an embodiment of the present invention. An embodiment of the method for correcting an offset in a traveling direction provided by an embodiment of the present invention includes:

[0074] S101. When it is detected that the current traveling direction deviates from the preset traveling direction, a current target compensation strategy is determined. The target compensation strategy is a first compensation strategy or a second compensation strategy. The first compensation strategy is angular deviation compensation. The second compensation strategy is angular velocity zero bias drift compensation and angular deviation compensation.

[0075] The pure inertial navigation sweeper monitors the deviation between the current direction of travel and the preset direction of travel in real time. If the current direction of travel is offset from the preset direction of travel, it is determined whether the current state of the pure inertial navigation sweeper is a state that requires angular velocity zero bias drift compensation. If not, the first compensation strategy is determined as the target compensation strategy. If so, the second compensation strategy is determined as the target compensation strategy. In the second compensation strategy, the processing order of angular velocity zero bias drift compensation and directional angle deviation compensation is to first remember the angular velocity zero bias drift compensation and then the directional angle deviation compensation. The implementation method of angular velocity zero bias drift compensation is not to find the required compensation parameters through the calibrated zero bias value, but to estimate the compensation parameters in real time according to the temperature change rate. Among them, the current direction of travel can be the current direction of the pure inertial navigation sweeper when it is suspended, or the current direction of the pure inertial navigation sweeper after running for a certain period of time, or the direction of the pure inertial navigation sweeper after pausing and resuming operation.

[0076] It should be noted that when it is detected that the current traveling direction is offset from the preset traveling direction, it will be detected in real time whether the current traveling direction is offset from the preset traveling direction. In order to improve the accuracy of the angle calculation, the pure inertial navigation sweeper needs to pause at regular intervals during operation so that the gyroscope zero bias can be updated. Therefore, the implementation method for detecting whether the previous traveling direction is offset from the preset traveling direction can be as follows: the angular velocity zero bias value of the pure inertial navigation sweeper before it resumes movement after pausing, as well as the angular velocity zero bias value of the traveling direction (at the current moment) are collected, and whether the previous traveling direction is offset from the preset traveling direction is detected by judging whether the two angular velocity zero bias values ​​are consistent. If they are consistent, it is determined that the current traveling direction is offset from the preset traveling direction. If they are inconsistent, it is determined that the current traveling direction is not offset from the preset traveling direction.

[0077] S102: Correct the current traveling direction according to the first compensation strategy or the second compensation strategy to obtain a corrected traveling direction.

[0078] Since the gyroscope angular velocity zero bias update can only be performed in a stationary state, when the first compensation strategy is used to correct the current traveling direction, the pure inertial navigation sweeper can obtain the gyroscope Z-axis reading zero bias before the pause and the gyroscope Z-axis reading zero bias after the pause, and calculate the angular deviation by the gyroscope Z-axis reading zero bias before the pause and the gyroscope Z-axis reading zero bias after the pause, and compensate the angular deviation for the basic angular deviation of the current traveling direction by the angular deviation, and use the new angular deviation after compensation as the basic angular deviation, that is, the corrected traveling direction, wherein the gyroscope Z-axis reading zero bias before the pause may be the gyroscope Z-axis reading zero bias of the last pause, and the gyroscope Z-axis reading zero bias after the pause may be the gyroscope Z-axis reading zero bias at the current moment.

[0079] When the second compensation strategy is used to correct the current direction of travel, the basic angular velocity zero bias drift compensation coefficient is calculated according to the motion state of the pure inertial navigation sweeper during the temperature compensation time interval; the temperature change rate within the preset time is collected, and the target angular velocity zero bias drift compensation coefficient is calculated according to the temperature change rate within the preset time and the basic angular velocity zero bias drift compensation coefficient, and the current compensation zero bias value is calculated by the target angular velocity zero bias drift compensation coefficient, and the gyroscope Z-axis reading zero bias before the pause is obtained. The basic direction angle of the current direction of travel is compensated for the direction angle deviation by the current compensation zero bias value and the gyroscope Z-axis reading zero bias before the pause, and the corrected direction of travel is obtained, wherein the preset time is the time interval of temperature compensation. By combining temperature compensation and direction angle deviation compensation, the subsequent angle of travel according to the corrected direction of travel will no longer have obvious deviations.

[0080] like Figure 2 As shown, Figure 2 The solid line in the middle represents the actual walking route. Figure 2 (1) shows a travel route (route corresponding to the travel direction) without compensation (direction angle deviation compensation and / or angular velocity zero bias drift compensation). Although the angular velocity deviation speed will decrease as the heating rate decreases, the accumulated deviation that occurred before this will not be eliminated, resulting in a poor deviation correction effect in the travel direction. Figure 2 (2) shows the travel route (the route corresponding to the travel direction) after compensation (direction angle deviation compensation and / or angular velocity zero bias drift compensation). Before the pure inertial navigation sweeper pauses for the first time, the angle of the travel route is significantly offset. After the angle is adjusted, the angle of the travel route is restored to the initial direction. Due to the effect of angular velocity zero bias drift compensation, the angle of the travel route will no longer deviate significantly, that is, the offset correction effect of the travel direction is obvious.

[0081] By detecting in real time whether the current traveling direction deviates from the preset traveling direction, and correcting the traveling direction using the first compensation strategy or the second compensation strategy as needed, the operation and calculation load of the pure inertial navigation sweeper is reduced. By combining the angular deviation compensation and the angular velocity zero deviation drift compensation, the walking route angle after compensation (i.e., traveling according to the corrected traveling direction) will no longer deviate significantly, and there is no need to perform a calibration process related to temperature control, which does not increase the calibration time. The compensation parameters are estimated in real time according to the temperature change rate, and the system has good adaptability.

[0082] S103. Travel in the corrected traveling direction.

[0083] Among them, after the pure inertial navigation sweeping machine moves according to the corrected direction of travel, the above steps S101-103 will be cyclically operated in the process before the pure inertial navigation sweeping machine terminates all operations, and it will operate according to the preset operation strategy, which includes the above steps S101-103.

[0084] In the embodiment of the present invention, by detecting in real time whether the current traveling direction is offset from the preset traveling direction, and performing the traveling direction correction of the first compensation strategy or the second compensation strategy as needed, the operation and calculation load of the pure inertial navigation sweeper is reduced, and by combining the directional angle deviation compensation and the angular velocity zero bias drift compensation, the walking route angle after compensation (i.e., traveling according to the corrected traveling direction) will no longer have obvious deviations, and there is no need to perform a calibration process related to temperature control, and the calibration time is not increased. The compensation parameters are estimated in real time according to the temperature change rate, which has good adaptability and is suitable for robots with instant startup requirements, thereby improving the adaptability of the offset correction of the traveling direction.

[0085] See also Figure 3 Another embodiment of the method for correcting the deviation of the traveling direction in the embodiment of the present invention includes:

[0086] In the method for compensating for angular velocity zero bias drift in the offset correction method for the traveling direction in the embodiment of the present invention, the compensation coefficient is estimated by collecting the temperature change rate and the zero bias change over a period of time, so the angular velocity zero bias drift compensation will not be performed in the time period from startup to the first zero bias update. In order to reduce the angle offset caused by temperature rise, the pure inertial navigation sweeper adopts a motion strategy of pausing for 2 to 3 seconds after the first operation for 30 seconds, and then pausing for 2 to 3 seconds after 120 seconds. For the accumulated angle error in the first operation without angular velocity zero bias drift compensation, and the angle calculation error caused by the zero bias jump thereafter, it will be estimated and compensated after each zero bias update. On the other hand, the angular velocity zero bias drift compensation method needs to obtain the initial temperature compensation coefficient during operation, that is, no angular velocity zero bias drift compensation is performed from startup to the first pause. The temperature and zero bias of the pure inertial navigation sweeper change the fastest when it is just turned on. In order to reduce the angle error occurring during this period, the interval time of the first pause needs to be shortened. Therefore, as an example but not limitation, the first preset time period in the embodiment of the present invention is 1 second, the second preset time period is 30 seconds, the third preset time period is 2-3 seconds, and the fourth preset time period is 120 seconds. The corresponding motion strategy is that the pure inertial navigation sweeper starts to move along the set bow-shaped path after starting. If the running time exceeds the fifth preset time period (30 seconds), it will pause for the third preset time period (2 to 3 seconds) before the next straight move. After that, every time the running time exceeds the fourth preset time period (120 seconds), it will pause for the third preset time period (2 to 3 seconds) before the next straight move.

[0087] S301. When it is detected that the running time of re-moving after pausing is greater than a first preset period, a first angular velocity zero bias value at the last pause and a second angular velocity zero bias value at the current moment are obtained.

[0088] Among them, the first preset period indicates the time interval from when the pure inertial navigation sweeper resumes movement after pausing to when the compensation calculation is performed. After the pure inertial navigation sweeper is started, it moves straight in the predetermined direction along the set bow-shaped path. Due to the change in the zero bias of the gyroscope reading caused by the rapid heating, the calculated directional angle error increases rapidly, indicating that the pure inertial navigation sweeper has deviated. Real-time monitoring is performed to determine whether the pure inertial navigation sweeper is about to go straight after its first operation and whether the operation time is greater than the fifth preset period (30 seconds). The fifth preset period indicates the shortest time interval from the start of cleaning to the first pause of the pure inertial navigation sweeper. If not, monitoring is continued; if so, the operation is suspended for the third preset period (2 to 3 seconds). The third preset period indicates the pause time. When the end of the third preset period is reached, the sweeper moves along the set bow-shaped path again. When it is detected that the operation time after the pause is greater than the first preset period (1 second), the first angle zero bias value when the operation is suspended for the third preset period (2 to 3 seconds) and the second angular velocity zero bias value at the current moment are read. The first angle zero bias value is obtained by reading all gyroscope output data from the start time to the first pause time, and calculating the first angle zero bias value through all gyroscope output data. The second angle zero bias value is obtained by reading all gyroscope output data from the first pause time to 1 second of operation, and calculating the second angle zero bias value through all gyroscope output data.

[0089] S302: Detect whether the current traveling direction deviates from the preset traveling direction by using the first angular velocity zero bias value and the second angular velocity zero bias value.

[0090] By judging whether the first angular velocity zero bias value is consistent with the second angular velocity zero bias value, it is possible to detect whether the current traveling direction is offset from the preset traveling direction. If the first angular velocity zero bias value is consistent with the second angular velocity zero bias value, it is determined that the current traveling direction is not offset from the preset traveling direction; if the first angular velocity zero bias value is inconsistent with the second angular velocity zero bias value, it is determined that the current traveling direction is offset from the preset traveling direction.

[0091] S303. When it is detected that the current traveling direction deviates from the preset traveling direction, a current target compensation strategy is determined. The target compensation strategy is a first compensation strategy or a second compensation strategy. The first compensation strategy is angular deviation compensation. The second compensation strategy is angular velocity zero bias drift compensation and angular deviation compensation.

[0092] Specifically, when the pure inertial navigation sweeper detects that the current travel direction is offset from the preset travel direction, it obtains the slope of the target temperature difference-time curve of the sensor within the second preset time period (30 seconds); determines whether the slope of the target temperature difference-time curve is greater than the preset threshold; if the slope of the target temperature difference-time curve is less than or equal to the preset threshold, the first compensation strategy is determined as the target compensation strategy, and the first compensation strategy is angular deviation compensation; if the slope of the target temperature difference-time curve is greater than the preset threshold, the second compensation strategy is determined as the target compensation strategy, and the second compensation strategy is angular velocity zero bias drift compensation and angular deviation compensation.

[0093] Specifically, when the pure inertial navigation sweeper detects that the current travel direction is offset from the preset travel direction, the execution process of obtaining the target temperature difference-time curve slope of the sensor within the second preset time period (30 seconds) includes: when it is detected that the current travel direction is offset from the preset travel direction, obtaining multiple temperature readings of the temperature sensor corresponding to the second preset time period; filtering and denoising the multiple temperature readings of the temperature sensor to obtain preprocessed temperature readings; and calculating the target temperature difference-time curve slope through the preprocessed temperature readings.

[0094] Due to the vibration of the pure inertial navigation sweeper itself, it is difficult to obtain a more accurate zero bias value. When the temperature changes slowly, the zero bias change caused by the temperature change is small, which is often lower than the deviation or calculation error caused by other factors. Therefore, when performing temperature bias compensation, only the case of faster temperature changes (target temperature difference-time curve slope> preset threshold) is considered.

[0095] Among them, the slope of the target temperature difference-time curve can be understood as the temperature change / duration. The multiple temperature readings of the temperature sensor corresponding to the second preset time period include the last temperature correction value, the current temperature correction value and the current temperature measurement value. Since the temperature value given by the temperature sensor has obvious noise, the temperature reading needs to be smoothed first. Therefore, after obtaining the multiple temperature readings of the temperature sensor corresponding to the second preset time period, the multiple temperature readings of the temperature sensor are first-order filtered through a preset first-order filtering formula to achieve filtering and noise reduction of the multiple temperature readings of the temperature sensor to obtain the preprocessed temperature readings, wherein the preset first-order filtering formula is as follows:

[0096] T n =k o ×T raw +(1-k o )×T n-1 , k o is the first-order filter coefficient, T n-1 , T n and T raw They are the previous temperature correction value, the current temperature correction value and the current temperature measurement value.

[0097] The target temperature difference-time curve slope is calculated through the preprocessed temperature readings, and it is determined whether the target temperature difference-time curve slope is less than or equal to a preset threshold. If the target temperature difference-time curve slope is less than or equal to the preset threshold, it indicates that angular velocity zero bias drift compensation is not required, and the first compensation strategy including angular direction deviation compensation is determined as the target compensation strategy; if the target temperature difference-time curve slope is greater than the preset threshold, it indicates that angular velocity zero bias drift compensation is required, and the second compensation strategy including angular velocity zero bias drift compensation and angular direction deviation compensation is determined as the target compensation strategy.

[0098] S304: Obtain the gyroscope z-axis zero bias value of the current moving direction, the first angular velocity zero bias value during the last pause, and the basic direction angle according to the first compensation strategy.

[0099] When the pure inertial navigation sweeper corrects the current traveling direction according to the first compensation strategy, the gyroscope z-axis zero bias value corresponding to the current traveling direction, the first angular velocity zero bias value at the last pause, and the basic direction angle are obtained.

[0100] S305 , calculating the current direction angular deviation value by using the gyroscope z-axis zero bias value of the current traveling direction and the first angular velocity zero bias value during the last pause.

[0101] The pure inertial navigation sweeper obtains the time between two zero bias updates, that is, the time between the current traveling direction and the last pause, and substitutes the time between the current traveling direction and the last pause, the gyroscope z-axis zero bias value of the current traveling direction and the first angular velocity zero bias value at the last pause into the preset direction angle deviation calculation formula to obtain the current direction angle deviation value, wherein the preset direction angle deviation calculation formula is as follows: Δangle 1 = (bias1 - bias last )×t last_motion / 2, Δangle1 represents the current direction angle deviation value, bias1 represents the gyroscope z-axis zero bias value in the current direction of travel, bias last Indicates the first angular velocity zero bias value at the last pause, t last_motion Indicates the time between the current moving direction and the last pause. It should be noted that when the current moving direction is the forward direction of the pure inertial navigation sweeper during pause operation, t last_motion Indicates the duration between the current pause and the previous pause.

[0102] S306: Compensate the basic direction angle of the current traveling direction by using the current direction angle deviation value to obtain a corrected traveling direction.

[0103] The pure inertial navigation sweeper compensates for the basic direction angle of the current travel direction by adding the basic direction angle of the current travel direction to the direction angle deviation value, and obtains the compensated direction angle, that is, the corrected travel direction, and uses the compensated direction angle as the basic direction angle for the next travel direction correction.

[0104] In the first preset period (1 second) after the pure inertial navigation sweeper continues to move straight, the pure inertial navigation sweeper still moves in the deviated direction, but due to the effectiveness of angle compensation, the sweeper will automatically correct the direction of travel to make it closer to the predetermined direction of travel.

[0105] S307: Alternatively, according to the second compensation strategy, obtain the first angular velocity zero bias value and the basic direction angle at the last pause of the current traveling direction.

[0106] When the pure inertial navigation sweeper corrects the current traveling direction according to the second compensation strategy, the first angular velocity zero bias value and the basic direction angle of the current traveling direction at the last pause are obtained.

[0107] S308, calculating the zero bias value after angular velocity zero bias drift compensation according to the first angular velocity zero bias value during the last pause.

[0108] Specifically, the pure inertial navigation sweeper obtains the target angular velocity zero bias drift compensation coefficient, the temperature correction value at the last pause, and the current temperature correction value; the target angular velocity zero bias drift compensation coefficient, the temperature correction value before the pause, the current temperature correction value, and the first angular velocity zero bias value at the last pause are calculated to obtain the zero bias value after the angular velocity zero bias drift compensation.

[0109] like Figure 4 As shown, Figure 4 In (1), the horizontal axis represents time and the vertical axis represents temperature. Figure 4 In (2), the horizontal axis represents time, and the vertical axis represents the slope of the temperature difference-time curve. Figure 4 In (3), the horizontal axis represents time, and the vertical axis represents the change in the gyroscope Z-axis degree zero bias (i.e., the angular velocity zero bias value). Figure 4It can be seen that the internal temperature rise rate of the pure inertial navigation sweeper is fast first and then slow, and the corresponding zero bias change is also fast first and then slow. After multiple tests, it is found that the gyroscope Z-axis degree zero bias change and the slope of the temperature difference-time curve (i.e., the temperature rise rate) show a similar trend, so the zero bias change can be estimated according to the temperature rise rate. According to experimental findings, the change trend of the gyroscope Z-axis degree zero bias is similar to the temperature difference-time change trend. Therefore, the relationship between the zero bias (i.e., the gyroscope Z-axis degree zero bias) and the temperature (temperature change rate) is expressed by the following formula B=f·ΔT, B represents the gyroscope Z-axis degree zero bias, f represents the compensation coefficient, ΔT represents the temperature change rate, and the key to the angular velocity zero bias drift compensation calculation is to estimate the value of the compensation coefficient f. It can be seen that the target angular velocity zero bias drift compensation coefficient is the key to the angular velocity zero bias drift compensation calculation. Therefore, the zero bias value after the angular velocity zero bias drift compensation is calculated by the target angular velocity zero bias drift compensation coefficient, the temperature correction value before the pause, the current temperature correction value, and the first angular velocity zero bias value at the last pause.

[0110] Substitute the target angular velocity zero bias drift compensation coefficient, the temperature correction value before the pause, the current temperature correction value and the first angular velocity zero bias value at the last pause into the preset current zero bias calculation formula to obtain the zero bias value after the angular velocity zero bias drift compensation, wherein the preset current zero bias calculation formula is as follows: bias = bias m-1 +p m ×(TT m-1 ), bias represents the zero bias value after angular velocity zero bias drift compensation (i.e., the zero bias value of the gyroscope z-axis in the current direction of travel), bias m-1 represents the first angular velocity zero bias value, T represents the temperature correction value before the pause, T m-1 Indicates the current temperature correction value.

[0111] Specifically, the execution process of the pure inertial navigation sweeper obtaining the target angular velocity zero bias drift compensation coefficient, the temperature correction value at the last pause and the current temperature correction value includes: calculating the basic angular velocity zero bias drift compensation coefficient according to the robot's motion state; obtaining the angular velocity zero bias drift compensation coefficient gain, and calculating the target angular velocity zero bias drift compensation coefficient through the basic angular velocity zero bias drift compensation coefficient and the angular velocity zero bias drift compensation coefficient gain; obtaining the temperature correction value at the last pause and the current temperature correction value.

[0112] Since the angular velocity zero bias drift compensation coefficient is updated every 30 seconds in actual applications, the parameters involved in the calculation of the target angular velocity zero bias drift compensation coefficient are all parameters corresponding to every 30 seconds, such as the basic angular velocity zero bias drift compensation coefficient. The pure inertial navigation sweeper obtains the robot's motion state in real time. If the robot's motion state meets the preset state conditions, the basic angular velocity zero bias drift compensation coefficient is calculated; the product of the basic angular velocity zero bias drift compensation coefficient and the angular velocity zero bias drift compensation coefficient gain is calculated to obtain the target angular velocity zero bias drift compensation coefficient.

[0113] In a feasible implementation, the execution process of obtaining the angular velocity zero bias drift compensation coefficient gain includes: fitting the exponential function of time (exponential function of time t) through the slope of the target temperature difference-time curve, and setting the fitted function to k=a×exp(b×t), where k represents the slope of the target temperature difference-time curve, a and b are coefficients in the fitted exponential function, and the fitting result is as follows: Figure 5 As shown, the horizontal axis t_1 represents time, and the vertical axis k_1 represents the slope of the target temperature difference-time curve. Further, by taking a value every 30 seconds on the curve of the target temperature difference-time curve slope, a recursive relationship can be obtained: k n =σ×k n -1, where σ is the angular velocity zero bias drift compensation coefficient gain. By recursive relationship: k n =σ×k n -1 can be used to calculate the angular velocity zero bias drift compensation coefficient gain σ, thereby obtaining the angular velocity zero bias drift compensation coefficient gain.

[0114] Among them, the temperature correction value at the last pause is the temperature value corrected for the temperature at the last pause, and the implementation method for obtaining the temperature correction value at the last pause is: reading the temperature at the last pause moment, adding the preset correction value to the temperature at the last pause moment, or correcting the temperature at the last pause moment by a preset correction factor; the current temperature correction value is the temperature value corrected for the current temperature, and the implementation method for obtaining the current temperature correction value is: reading the temperature at the current moment, adding the preset correction value to the temperature at the current moment, or correcting the temperature at the current moment by a preset correction factor.

[0115] Specifically, the execution process of the pure inertial navigation sweeper calculating the basic angular velocity zero bias drift compensation coefficient according to the robot's motion state includes: monitoring the robot's motion state, and when it is monitored that the robot's motion state meets the preset state conditions, obtaining the current zero bias value and the last updated zero bias value, as well as the current temperature and the temperature when the zero bias was last updated. The preset state conditions are used to indicate that the pause time reaches the third preset period (2-3 seconds), and the time interval between two pause states is greater than the second preset period (30 seconds); the current zero bias value, the last updated zero bias value, the current temperature and the temperature when the zero bias was last updated are calculated to obtain the basic angular velocity zero bias drift compensation coefficient.

[0116] The second preset period indicates the shortest time interval for angular velocity zero bias drift compensation, the pause time can be the time between the two static states from static before cleaning to the first pause, and the pause time can also be the time between the two pauses after the two static states from static before cleaning to the first pause. The robot motion state is monitored to determine whether the robot motion state meets the preset state conditions. If so, the current zero bias value and the last updated zero bias value, as well as the current temperature and the temperature when the zero bias was last updated; if not, continue monitoring until it is detected that the robot motion state meets the preset state conditions.

[0117] In practical applications, the angular velocity zero bias drift compensation coefficient is updated every 30 seconds. Therefore, the parameters involved in the calculation of the target angular velocity zero bias drift compensation coefficient are all corresponding parameters within every 30 seconds, that is, the current zero bias value is the zero bias value at the current moment within the current 30 seconds of the current calculation, the last updated zero bias value is the zero bias value at the last pause 30 seconds before the current calculation, that is, the first angular velocity zero bias value, the current temperature is the temperature at the current moment within the current 30 seconds of the current calculation, and the temperature at the last zero bias update is the temperature corresponding to the zero bias value at the last pause 30 seconds before the current calculation.

[0118] Calculate the difference between the current zero bias value and the last updated zero bias value (current zero bias value minus the last updated zero bias value) to obtain a first difference, and calculate the difference between the current temperature and the temperature at the last zero bias update (current temperature minus the temperature at the last zero bias update) to obtain a second difference; divide the first difference by the second difference to obtain a basic angular velocity zero bias drift compensation coefficient.

[0119] S309, calculating the current direction angular deviation value by using the first angular velocity zero bias value during the last pause and the zero bias value after angular velocity zero bias drift compensation.

[0120] The pure inertial navigation sweeper obtains the time between two zero bias updates, that is, the time between the current traveling direction and the last pause, and substitutes the time between the current traveling direction and the last pause, the zero bias value after angular velocity zero bias drift compensation, and the first angular velocity zero bias value at the last pause into the preset direction angle deviation calculation formula to obtain the current direction angle deviation value, where the preset direction angle deviation calculation formula is as follows: Δangle2 = (bias2 - bias last )×t last_motion / 2, Δangle2 represents the current direction angle deviation value, bias2 represents the zero bias value after angular velocity zero bias drift compensation, bias last Indicates the first angular velocity zero bias value at the last pause, t last_motion Indicates the time between the current moving direction and the last pause. It should be noted that when the current moving direction is the forward direction of the pure inertial navigation sweeper during pause operation, t last_motion Indicates the duration between the current pause and the previous pause.

[0121] S310 . Compensate the basic direction angle of the current traveling direction by using the current direction angle deviation value to obtain a corrected traveling direction.

[0122] The pure inertial navigation sweeper compensates for the basic direction angle of the current travel direction by adding the basic direction angle of the current travel direction to the direction angle deviation value, and obtains the compensated direction angle, that is, the corrected travel direction, and uses the compensated direction angle as the basic direction angle for the next travel direction correction.

[0123] During the first preset period (1 second) after the pure inertial navigation sweeper continues to move straight, the pure inertial navigation sweeper still moves in the deviated direction, but due to the effectiveness of angle compensation, the sweeper will automatically correct the direction of travel to make it closer to the predetermined direction of travel; in addition, due to the effectiveness of angular velocity zero bias drift compensation, the direction of travel of the pure inertial navigation sweeper no longer deviates significantly.

[0124] like Figure 6 As shown, Figure 6 The figure shows the treadmill effect of the angular velocity zero bias drift compensation strategy. Figure 6 (1) shows the temperature in a test using the angular velocity zero bias drift compensation strategy. Figure 6 (2) shows the gyroscope Z-axis reading in a test using the angular velocity zero bias drift compensation strategy. Figure 6(3) in FIG. 3 shows the gyroscope Z-axis reading zero bias curve (angular velocity zero bias) in a test using the angular velocity zero bias drift compensation strategy. It can be seen that since the zero bias cannot be updated in the motion state, the basic zero bias value curve is a horizontal straight line. After adding the angular velocity zero bias drift compensation, the gyroscope Z-axis reading zero bias curve shows the same trend as the temperature change curve. It can be seen that after adding the angular velocity zero bias drift compensation, the jump during the zero bias update is significantly reduced. For a pure inertial navigation sweeper, the zero bias error of the gyroscope reading is the main cause of the angle calculation deviation. The reduction of the zero bias error can effectively reduce the directional angle deviation.

[0125] like Figure 7 As shown, Figure 7 The figure shows the angular velocity zero bias change curve (angular velocity zero bias) achieved by the directional angle deviation compensation, which reflects the motion state of the pure inertial navigation sweeper. When the pure inertial navigation sweeper is moving, the zero bias is not calculated, and only compensation is performed. Figure 7 The part of the curve that changes steadily; when the pure inertial navigation sweeper is stationary, the zero bias is recalculated continuously, which is the part of the curve that changes dramatically. It can be seen that the zero bias value jumps before and after each stationary state of the pure inertial navigation sweeper. The compensation angle is calculated by taking the jump difference and the time of the zero bias stable change stage before the stationary state.

[0126] S311. Travel in the corrected travel direction.

[0127] The pure inertial navigation sweeper moves according to the corrected direction of travel and monitors in real time whether the current direction of travel deviates from the preset direction of travel.

[0128] Specifically, after the pure inertial navigation sweeper moves in the corrected direction of travel, it is determined whether the time traveled in the corrected direction of travel is greater than the fourth preset period of time; if the time traveled in the corrected direction of travel is greater than the fourth preset period of time, the operation is suspended according to the third preset period of time.

[0129] After the pure inertial navigation sweeper moves in the corrected direction of travel, when the running time exceeds the fourth preset period (120 seconds), the sweeper pauses for the third preset period (2 to 3 seconds) before the next straight travel. Specifically, whether the time traveled in the corrected direction of travel is greater than the fourth preset period; if so, the operation is suspended according to the third preset period; after each pause, the deviation change will be judged (that is, whether the current direction of travel is offset from the preset direction of travel), and the direction angle will be corrected (that is, the current direction of travel will be corrected), that is, the execution process of the above steps S101-S103 and the above steps S301-S309 will be repeated; if not, continue to move in the corrected direction of travel.

[0130] In the embodiment of the present invention, by detecting in real time whether the current traveling direction is offset from the preset traveling direction, and performing the traveling direction correction of the first compensation strategy or the second compensation strategy as needed, the operation and calculation load of the pure inertial navigation sweeper is reduced, and by combining the directional angle deviation compensation and the angular velocity zero bias drift compensation, the walking route angle after compensation (i.e., traveling according to the corrected traveling direction) will no longer have obvious deviations, and there is no need to perform a calibration process related to temperature control, and the calibration time is not increased. The compensation parameters are estimated in real time according to the temperature change rate, which has good adaptability and is suitable for robots with instant startup requirements, thereby improving the adaptability of the offset correction of the traveling direction.

[0131] See also Figure 8 Another embodiment of the method for correcting the deviation of the traveling direction in the embodiment of the present invention includes:

[0132] S801, step 1: when it is detected that the first operation time is greater than the fifth preset period, suspending operation according to the third preset period;

[0133] S802, step 2: when it is detected that the running time after the third preset period of time is suspended and then resumed is greater than the first preset period of time, detecting whether the current direction of travel is offset from the preset direction of travel, and determining the current target compensation strategy according to the detection result, the target compensation strategy is the first compensation strategy or the second compensation strategy, the first compensation strategy is the direction angle deviation compensation, and the second compensation strategy is the angular velocity zero bias drift compensation and the direction angle deviation compensation; correcting the current direction of travel according to the first compensation strategy or the second compensation strategy to obtain a corrected direction of travel; and traveling according to the corrected direction of travel;

[0134] S803, step three: when it is detected that the running time after traveling in the corrected traveling direction is greater than the fourth preset period, suspend the operation according to the third preset period and repeat step two.

[0135] During the operation of the pure inertial navigation sweeper, its internal temperature will gradually increase. If it is the first start after power-on or wake-up, the temperature will start to rise from room temperature. Generally speaking, the lower the initial temperature, the faster the temperature rises. Experiments have found that the temperature rises fastest within about 5 minutes after startup, and the resulting zero bias drift is also the most obvious. Therefore, as an example but not a limitation, this embodiment is described with the offset correction of the direction of travel about 5 minutes after the pure inertial navigation sweeper is started. In order to improve the accuracy of the angle calculation, the pure inertial navigation sweeper needs to pause at regular intervals during operation to allow the gyroscope zero bias to be updated.

[0136] The method for compensating for angular velocity zero bias drift in the offset correction method for the traveling direction in the embodiment of the present invention estimates the compensation coefficient by collecting the temperature change rate and zero bias change over a period of time, so angular velocity zero bias drift compensation will not be performed in the time period from startup to the first zero bias update. In order to reduce the angular offset caused by temperature rise, the pure inertial navigation sweeper adopts a movement strategy of pausing for 2 to 3 seconds after the first 30 seconds of operation, and then pausing for 2 to 3 seconds after 120 seconds. The accumulated angular error in the first operation without angular velocity zero bias drift compensation, as well as the subsequent angular calculation error caused by zero bias jump, will be estimated and compensated after each zero bias update.

[0137] Therefore, as an example but not limitation, the first preset period in the embodiment of the present invention is 1 second, the second preset period is 30 seconds, the third preset period is 2-3 seconds, the fourth preset period is 120 seconds, the fifth preset period is 30 seconds, and the sixth preset period is 5 minutes.

[0138] Among them, the above-mentioned step S803 and step three: when it is detected that the running time after moving in the corrected direction of travel is greater than the fourth preset time period, the operation is suspended according to the third preset time period, and step two is repeated. The first compensation strategy is repeatedly executed during the operation of the pure inertial navigation sweeper; the execution condition of the second compensation strategy during the operation of the pure inertial navigation sweeper is whether the slope of the temperature difference-time curve is greater than the preset threshold. If the slope of the temperature difference-time curve is greater than the preset threshold, the second compensation strategy is repeatedly executed until the slope of the temperature difference-time curve is less than the preset threshold. Furthermore, when the preset threshold is 0, the second compensation strategy can be repeatedly executed until the slope of the temperature difference-time curve is less than or equal to the preset threshold.

[0139] The execution process of steps S801-S803 of this embodiment is similar to the execution process of steps S301-S311 described above, and will not be repeated here.

[0140] In the embodiment of the present invention, the pure inertial navigation sweeper adopts a motion strategy of pausing the first preset period (2 to 3 seconds) after the fifth preset period (30 seconds) of the first operation, and then pausing the first preset period (2 to 3 seconds) after the fourth preset period (120 seconds), thereby reducing the angle deviation caused by temperature rise, and detecting in real time whether the current direction of travel is offset from the preset direction of travel, and performing the first compensation strategy or the second compensation strategy for the direction of travel correction as required, thereby reducing the operation and calculation load of the pure inertial navigation sweeper, and combining the angular deviation compensation and the angular velocity zero deviation drift compensation, so that the walking route angle after compensation (i.e., traveling according to the corrected direction of travel) will no longer have obvious deviations, and there is no need to perform a calibration process related to temperature control, and the calibration time is not increased. The compensation parameters are estimated in real time according to the temperature change rate, and the robot has good adaptability, is suitable for robots with instant startup requirements, and improves the adaptability of the offset correction of the direction of travel.

[0141] The above describes the deviation correction method of the traveling direction in the embodiment of the present invention. The following describes the deviation correction device of the traveling direction in the embodiment of the present invention. Fig. 9 , an embodiment of the device for correcting the deviation in the traveling direction in the embodiment of the present invention includes:

[0142] A determination module 901 is used to determine a current target compensation strategy when it is detected that the current traveling direction deviates from the preset traveling direction, the target compensation strategy being a first compensation strategy or a second compensation strategy, the first compensation strategy being angular deviation compensation, and the second compensation strategy being angular velocity zero bias drift compensation and angular deviation compensation;

[0143] A correction module 902, configured to correct the current traveling direction according to the first compensation strategy or the second compensation strategy to obtain a corrected traveling direction;

[0144] The traveling module 903 is used to travel in the corrected traveling direction.

[0145] The functional implementation of each module in the above-mentioned device for correcting the deviation in the traveling direction corresponds to each step in the above-mentioned embodiment of the method for correcting the deviation in the traveling direction, and its functions and implementation processes will not be described one by one here.

[0146] In the embodiment of the present invention, by detecting in real time whether the current traveling direction is offset from the preset traveling direction, and performing the traveling direction correction of the first compensation strategy or the second compensation strategy as needed, the operation and calculation load of the pure inertial navigation sweeper is reduced, and by combining the directional angle deviation compensation and the angular velocity zero bias drift compensation, the walking route angle after compensation (i.e., traveling according to the corrected traveling direction) will no longer have obvious deviations, and there is no need to perform a calibration process related to temperature control, and the calibration time is not increased. The compensation parameters are estimated in real time according to the temperature change rate, which has good adaptability and is suitable for robots with instant startup requirements, thereby improving the adaptability of the offset correction of the traveling direction.

[0147] See also Fig.10 Another embodiment of the device for correcting the deviation in the traveling direction in the embodiment of the present invention includes:

[0148] An acquisition module 904 is used to acquire a first angular velocity zero bias value at the last pause and a second angular velocity zero bias value at the current moment when it is detected that the running time of the re-movement after the pause is greater than a first preset period of time;

[0149] A detection module 905 is used to detect whether the current traveling direction deviates from the preset traveling direction through the first angular velocity zero bias value and the second angular velocity zero bias value;

[0150] A determination module 901 is used to determine a current target compensation strategy when it is detected that the current traveling direction deviates from the preset traveling direction, the target compensation strategy being a first compensation strategy or a second compensation strategy, the first compensation strategy being angular deviation compensation, and the second compensation strategy being angular velocity zero bias drift compensation and angular deviation compensation;

[0151] A correction module 902, configured to correct the current traveling direction according to the first compensation strategy or the second compensation strategy to obtain a corrected traveling direction;

[0152] The correction module 902 specifically includes:

[0153] A first acquisition submodule 9021 is used to acquire the gyroscope z-axis zero bias value of the current traveling direction, the first angular velocity zero bias value at the last pause, and the basic direction angle according to the first compensation strategy;

[0154] The first calculation submodule 9022 is used to calculate the current direction angular deviation value through the gyroscope z-axis zero bias value of the current traveling direction and the first angular velocity zero bias value during the last pause;

[0155] The first compensation submodule 9023 is used to compensate the basic direction angle of the current traveling direction by using the current direction angle deviation value to obtain a corrected traveling direction;

[0156] Alternatively, the second acquisition submodule 9024 is used to acquire the first angular velocity zero bias value and the basic direction angle at the last pause of the current traveling direction according to the second compensation strategy;

[0157] The second calculation submodule 9025 is used to calculate the zero bias value after angular velocity zero bias drift compensation according to the first angular velocity zero bias value during the last pause;

[0158] The third calculation submodule 9026 is used to calculate the current direction angular deviation value by using the first angular velocity zero bias value at the last pause and the zero bias value after angular velocity zero bias drift compensation;

[0159] The second compensation submodule 9027 is used to compensate the basic direction angle of the current traveling direction by using the current direction angle deviation value to obtain a corrected traveling direction;

[0160] The traveling module 903 is used to travel in the corrected traveling direction.

[0161] Optionally, the determining module 901 includes:

[0162] The third acquisition unit 9011 is used to acquire the slope of the target temperature difference-time curve of the sensor within a second preset time period when it is detected that the current travel direction deviates from the preset travel direction;

[0163] A judgment unit 9012 is used to judge whether the slope of the target temperature difference-time curve is greater than a preset threshold;

[0164] A first determination unit 9013 is used to determine a first compensation strategy as a target compensation strategy if the slope of the target temperature difference-time curve is less than or equal to a preset threshold, and the first compensation strategy is directional angle deviation compensation;

[0165] The second determination unit 9014 is used to determine the second compensation strategy as the target compensation strategy if the slope of the target temperature difference-time curve is greater than a preset threshold, and the second compensation strategy is angular velocity zero bias drift compensation and directional angle deviation compensation.

[0166] Optionally, the third obtaining unit 9011 may also be specifically configured to:

[0167] When it is detected that the current traveling direction deviates from the preset traveling direction, a plurality of temperature readings of the temperature sensor corresponding to a second preset time period are obtained;

[0168] Performing filtering and noise reduction processing on multiple temperature readings of the temperature sensor to obtain preprocessed temperature readings;

[0169] The slope of the target temperature difference-time curve is calculated using the preprocessed temperature readings.

[0170] Optionally, the second calculation submodule 9025 includes:

[0171] An acquisition unit 90251 is used to acquire a target angular velocity zero bias drift compensation coefficient, a temperature correction value at the last pause, and a current temperature correction value;

[0172] The operation unit 90252 is used to calculate the target angular velocity zero bias drift compensation coefficient, the temperature correction value before the pause, the current temperature correction value and the first angular velocity zero bias value during the last pause to obtain the zero bias value after the angular velocity zero bias drift is compensated.

[0173] Optionally, the acquisition unit 90251 includes:

[0174] The first calculation subunit 902511 is used to calculate the basic angular velocity zero bias drift compensation coefficient according to the robot motion state;

[0175] The second calculation subunit 902512 is used to obtain the angular velocity zero bias drift compensation coefficient gain, and calculate the target angular velocity zero bias drift compensation coefficient through the basic angular velocity zero bias drift compensation coefficient and the angular velocity zero bias drift compensation coefficient gain;

[0176] The acquisition subunit 902513 is used to obtain the temperature correction value at the last pause and the current temperature correction value.

[0177] Optionally, the first computing subunit 902511 may also be specifically used for:

[0178] The robot motion state is monitored, and when it is monitored that the robot motion state meets the preset state condition, the current zero bias value and the last updated zero bias value, as well as the current temperature and the temperature when the zero bias was last updated are obtained, and the preset state condition is used to indicate that the pause motion time reaches a third preset period, and the time interval between two pause states is greater than the second preset period;

[0179] The current zero bias value, the last updated zero bias value, the current temperature and the temperature of the last zero bias update are calculated to obtain the basic angular velocity zero bias drift compensation coefficient.

[0180] Optionally, the deviation correction device for the traveling direction also includes:

[0181] A determination module 906, configured to determine whether the time taken to travel in the corrected traveling direction is greater than a fourth preset period of time;

[0182] The pause module 907 is configured to pause the operation according to the third preset time period if the time traveled according to the corrected travel direction is greater than the fourth preset time period.

[0183] In the embodiment of the present invention, by detecting in real time whether the current traveling direction is offset from the preset traveling direction, and performing the traveling direction correction of the first compensation strategy or the second compensation strategy as needed, the operation and calculation load of the pure inertial navigation sweeper is reduced, and by combining the directional angle deviation compensation and the angular velocity zero bias drift compensation, the walking route angle after compensation (i.e., traveling according to the corrected traveling direction) will no longer have obvious deviations, and there is no need to perform a calibration process related to temperature control, and the calibration time is not increased. The compensation parameters are estimated in real time according to the temperature change rate, which has good adaptability and is suitable for robots with instant startup requirements, thereby improving the adaptability of the offset correction of the traveling direction.

[0184] See also Fig.11 Another embodiment of the device for correcting the deviation in the traveling direction in the embodiment of the present invention includes:

[0185] The suspension operation module 1101 is used to execute step 1: when it is detected that the first operation time is greater than the fifth preset period, suspend the operation according to the third preset period;

[0186] The compensation module 1102 is used to execute step 2: when it is detected that the running time after the third preset period of time is suspended and then resumed is greater than the first preset period of time, detect whether the current traveling direction is offset from the preset traveling direction, and determine the current target compensation strategy according to the detection result, the target compensation strategy is the first compensation strategy or the second compensation strategy, the first compensation strategy is the direction angle deviation compensation, and the second compensation strategy is the angular velocity zero bias drift compensation and the direction angle deviation compensation; according to the first compensation strategy or the second compensation strategy, correct the current traveling direction to obtain a corrected traveling direction; and travel according to the corrected traveling direction;

[0187] The repeat execution module 1103 is used to execute step three: when it is detected that the running time after traveling in the corrected traveling direction is greater than the fourth preset time period, the running is suspended according to the third preset time period, and step two is repeated.

[0188] In the embodiment of the present invention, the pure inertial navigation sweeper adopts a motion strategy of pausing the first preset period (2 to 3 seconds) after the fifth preset period (30 seconds) of the first operation, and then pausing the first preset period (2 to 3 seconds) after the fourth preset period (120 seconds), thereby reducing the angle deviation caused by temperature rise, and detecting in real time whether the current direction of travel is offset from the preset direction of travel, and performing the first compensation strategy or the second compensation strategy for the direction of travel correction as required, thereby reducing the operation and calculation load of the pure inertial navigation sweeper, and combining the angular deviation compensation and the angular velocity zero deviation drift compensation, so that the walking route angle after compensation (i.e., traveling according to the corrected direction of travel) will no longer have obvious deviations, and there is no need to perform a calibration process related to temperature control, and the calibration time is not increased. The compensation parameters are estimated in real time according to the temperature change rate, and the robot has good adaptability, is suitable for robots with instant startup requirements, and improves the adaptability of the offset correction of the direction of travel.

[0189] above Fig. 9 , Fig.10 and Fig.11 The traveling direction deviation correction device in the embodiment of the present invention is described in detail from the perspective of modular functional entities. The intelligent device based on unit decomposition in the embodiment of the present invention is described in detail from the perspective of hardware processing.

[0190] Fig.12 1 is a schematic diagram of the structure of a smart device provided by an embodiment of the present invention. The smart device 1200 may have relatively large differences due to different configurations or performances, and may include one or more processors (central processing units, CPU) 1210 (for example, one or more processors) and a memory 1220, and one or more storage media 1230 (for example, one or more mass storage devices) storing application programs 1233 or data 1232. Among them, the memory 1220 and the storage medium 1230 can be short-term storage or permanent storage. The program stored in the storage medium 1230 may include one or more modules (not shown in the figure), and each module may include a series of instruction operations in the smart device 1200. Furthermore, the processor 1210 may be configured to communicate with the storage medium 1230 to execute a series of instruction operations in the storage medium 1230 on the smart device 1200.

[0191] The smart device 1200 may also include one or more power supplies 1240, one or more wired or wireless network interfaces 1250, one or more input and output interfaces 1260, and / or one or more operating systems 1231, such as Windows Server, Mac OS X, Unix, Linux, FreeBSD, etc. Those skilled in the art will appreciate that Fig.12 The structure of the smart device shown does not constitute a limitation on the smart device, and may include more or less components than shown in the figure, or combine certain components, or arrange the components differently.

[0192] The present invention also provides a computer-readable storage medium, which may be a non-volatile computer-readable storage medium or a volatile computer-readable storage medium. A computer program is stored in the computer-readable storage medium. When the computer program runs on a computer, the computer executes the steps of the method for correcting the offset of the direction of travel.

[0193] Those skilled in the art can clearly understand that, for the convenience and brevity of description, the specific working processes of the systems, devices and units described above can refer to the corresponding processes in the aforementioned method embodiments and will not be repeated here.

[0194] If the integrated unit is implemented in the form of a software functional unit and sold or used as an independent product, it can be stored in a computer-readable storage medium. Based on this understanding, the technical solution of the present invention, or the part that contributes to the prior art, or all or part of the technical solution can be embodied in the form of a software product, which is stored in a storage medium and includes several computer programs to enable a computer device (which can be a personal computer, server, or network device, etc.) to perform all or part of the steps of the methods of various embodiments of the present invention. The aforementioned storage medium includes: U disk, mobile hard disk, read-only memory (ROM), random access memory (RAM), disk or optical disk, etc., various media that can store program codes.

[0195] The above embodiments are only used to illustrate the technical solutions of the present invention, rather than to limit the same. Although the present invention has been described in detail with reference to the aforementioned embodiments, those skilled in the art should understand that the technical solutions described in the aforementioned embodiments may still be modified, or some of the technical features thereof may be replaced by equivalents. However, these modifications or replacements do not deviate the essence of the corresponding technical solutions from the spirit and scope of the technical solutions of the embodiments of the present invention.

Claims

1. A method for correcting deviation in a traveling direction, characterized in that: The deviation correction method of the traveling direction includes: When it is detected that the current traveling direction is offset from the preset traveling direction, the target temperature difference-time curve slope of the sensor within the second preset time period is obtained, and the current target compensation strategy is determined according to the target temperature difference-time curve slope, the target compensation strategy includes a first compensation strategy and a second compensation strategy, the first compensation strategy is directional angle deviation compensation, the second compensation strategy is angular velocity zero bias drift compensation and directional angle deviation compensation, the angular velocity zero bias drift compensation is to estimate the compensation parameter in real time according to the temperature change rate, the compensation parameter is calculated based on the target angular velocity zero bias drift compensation coefficient, the target angular velocity zero bias drift compensation coefficient is calculated based on the angular velocity zero bias drift compensation coefficient gain, and the angular velocity zero bias drift compensation coefficient gain is calculated by the following method: obtain a curve of the target temperature difference-time curve slope; obtain a recursive relationship on the curve of the target temperature difference-time curve slope; and infer the angular velocity zero bias drift compensation coefficient gain through the recursive relationship; According to a corresponding compensation strategy, the current traveling direction is corrected to obtain a corrected traveling direction; Proceed in the corrected direction of travel.

2. The method for correcting the deviation of the traveling direction according to claim 1, characterized in that: When the current traveling direction is detected to be offset from the preset traveling direction, before determining the current target compensation strategy, the method further includes: When it is detected that the running time of the re-movement after the pause is greater than the first preset period, the first angular velocity zero bias value at the last pause and the second angular velocity zero bias value at the current moment are obtained; By using the first angular velocity zero bias value and the second angular velocity zero bias value, it is detected whether the current traveling direction deviates from the preset traveling direction.

3. The method for correcting the deviation of the traveling direction according to claim 1 or 2, characterized in that: When the current traveling direction is detected to be offset from the preset traveling direction, a current target compensation strategy is determined, the target compensation strategy includes a first compensation strategy and a second compensation strategy, the first compensation strategy is directional angle deviation compensation, the second compensation strategy is angular velocity zero bias drift compensation and directional angle deviation compensation, including: When it is detected that the current traveling direction deviates from the preset traveling direction, the slope of the target temperature difference-time curve of the sensor within the second preset time period is obtained; Determine whether the slope of the target temperature difference-time curve is greater than a preset threshold; If the slope of the target temperature difference-time curve is less than or equal to a preset threshold, a first compensation strategy is determined as the target compensation strategy, wherein the first compensation strategy is directional angle deviation compensation; If the slope of the target temperature difference-time curve is greater than a preset threshold, a second compensation strategy is determined as the target compensation strategy, and the second compensation strategy is angular velocity zero bias drift compensation and directional angle deviation compensation.

4. The method for correcting the deviation in the traveling direction according to claim 3, characterized in that: When detecting that the current traveling direction deviates from the preset traveling direction, obtaining the slope of the target temperature difference-time curve of the sensor within the second preset time period includes: When it is detected that the current traveling direction deviates from the preset traveling direction, a plurality of temperature readings of the temperature sensor corresponding to a second preset time period are obtained; Performing filtering and noise reduction processing on multiple temperature readings of the temperature sensor to obtain pre-processed temperature readings; The target temperature difference-time curve slope is calculated through the pre-processed temperature readings.

5. The method for correcting the deviation of the traveling direction according to claim 2, characterized in that: The correcting the current traveling direction according to the corresponding compensation strategy to obtain a corrected traveling direction includes: According to the first compensation strategy, the gyroscope z-axis zero bias value of the current traveling direction, the first angular velocity zero bias value at the last pause, and the basic direction angle are obtained; Calculate the current direction angular deviation value by using the gyroscope z-axis zero bias value of the current traveling direction and the first angular velocity zero bias value during the last pause; The basic direction angle of the current traveling direction is compensated by the direction angle deviation value to obtain a corrected traveling direction; Alternatively, according to the second compensation strategy, the first angular velocity zero bias value and the basic direction angle at the last pause of the current traveling direction are obtained; Calculating the zero bias value after angular velocity zero bias drift compensation by using the first angular velocity zero bias value during the last pause; Calculating the current direction angular deviation value by using the first angular velocity zero bias value during the last pause and the zero bias value after the angular velocity zero bias drift compensation; The basic direction angle of the current traveling direction is compensated by the current direction angle deviation value to obtain a corrected traveling direction.

6. The method for correcting the deviation of the traveling direction according to claim 5, characterized in that: The calculating the zero bias value after angular velocity zero bias drift compensation by using the first angular velocity zero bias value during the last pause includes: Get the target angular velocity zero bias drift compensation coefficient, the temperature correction value at the last pause, and the current temperature correction value; The target angular velocity zero bias drift compensation coefficient, the temperature correction value before the last pause, the current temperature correction value and the first angular velocity zero bias value during the last pause are calculated to obtain the zero bias value after the angular velocity zero bias drift compensation.

7. The method for correcting the deviation in the traveling direction according to claim 6, characterized in that: The step of obtaining the target angular velocity zero bias drift compensation coefficient, the temperature correction value at the last pause, and the current temperature correction value includes: Calculate the basic angular velocity zero bias drift compensation coefficient according to the robot's motion state; Obtaining a curve of the target temperature difference-time curve slope; obtaining a recursive relationship on the curve of the target temperature difference-time curve slope; and calculating the angular velocity zero bias drift compensation coefficient gain through the recursive relationship; Calculating a target angular velocity zero bias drift compensation coefficient by using the basic angular velocity zero bias drift compensation coefficient and the angular velocity zero bias drift compensation coefficient gain; Get the temperature correction value at the last pause and the current temperature correction value.

8. The method for correcting the deviation of the traveling direction according to claim 7, characterized in that: The method of calculating the basic angular velocity zero bias drift compensation coefficient according to the robot motion state includes: The robot motion state is monitored, and when it is monitored that the robot motion state meets the preset state condition, the current zero bias value and the last updated zero bias value, as well as the current temperature and the temperature when the zero bias was last updated are obtained, wherein the preset state condition is used to indicate that the pause motion time reaches a third preset period, and the time interval between two pause states is greater than the second preset period; The current zero bias value, the last updated zero bias value, the current temperature and the temperature of the last zero bias update are calculated to obtain a basic angular velocity zero bias drift compensation coefficient.

9. The method for correcting the deviation of the traveling direction according to claim 1, characterized in that: After the traveling in the corrected traveling direction, the method further includes: Determining whether the time traveled in the corrected traveling direction is greater than a fourth preset time period; If the time traveled in the corrected traveling direction is greater than the fourth preset period, the operation is suspended according to the third preset period.

10. A method for correcting deviation in a traveling direction, characterized in that: The deviation correction method of the traveling direction includes: Step 1: When it is detected that the first operation time is greater than the fifth preset period, the operation is suspended according to the third preset period; Step 2: When it is detected that the running time after the operation is resumed after being suspended for the third preset period is greater than the first preset period, detect whether the current travel direction is offset from the preset travel direction, and determine the current target compensation strategy according to the detection result, the target compensation strategy includes a first compensation strategy and a second compensation strategy, the first compensation strategy is directional angle deviation compensation, the second compensation strategy is angular velocity zero bias drift compensation and directional angle deviation compensation, the angular velocity zero bias drift compensation is to estimate the compensation parameter in real time according to the temperature change rate, the compensation parameter is calculated based on the target angular velocity zero bias drift compensation coefficient, the target angular velocity zero bias drift compensation coefficient is calculated based on the angular velocity zero bias drift compensation coefficient gain, the angular velocity zero bias drift compensation coefficient gain is calculated by the following method: obtain a curve of the slope of the target temperature difference-time curve; obtain a recursive relationship on the curve of the slope of the target temperature difference-time curve; calculate the angular velocity zero bias drift compensation coefficient gain through the recursive relationship; according to the corresponding compensation strategy, correct the current travel direction to obtain a corrected travel direction; travel according to the corrected travel direction; Step three: when it is detected that the running time after traveling in the corrected traveling direction is greater than the fourth preset period, suspending the operation according to the third preset period and repeating step two.

11. A device for correcting deviation in the travel direction, characterized in that: The deviation correction device of the traveling direction comprises: A determination module, for obtaining a target temperature difference-time curve slope of the sensor within a second preset time period when detecting that the current direction of travel is offset from a preset direction of travel, and determining a current target compensation strategy according to the target temperature difference-time curve slope, wherein the target compensation strategy includes a first compensation strategy and a second compensation strategy, wherein the first compensation strategy is directional angle deviation compensation, and the second compensation strategy is angular velocity zero bias drift compensation and directional angle deviation compensation, wherein the angular velocity zero bias drift compensation is to estimate a compensation parameter in real time according to a temperature change rate, wherein the compensation parameter is calculated based on a target angular velocity zero bias drift compensation coefficient, wherein the target angular velocity zero bias drift compensation coefficient is calculated based on an angular velocity zero bias drift compensation coefficient gain, and wherein the angular velocity zero bias drift compensation coefficient gain is calculated by the following method: obtaining a curve of a target temperature difference-time curve slope; obtaining a recursive relationship on the curve of a target temperature difference-time curve slope; and calculating an angular velocity zero bias drift compensation coefficient gain through the recursive relationship; A correction module, used for correcting the current traveling direction according to a corresponding compensation strategy to obtain a corrected traveling direction; A traveling module is used to travel in the corrected traveling direction.

12. A device for correcting deviation in the traveling direction, characterized in that: The deviation correction device of the traveling direction comprises: The suspension operation module is used to execute step 1: when it is detected that the first operation time is greater than the fifth preset time period, suspend the operation according to the third preset time period; A compensation module, used to execute step 2: when it is detected that the running time after the operation is resumed after pausing for a third preset period is greater than the first preset period, detect whether the current travel direction is offset from the preset travel direction, and determine the current target compensation strategy according to the detection result, the target compensation strategy includes a first compensation strategy and a second compensation strategy, the first compensation strategy is directional angle deviation compensation, the second compensation strategy is angular velocity zero bias drift compensation and directional angle deviation compensation, the angular velocity zero bias drift compensation is to estimate the compensation parameter in real time according to the temperature change rate, the compensation parameter is calculated based on the target angular velocity zero bias drift compensation coefficient, the target angular velocity zero bias drift compensation coefficient is calculated based on the angular velocity zero bias drift compensation coefficient gain, the angular velocity zero bias drift compensation coefficient gain is calculated by the following method: obtain a curve of the slope of the target temperature difference-time curve; obtain a recursive relationship on the curve of the slope of the target temperature difference-time curve; calculate the angular velocity zero bias drift compensation coefficient gain through the recursive relationship; according to the corresponding compensation strategy, correct the current travel direction to obtain a corrected travel direction; travel according to the corrected travel direction; The repeating execution module is used to execute step three: when it is detected that the running time after traveling in the corrected traveling direction is greater than the fourth preset time period, suspend the operation according to the third preset time period and repeat step two.

13. A smart device, characterized in that: The smart device comprises: a memory and at least one processor, wherein the memory stores a computer program; The at least one processor calls the computer program in the memory to enable the smart device to execute the method for correcting the deviation of the traveling direction as described in any one of claims 1-10.

14. A computer-readable storage medium having a computer program stored thereon, characterized in that: When the computer program is executed by a processor, the method for correcting the deviation of the traveling direction as described in any one of claims 1 to 10 is implemented.