Gyroscope zero offset calibration method and related equipment

By calculating and updating the zero deviation of the MEMS gyroscope in real time in an unmanned lawn mower, and adjusting the angle with preset integral frequency, the problem of poor stability of the gyroscope is solved, and the precise control of the equipment angle and travel path are realized reliability.

CN118980390APending Publication Date: 2024-11-19ZHEJIANG YAT ELECTRICAL APPLIANCE CO LTD
View PDF 0 Cites 1 Cited by

Patent Information

Application Number
CN202411103101.1
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-08-12
Publication Date
2024-11-19

AI Technical Summary

Technical Problem

MEMS gyroscopes have poor stability in unmanned lawn mowers, making it difficult for the equipment to effectively control the angle, especially after long-term work, errors will gradually accumulate, affecting the accuracy of the equipment's travel path. sex.

Method used

By judging the stationary state after power starts on the power equipment, calculating the basic zero deviation, and judging the equipment status based on the real-time value and calibration value, reupdating the zero deviation to prevent error accumulation, and using the preset integral frequency to perform angle integration on the gyroscope to adjust Direction of travel.

Benefits of technology

Effectively keep the gyroscope's zero deviation error within a controllable range, ensure the reliability and accuracy of the equipment's travel path during work, reduce angle errors, and improve mowing efficiency.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118980390A_ABST
    Figure CN118980390A_ABST
Patent Text Reader

Abstract

The invention provides a gyroscope zero offset calibration method and related equipment, and relates to the field of navigation.The method comprises the steps that after power equipment is powered on and started, whether the power equipment is in a static state or not is judged, when the power equipment is in the static state, basic zero offset of the power equipment is calculated, and a first actual gyroscope value is obtained through calculation based on the basic zero offset; whether the power equipment is in a moving state or a static state is judged based on the calculation result of the first actual gyroscope value and the calibration value, when the power equipment is in the static state, the basic zero offset of the gyroscope is calculated again, and in the process, when it is detected that the equipment is static once, the basic zero offset is updated once; the zero offset error of the gyroscope cannot be accumulated, and the accuracy of the zero offset error is ensured to the greatest extent, so that the reliability of the advancing path of the power equipment in the working process is effectively ensured.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the field of navigation technology, and in particular to a gyroscope zero bias calibration method and related equipment. Background Art

[0002] MEMS gyroscope, the full name of which is Micro Electro Mechanical Systems Gyroscope, is a miniaturized gyroscope made using micro-electromechanical systems (MEMS) technology.

[0003] Unmanned lawn mowers, also known as smart lawn mowers or robot lawn mowers, are lawn mowing equipment that integrates advanced technology and automation functions. This type of lawn mower can autonomously complete lawn mowing without manual operation, greatly improving the efficiency and convenience of mowing.

[0004] During operation, the smart lawn mower starts from the charging station and mows the entire area within the electronic fence, which involves constant turning and U-turns. These behaviors require the smart lawn mower to know the angle of each turn during the operation in order to adjust its own direction of travel. When calculating the angle of each turn, the MEMS gyroscope sensor is needed to calculate the angle.

[0005] Generally, a MEMS gyroscope has a large zero bias and poor zero bias stability. Moreover, as the working time increases, the zero bias error will gradually accumulate, eventually making it difficult to effectively control the angle of the device (the device equipped with the MEMS gyroscope). Summary of the invention

[0006] In view of this, an embodiment of the present invention provides a gyroscope zero bias calibration method and related equipment to provide a reliable gyroscope zero bias for a power device during its operation.

[0007] To achieve the above objectives, the embodiments of the present invention provide the following technical solutions:

[0008] A gyroscope zero bias calibration method, comprising:

[0009] After the power device is powered on and started, determining whether the power device is in a stationary state, wherein the gyroscope is installed in the power device;

[0010] When the power device is in a stationary state, calculating the basic zero bias of the gyroscope;

[0011] Collecting the real-time value of the gyroscope, and calculating an actual calculated gyroscope value based on the real-time value and the basic zero bias, which is recorded as a first actual gyroscope value;

[0012] Determining whether the first actual gyroscope value is greater than a calibration value;

[0013] When the first actual gyroscope value is not greater than the calibration value, it is determined that the power device is in a stationary state, and the steps of calculating the basic zero bias of the gyroscope and subsequent steps are re-executed until the first actual gyroscope value is greater than the calibration value.

[0014] Optionally, in the above gyroscope zero bias calibration method, before determining whether the first actual gyroscope value is greater than the calibration value, the method further includes:

[0015] Based on a preset time interval, the calibration value of the gyroscope is updated.

[0016] Optionally, in the above gyroscope zero bias calibration method, the calibration value is:

[0017] noise=noise0+a;

[0018] The noise is a calibrated value, the noise0 is the gyroscope zero bias noise when the power equipment is in a stationary state, and a is a preset margin.

[0019] Optionally, in the above gyroscope bias calibration method, calculating the basic bias of the gyroscope includes:

[0020] Get the real-time value of the gyroscope collected at each moment in the time period to which the current moment belongs, and calculate the basic zero bias of the gyroscope.

[0021] Optionally, in the above gyroscope zero bias calibration method, when the first actual gyroscope value is greater than the calibration value, the method further includes:

[0022] The gyroscope is angle-integrated based on a preset integration frequency.

[0023] Optionally, in the above gyroscope zero bias calibration method, performing angle integration on the gyroscope based on a preset integration frequency includes:

[0024] Obtaining the travel speed of the power device;

[0025] Acquire a target integrated frequency that matches the travel speed;

[0026] The gyroscope is angle-integrated based on the target integration frequency.

[0027] Optionally, in the above gyroscope zero bias calibration method, performing angle integration on the gyroscope based on a preset integration frequency includes:

[0028] Performing angle integration on the first actual gyroscope value based on the formula yaw+=gyro_cal*(1 / f);

[0029] Among them, gyro_cal is the first actual gyroscope value, f is the preset integration frequency, and yaw is the integration result.

[0030] A gyroscope zero bias calibration device, comprising:

[0031] A startup judgment unit, used for judging whether the power device is in a stationary state after the power device is powered on and started, wherein the gyroscope is installed in the power device;

[0032] A basic zero bias calculation unit, used for calculating the basic zero bias of the gyroscope when the power device is in a stationary state;

[0033] An actual gyroscope value calculation unit, used for collecting the real-time value of the gyroscope, and calculating an actual calculated gyroscope value based on the real-time value and the basic zero bias, which is recorded as a first actual gyroscope value;

[0034] The device state judgment unit is used to judge whether the first actual gyroscope value is greater than the calibration value. When the first actual gyroscope value is not greater than the calibration value, it is determined that the power device is in a stationary state, and a trigger signal for controlling the operation of the basic zero bias calculation unit is output to the basic zero bias calculation unit.

[0035] A computer program product includes computer-readable instructions. When the computer-readable instructions are executed on a power device, the power device implements any one of the above-mentioned gyroscope zero bias calibration methods.

[0036] A power device, comprising at least one processor and a memory connected to the processor, wherein:

[0037] The memory is used to store computer programs;

[0038] The processor is used to execute the computer program so that the power device can implement the gyroscope zero bias calibration method as described in any one of the above.

[0039] Optionally, the power equipment is a lawn mower or a sweeping robot.

[0040] A computer storage medium carries one or more computer programs. When the one or more computer programs are executed by a power device, the power device can implement any one of the gyroscope zero bias calibration methods described above.

[0041] Based on the above technical scheme, the above scheme provided by the embodiment of the present invention determines whether the power device is in a stationary state after the power device is powered on and started. When the power device is in a stationary state, the basic zero bias of the power device is calculated, and a first actual gyroscope value is calculated based on the basic zero bias. Then, based on the calculation result of the first actual gyroscope value and the calibration value, it is determined whether the power device is in a moving state or a stationary state. When the power device is in a stationary state, the basic zero bias of the gyroscope is recalculated. In this process, each time the device is detected to be stationary, the basic zero bias is updated, so that the zero bias error of the gyroscope cannot be accumulated, thereby ensuring the accuracy of the zero bias error to the greatest extent, thereby effectively ensuring the reliability of the travel path of the power device during operation. BRIEF DESCRIPTION OF THE DRAWINGS

[0042] In order to more clearly illustrate the embodiments of the present invention or the technical solutions in the prior art, the drawings required for use in the embodiments or the description of the prior art will be briefly introduced below. Obviously, the drawings described below are only embodiments of the present invention. For ordinary technicians in this field, other drawings can be obtained based on the provided drawings without paying creative work.

[0043] Figure 1 A schematic diagram of a flow chart of a gyroscope zero bias calibration method disclosed in an embodiment of the present application;

[0044] Figure 2 This is a schematic diagram of the gyroscope output disclosed in the embodiment of the present application;

[0045] Figure 3 A schematic flow chart of a gyroscope zero bias calibration method disclosed in another embodiment of the present application;

[0046] Figure 4 A schematic diagram of the structure of a gyroscope zero bias calibration device disclosed in an embodiment of the present application;

[0047] Figure 5 A schematic diagram of the structure of a gyroscope zero bias calibration device disclosed in another embodiment of the present application;

[0048] Figure 6 This is a schematic diagram of a portion of the structure of the control system inside the power equipment disclosed in the embodiment of the present application. DETAILED DESCRIPTION

[0049] The following will be combined with the drawings in the embodiments of the present invention to clearly and completely describe the technical solutions in the embodiments of the present invention. Obviously, the described embodiments are only part of the embodiments of the present invention, not all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of the present invention.

[0050] In the prior art, the angle calculation method for the MEMS gyroscope is relatively simple, which is just to perform a zero bias calculation on the gyroscope. The prior art is implemented as follows:

[0051] When the lawn mower is powered on, ensure that the machine is in a stationary state. At this time, the zero bias of the gyroscope is averaged and used as the basic zero bias of the gyroscope, which is calculated as gyro_bias. The real-time value of the gyroscope collected thereafter is calculated as gyro_get. Finally, the actual calculated gyroscope value used is calculated as gyro_cal. The relationship between gyro_bias, gyro_get and gyro_cal satisfies the formula: gyro_cal = gyro_get - gyro_bias.

[0052] The applicant has found through research that the prior art does not consider the effects of the gyroscope's zero bias stability, temperature coefficient, etc. when calculating the gyroscope's angle value. If the gyroscope works for a long time, there will be problems such as large angle error and static angle drift, resulting in the smart lawn mower moving in an arc instead of a straight line and large turning angle errors.

[0053] In order to facilitate a better understanding of the present solution, this application takes a lawn mower scenario as an example to illustrate the solution. Of course, when necessary, the solution can also be applied to other automatic cruising devices. For example, in addition to lawn mowers, it can also be applied to cleaning robots, automatic sprinkler trucks and other equipment.

[0054] In actual applications, smart lawn mowers exist in two states: motion and still. Generally, a MEMS gyroscope has a specific zero bias value regardless of whether the lawn mower is in motion or still state, and the stability of the zero bias value is easily affected by various factors. For example, the stability of the zero bias value is affected by temperature and working time. The zero bias value of the gyroscope will change with changes in temperature and time, resulting in the gyroscope angle value calculated by the algorithm to deviate from the actual angle when the lawn mower is still, that is, angle drift occurs.

[0055] The present invention uses the three states of the lawn mower being powered on, running, and stationary to perform real-time calculation of the zero bias of the gyroscope, so that the zero bias value of the gyroscope is within a controllable range no matter what state the lawn mower is in, effectively reducing the angle error caused by the gyroscope integration, thereby achieving the purpose of precise angle control of the lawn mower and improving the mowing efficiency.

[0056] See also Figure 1 , the present application discloses a gyroscope zero bias calibration method, comprising:

[0057] Step S100: After the power device is powered on and started, it is determined whether the power device is in a stationary state, and the gyroscope is installed in the power device.

[0058] In this step, powering on the power device means connecting the power device to a power source and turning on the power switch, so that the device starts to obtain power and run. In this step, when the power device is just powered on, the basic zero bias of the gyroscope has not yet been generated. At this time, the power device is not in motion, and the power device remains in a stationary state. At this time, it can be considered that the power device is in a stationary state. Of course, after the power device moves for a period of time and stops moving, it can also be considered that the power device enters a stationary state. Therefore, the stationary state determined in this scheme can include the stationary state when the power device is just powered on, and the stationary state during the operation of the power device. When it is detected that the power device is in a stationary state, step S101 is executed.

[0059] The gyroscope in the power device may be a MEMS gyroscope, or other gyroscopes with inherent zero bias.

[0060] Step S101: When the power device is in a stationary state, the basic zero bias of the gyroscope is calculated.

[0061] This step is mainly performed when the power device is just started. When the power device is powered on and started, the power device is still in a stationary state for a short period of time, or when the power device is idling, it is also in a stationary state. When the power device is in a stationary state, the zero bias of the gyroscope during this period (the zero bias corresponding to the real-time value of the gyroscope collected at each moment in the time period to which the current moment belongs) is averaged and the calculation result is used as the basic zero bias of the gyroscope, and the basic zero bias is calculated as gyro_bias.

[0062] Step S102: obtaining an actual calculated gyroscope value based on the basic zero bias calculation, which is recorded as a first actual gyroscope value.

[0063] After the basic zero bias is calculated, the real-time value gyro_cal of the gyroscope is collected, and based on the real-time value gyro_get and the basic zero bias gyro_bias, the actual calculated gyroscope value gyro_cal used last is calculated based on the formula gyro_cal=gyro_get-gyro_bias, and gyro_cal is recorded as the first actual gyroscope value.

[0064] Step S103: determining whether the first actual gyroscope value is greater than a calibration value.

[0065] When the first actual gyroscope value is greater than the calibration value, the power device is calibrated to be in a motion state, and at this time, the gyroscope can be angle-integrated based on a preset integration frequency.

[0066] When the first actual gyroscope value is not greater than the calibration value, the power device is calibrated to be in a stationary state.

[0067] Gyroscopes of different specifications and types have their own unique noise values, and the noise values ​​also have different noise values ​​according to different settings such as the gyroscope's range, bandwidth, sampling frequency, etc. It should be noted that the noise value here does not refer to sound, but to the random fluctuations or errors in the output signal of the gyroscope sensor. This noise is usually caused by various factors such as the physical process inside the sensor, the noise of electronic components, changes in ambient temperature, electromagnetic interference, etc. The noise value manifests itself as random fluctuations in the measured value (i.e., the angular velocity value), which will affect the measurement accuracy and stability of the gyroscope. For the same gyroscope, the smart lawn mower must collect and record its unique noise value once, that is, the maximum upper and lower limits of the gyroscope output in a stationary state, and at the same time leave a certain margin, which is counted as noise, that is, noise = noise0 + a, where a is the margin, and noise0 is the zero-bias noise of the gyroscope in a stationary state, such as Figure 2 The gyroscope zero bias noise plus a certain margin can take the noise as 0.65. In order to prevent misunderstanding, in this application, the noise value is recorded as a calibration value, based on which it can be judged whether the power device is in a stationary state or in a working state. In this solution, when the first actual gyroscope value is greater than the calibration value, it indicates that the power device is in a moving state, and when the first actual gyroscope value is not greater than the calibration value, it indicates that the power device is in a stationary state.

[0068] In the technical solution disclosed in this embodiment, as the cumulative usage time of the gyroscope continues to increase, the remaining life of the gyroscope will continue to decrease, and its performance and accuracy will have some deviations to a certain extent. As a result, its noise value will also change. At this time, there will be a certain error between the initial calibrated noise value and the actual noise value. Therefore, in this solution, the noise value of the gyroscope can also be recalibrated based on a preset time interval, and the calibration value can be updated.

[0069] When the first actual gyroscope value is not greater than the calibration value, the step of calculating the basic zero bias of the gyroscope and subsequent steps are re-executed until it is detected that the first actual gyroscope value is greater than the calibration value.

[0070] When the first actual gyroscope value is not greater than the calibration value, it indicates that the power device is in a stationary state. The stationary state may be the stationary state when the power device is just powered on or the standby state after working for a period of time. When the power device is in a stationary state, in order to obtain a more accurate basic zero bias, it is necessary to re-execute step S101 to calculate the basic zero bias of the gyroscope at the current moment. After the basic zero bias of the gyroscope is calculated, continue to execute subsequent steps until it is detected that the first actual gyroscope value is greater than the calibration value.

[0071] The reason why this step returns to step S101 to recalculate the basic zero bias of the gyroscope is to prevent the power equipment from working for a long time and the heat dissipation during operation of the power equipment causing the temperature change of the gyroscope to cause the zero bias of the gyroscope to fluctuate, which in turn causes the basic zero bias of the gyroscope measured when the equipment is powered on to be unreliable.

[0072] From the above scheme, the above scheme disclosed in the present application determines whether the power device is in motion or at rest based on the calculation result of the first actual gyroscope value and the calibration value. When the power device is at rest, the basic zero bias of the gyroscope is recalculated. In this process, each time the device is detected to be stationary, the basic zero bias is updated, so that the zero bias error of the gyroscope cannot be accumulated, thereby ensuring the accuracy of the zero bias error to the greatest extent, thereby effectively ensuring the reliability of the travel path of the power device during operation.

[0073] When the first actual gyroscope value is greater than the calibration value, the power device is calibrated to be in working state. Therefore, there is no need to return to step S101 to recalibrate the basic zero bias of the gyroscope. It is necessary to calculate the angle of the gyroscope based on the first actual gyroscope value to adjust the direction of travel of the power device. Therefore, see Figure 3 When the first actual gyroscope value is greater than the calibration value, step S104 needs to be performed:

[0074] Step S104: performing angle integration on the gyroscope based on a preset integration frequency, and calculating the angle of the gyroscope based on the integration result.

[0075] When the first actual gyroscope value is greater than the calibration value, it indicates that the power device is in working condition. Therefore, there is no need to return to step S101 to recalibrate the basic zero bias of the gyroscope. At this time, the gyroscope needs to be integrated based on the preset integration frequency, and the angle of the gyroscope is calculated based on the integration result. Then, the direction of travel of the power device is adjusted based on the gyroscope angle and the planned path of the power device, so that the power device moves according to the planned path. This process can be specifically implemented by an integration formula, and the integration formula is: yaw+=gyro_cal*(1 / f), wherein gyro_cal is the first actual gyroscope value, f is the preset integration frequency, and yaw is the integration result. For example, when the preset integration frequency is 100 Hz, the above formula is yaw+=gyro_cal*0.01.

[0076] Regarding the preset integration frequency, in this step, considering that the faster the travel speed of the power device is, the farther the travel distance of the power device in unit time is, the greater the deviation between the travel direction of the power device and the planned direction caused by the angle error of the gyroscope. Therefore, the faster the travel speed of the power device is, the more accurate the gyroscope angle must be provided. Since the higher the preset integration frequency is, the more reliable the calculated gyroscope angle is, therefore, the present application can establish a mapping relationship between the preset integration frequency and the travel speed of the power device. When the gyroscope is integrated at an angle based on the preset integration frequency, specifically, the travel speed of the power device is obtained through a speed sensor, and then the target integration frequency matching the travel speed is obtained based on a preset mapping table (the preset mapping table records the mapping relationship between the travel speed and the target integration frequency), and then the gyroscope is integrated at an angle based on the determined target integration frequency, thereby obtaining the angle of the gyroscope whose accuracy matches the travel speed of the power device.

[0077] This embodiment discloses a gyroscope zero bias calibration device. For the specific working contents of each unit in the device, please refer to the contents of the above method embodiment.

[0078] The following is a description of a gyroscope zero bias calibration device provided in an embodiment of the present invention. The gyroscope zero bias calibration device described below and the gyroscope zero bias calibration method described above can be referenced to each other.

[0079] See also Figure 4 , the device may include:

[0080] The startup judgment unit 00 corresponds to step S100 in the above method, and is used to judge whether the power device is in a stationary state after the power device is powered on and started, and the gyroscope is installed in the power device;

[0081] A basic zero bias calculation unit 10, which corresponds to step S101 in the above method, is used to calculate the basic zero bias of the gyroscope when the power device is in a stationary state;

[0082] An actual gyroscope value calculation unit 20, which corresponds to step S102 in the above method, is used to collect the real-time value of the gyroscope, and calculate the actual calculated gyroscope value based on the real-time value and the basic zero bias, which is recorded as a first actual gyroscope value;

[0083] The device state judgment unit 30 corresponds to step S103 in the above method, and is used to judge whether the first actual gyroscope value is greater than the calibration value. When the first actual gyroscope value is not greater than the calibration value, it is judged that the power device is in a stationary state, and a trigger signal for controlling the operation of the basic zero bias calculation unit is output to the basic zero bias calculation unit 10, so that the basic zero bias calculation unit 10 recalculates the basic zero bias of the gyroscope.

[0084] The above method corresponds to Figure 5 The above-mentioned device may further include a calibration value updating unit 40, and the calibration value updating unit 40 is used to update the calibration value of the gyroscope based on a preset time interval.

[0085] Corresponding to the above method, see Figure 5 The above-mentioned device may also include a gyroscope angle calculation unit 50, which is used to integrate the gyroscope angle based on a preset integration frequency when the device state judgment unit 30 detects that the first actual gyroscope value is greater than the calibration value, and calculate the gyroscope angle based on the integration result.

[0086] Corresponding to the above method, the present application also discloses a power device, referring to Figure 6 As shown, it shows a partial structural schematic diagram of a control system suitable for implementing the internal power equipment in the embodiment of the present application. The power equipment in the embodiment of the present application may include but is not limited to equipment such as lawn mowers, sweeping robots, etc. Figure 6 The power equipment shown is merely an example and should not bring any limitation to the functions and scope of use of the embodiments of the present application.

[0087] like Figure 6As shown, the power device may include a processor (e.g., a central processing unit, a graphics processing unit, etc.) 601, which can perform various appropriate actions and processes according to a program stored in a read-only memory (ROM) 602 (the program is a program for executing the gyroscope zero bias calibration method described in any one of the above embodiments of the present application) or a program loaded from a storage device 608 to a random access memory (RAM) 603. When the power device is powered on, various programs and data required for the operation of the power device are also stored in the RAM 603. The processing device 601, the ROM 602, and the RAM 603 are connected to each other via a bus 604. An input / output (I / O) interface 605 is also connected to the bus 604.

[0088] Typically, the following devices may be connected to the I / O interface 605: input devices 606 including, for example, a touch screen, a touch pad camera, a microphone, an accelerometer, a gyroscope, etc.; output devices 607 including, for example, a liquid crystal display (LCD), a speaker, a vibrator, etc.; storage devices 608 including, for example, a memory card, a hard disk, etc.; and communication devices 609. The communication device 609 may allow the power device to communicate with other devices wirelessly or by wire to exchange data. Although Figure 6 The power plant with various devices is shown, but it should be understood that it is not required to implement or have all the devices shown. More or fewer devices can be implemented or have instead.

[0089] Also provided in an embodiment of the present application is a computer program product including computer-readable instructions. When the computer-readable instructions are executed on a power device, the power device implements any one of the gyroscope zero bias calibration methods provided in the embodiments of the present application.

[0090] A computer-readable storage medium is also provided in an embodiment of the present application. The storage medium carries one or more computer programs. When the one or more computer programs are executed by a power device, the power device can implement any gyroscope zero bias calibration method provided in the embodiment of the present application.

[0091] In summary of the above solutions, power equipment (such as lawn mowing robots and sweeping robots) require accurate angles as references during actual use, so as to achieve the purpose of high-efficiency operation. The first solution to obtain accurate angle values ​​is to use a high-performance gyroscope sensor, but such sensors are often expensive, far exceeding the cost budget of the power equipment; the second solution is to use a low-priced civilian gyroscope sensor, which meets the requirements in terms of price, but is far from meeting the requirements in terms of performance. Through the above solutions, the present invention enables low-priced civilian gyroscope sensors to meet the performance requirements of power equipment, and may even be better than high-performance gyroscope sensors in terms of performance. At the same time, it also reduces the production cost of power equipment.

[0092] For the convenience of description, the above system is described as being divided into various modules according to their functions. Of course, when implementing the present invention, the functions of each module can be implemented in the same or multiple software and / or hardware.

[0093] Each embodiment in this specification is described in a progressive manner, and the same or similar parts between the embodiments can refer to each other, and each embodiment focuses on the differences from other embodiments. In particular, for the system or system embodiment, since it is basically similar to the method embodiment, the description is relatively simple, and the relevant parts can refer to the partial description of the method embodiment. The system and system embodiments described above are merely schematic, wherein the units described as separate components may or may not be physically separated, and the components displayed as units may or may not be physical units, that is, they may be located in one place, or they may be distributed on multiple network units. Some or all of the modules may be selected according to actual needs to achieve the purpose of the scheme of this embodiment. Ordinary technicians in this field can understand and implement it without creative work.

[0094] Professionals may further appreciate that the units and algorithm steps of each example described in conjunction with the embodiments disclosed herein can be implemented in electronic hardware, computer software, or a combination of the two. In order to clearly illustrate the interchangeability of hardware and software, the composition and steps of each example have been generally described in the above description according to function. Whether these functions are performed in hardware or software depends on the specific application and design constraints of the technical solution. Professionals and technicians may use different methods to implement the described functions for each specific application, but such implementation should not be considered to be beyond the scope of the present invention.

[0095] The steps of the method or algorithm described in conjunction with the embodiments disclosed herein may be implemented directly using hardware, a software module executed by a processor, or a combination of the two. The software module may be placed in a random access memory (RAM), a memory, a read-only memory (ROM), an electrically programmable ROM, an electrically erasable programmable ROM, a register, a hard disk, a removable disk, a CD-ROM, or any other form of storage medium known in the art.

[0096] It should also be noted that, in this article, relational terms such as first and second, etc. are only used to distinguish one entity or operation from another entity or operation, and do not necessarily require or imply any such actual relationship or order between these entities or operations. Moreover, the terms "include", "comprise" or any other variants thereof are intended to cover non-exclusive inclusion, so that a process, method, article or device including a series of elements includes not only those elements, but also other elements not explicitly listed, or also includes elements inherent to such process, method, article or device. In the absence of further restrictions, the elements defined by the sentence "comprise a ..." do not exclude the presence of other identical elements in the process, method, article or device including the elements.

[0097] The above description of the disclosed embodiments enables one skilled in the art to implement or use the present invention. Various modifications to these embodiments will be apparent to one skilled in the art, and the general principles defined herein may be implemented in other embodiments without departing from the spirit or scope of the present invention. Therefore, the present invention will not be limited to the embodiments shown herein, but rather to the widest scope consistent with the principles and novel features disclosed herein.

Claims

1. A gyroscope zero bias calibration method, characterized in that: include: After the power device is powered on and started, determining whether the power device is in a stationary state, wherein the gyroscope is installed in the power device; When the power device is in a stationary state, calculating the basic zero bias of the gyroscope; Collecting the real-time value of the gyroscope, and calculating an actual calculated gyroscope value based on the real-time value and the basic zero bias, which is recorded as a first actual gyroscope value; Determining whether the first actual gyroscope value is greater than a calibration value; When the first actual gyroscope value is not greater than the calibration value, it is determined that the power device is in a stationary state, and the steps of calculating the basic zero bias of the gyroscope and subsequent steps are re-executed until the first actual gyroscope value is greater than the calibration value.

2. The gyroscope zero bias calibration method according to claim 1, characterized in that: Before determining whether the first actual gyroscope value is greater than the calibration value, the method further includes: Based on a preset time interval, the calibration value of the gyroscope is updated.

3. The gyroscope zero bias calibration method according to claim 2, characterized in that: The calibration value is: noise=noise0+a; The noise is a calibrated value, the noise0 is the gyroscope zero bias noise when the power equipment is in a stationary state, and a is a preset margin.

4. The gyroscope zero bias calibration method according to claim 1, characterized in that: Calculate the basic bias of the gyroscope, including: Get the real-time value of the gyroscope collected at each moment in the time period to which the current moment belongs, and calculate the basic zero bias of the gyroscope.

5. The gyroscope zero bias calibration method according to claim 1, characterized in that: When the first actual gyroscope value is greater than the calibration value, the method further includes: The gyroscope is angle-integrated based on a preset integration frequency.

6. The gyroscope zero bias calibration method according to claim 5, characterized in that: Performing angle integration on the gyroscope based on a preset integration frequency includes: Obtaining the travel speed of the power device; Acquire a target integrated frequency that matches the travel speed; The gyroscope is angle-integrated based on the target integration frequency.

7. The gyroscope zero bias calibration method according to claim 6, characterized in that: Performing angle integration on the gyroscope based on a preset integration frequency includes: Performing angle integration on the first actual gyroscope value based on the formula yawgyro_cal*(1 / f); Among them, gyro_cal is the first actual gyroscope value, f is the preset integration frequency, and yaw is the integration result.

8. A gyroscope zero bias calibration device, characterized in that: include: A startup judgment unit, used for judging whether the power device is in a stationary state after the power device is powered on and started, wherein the gyroscope is installed in the power device; A basic zero bias calculation unit, used for calculating the basic zero bias of the gyroscope when the power device is in a stationary state; An actual gyroscope value calculation unit, used for collecting the real-time value of the gyroscope, and calculating an actual calculated gyroscope value based on the real-time value and the basic zero bias, which is recorded as a first actual gyroscope value; The device state judgment unit is used to judge whether the first actual gyroscope value is greater than the calibration value. When the first actual gyroscope value is not greater than the calibration value, it is determined that the power device is in a stationary state, and a trigger signal for controlling the operation of the basic zero bias calculation unit is output to the basic zero bias calculation unit.

9. A computer program product, characterized in that It comprises computer-readable instructions, and when the computer-readable instructions are executed on a power device, the power device implements the gyroscope zero bias calibration method as claimed in any one of claims 1 to 7.

10. A power device, characterized in that: The method comprises at least one processor and a memory connected to the processor, wherein: The memory is used to store computer programs; The processor is used to execute the computer program so that the power device can implement the gyroscope zero bias calibration method as described in any one of claims 1 to 7.

11. The power device according to claim 9, characterized in that: The power equipment is a lawn mower or a sweeping robot.

12. A computer storage medium, characterized in that: The storage medium carries one or more computer programs, and when the one or more computer programs are executed by a power device, the power device can implement the gyroscope zero bias calibration method as described in any one of claims 1 to 7.

Citation Information

Cited By

  • Gyroscope calibration method, system and equipment and storage medium

    CN120467392A