Adaptive filter based on rotation angular acceleration, configuration method thereof, medium and equipment

By performing differential calculations on the rotation angle data, dynamically adjusting the cutoff frequency of the adaptive filter, the problem of inability to effectively filter out noise when the rotation angular velocity changes in the prior art is solved, and the measurement accuracy and filtering effect are improved.

CN119051629APending Publication Date: 2024-11-29GUIZHOU ZHENHUA FENGGUANG SEMICON
View PDF 0 Cites 2 Cited by

Patent Information

Application Number
CN202410950759.X
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-07-16
Publication Date
2024-11-29

AI Technical Summary

Technical Problem

In the prior art, noise cannot be effectively filtered out when the rotation angular velocity changes, resulting in a decrease in measurement accuracy, and the cutoff frequency of the existing low-pass filter is constant and cannot be adjusted dynamically according to actual conditions.

Method used

By performing differential calculations on the rotation angle data, the rotation angular velocity and angular acceleration are obtained, the cutoff frequency of the adaptive filter is dynamically adjusted, and the appropriate cutoff frequency is selected according to the rotation angular acceleration is configured to realize adaptive filtering.

Benefits of technology

Improve the accuracy and filtering effect of measurement results, ensuring that noise can be effectively filtered out and effective data loss can be reduced when the rotation angular velocity changes.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN119051629A_ABST
    Figure CN119051629A_ABST
Patent Text Reader

Abstract

The embodiment of the invention provides a self-adaptive filter based on rotation angular acceleration, a configuration method thereof, a medium and equipment. The configuration method of the adaptive filter based on the rotation angular acceleration is used for adjusting the cut-off frequency of the adaptive filter based on angle data input in the configuration method, and the configuration method comprises the following steps: S1, performing differential calculation on acquired rotation angle data to obtain the rotation angular velocity; s2, performing differential calculation on the obtained rotation angular velocity to obtain rotation angular acceleration; and S3, selecting a cut-off frequency of the adaptive filter according to the obtained rotation angular acceleration, and configuring the adaptive filter based on the selected cut-off frequency. In the process of processing the sensor data, the cut-off frequency of the adaptive filter is correspondingly changed by considering the acceleration change in the rotation angle data, so that the filtering of the data is more intelligent and accurate, and the accuracy of the final measurement result is improved.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the technical field of position detection, and in particular to an adaptive filter based on rotational angular acceleration and a configuration method, medium and device thereof. Background Art

[0002] A rotation angle sensor is a sensor that senses the real-time angle during rotation and converts it into an output signal. The sensor output angle accuracy is a key indicator that affects sensor performance.

[0003] During the measurement process, due to the influence of mechanical vibration and electromagnetic interference, high-frequency noise accompanies the output of the measured data, causing the output angle to be accompanied by random measurement errors, and seriously affecting the accuracy and integral linearity of the angle sensor. Therefore, in the angle sensor system, a low-pass filter is often inserted after the output module of the measured angle to filter out high-frequency random errors. The low-pass filter filters the signal components above the cutoff frequency and only outputs the signal components below the cutoff frequency, thereby filtering the measured angle signal.

[0004] The study found that during the rotation of the sensor, as the rotational angular acceleration increases, both the output effective data frequency and the noise frequency will increase; similarly, when the rotational angular acceleration decreases, the output effective data frequency and the noise frequency will also decrease. The filter coefficient of the commonly used low-pass filter on the market is a constant value. Even in dynamic application scenarios, the filter cutoff frequency and bandwidth remain constant due to changes in the effective data frequency and the noise frequency caused by changes in acceleration. In addition, in order to ensure the effective filtering of high-frequency noise, the cutoff frequency of the low-pass filter is often set to a lower value. At this time, under high acceleration conditions, the lower cutoff frequency will cause the loss of effective data and affect the measurement accuracy. However, if the cutoff frequency is set higher, under low acceleration conditions, the filter will cause the noise to not be completely filtered out, reducing the measurement accuracy. This also leads to the inability of existing filters to effectively filter out noise according to actual conditions when the rotational angular velocity changes. Summary of the invention

[0005] In view of the deficiencies in the prior art, the present invention provides an adaptive filter based on rotational angular acceleration and a configuration method, medium and device thereof, which solves the problem in the prior art that accurate measurement cannot be performed when the rotational angular velocity changes.

[0006] In a first aspect, according to an embodiment of the present invention, a configuration method for an adaptive filter based on rotational angular acceleration is provided, which is used to adjust the cutoff frequency of the adaptive filter based on angle data input therein, and the configuration method comprises the following steps: S1, performing differential calculation on the acquired rotational angle data to obtain rotational angular velocity; S2, performing differential calculation on the acquired rotational angular velocity to obtain rotational angular acceleration; S3, selecting the cutoff frequency of the adaptive filter according to the acquired rotational angular acceleration, and configuring the adaptive filter based on the selected cutoff frequency.

[0007] According to an embodiment of the present invention, the rotation angular velocity is:

[0008]

[0009] in, is the change in rotation angle per unit time, and Δt is the unit time.

[0010] According to an embodiment of the present invention, the rotational angular acceleration is:

[0011] a=Δω / Δt,

[0012] Among them, Δω is the change of rotation angular velocity per unit time.

[0013] According to an embodiment of the present invention, the cutoff frequency of the adaptive filter is selected according to the obtained rotational angular acceleration: S31. According to the rotational angular acceleration list range, the ranking value of the obtained rotational angular acceleration in the range list is obtained; S32. In the cutoff frequency list range, the corresponding cutoff frequency is obtained based on the ranking value; wherein the cutoff frequency list range is constructed based on the lowest cutoff frequency, the highest cutoff frequency and a preset list quantity value of the adaptive filter.

[0014] According to an embodiment of the present invention, the ranking value is configured with adjustable upper and lower limits.

[0015] In a second aspect, according to another embodiment of the present invention, there is provided an adaptive filter for dynamically adjusting its cutoff frequency, which is configured using the configuration method described in the first aspect.

[0016] According to another embodiment of the present invention, the adaptive filter comprises a recursive filtering unit.

[0017] In a third aspect, according to another embodiment of the present invention, a rotation angle measurement method is provided for obtaining the rotation angle of a device on which a rotation angle sensor is arranged, comprising the following steps: P1, obtaining the rotation angle data measured by the rotation angle sensor; P2, using the adaptive filter as described in the first aspect to filter the rotation angle data; P3, processing the filtered rotation angle data to obtain the rotation angle.

[0018] In a fourth aspect, according to another embodiment of the present invention, there is provided a computer-readable storage medium having a computer program stored thereon, wherein the computer program can be executed by a processor to implement the steps of the method described in the first aspect.

[0019] In the fifth aspect, according to another embodiment of the present invention, an electronic device is provided, comprising: one or more processors; and a memory, wherein the memory is used to store executable instructions; and the one or more processors are configured to implement the steps of the method described in the first aspect by executing the executable instructions.

[0020] The technical principle of the present invention is that in the process of processing sensor data, the cutoff frequency of the filter is changed accordingly by taking into account the acceleration change in the rotation angle data, so that the data filtering is more intelligent and accurate, and the accuracy of the measurement result is increased. BRIEF DESCRIPTION OF THE DRAWINGS

[0021] Figure 1 The figure is a flow chart of a method for configuring an adaptive filter according to an embodiment of the present invention.

[0022] Figure 2 This is a curve diagram of the K value determined according to the change in the sensor rotation speed according to an embodiment of the present invention. DETAILED DESCRIPTION

[0023] The technical solution of the present invention is further described below in conjunction with the accompanying drawings and embodiments.

[0024] As described in the background technology, the filter in the prior art cannot effectively filter out noise according to the actual changes in sensor acceleration. Figure 1As shown, an embodiment of the present invention proposes a configuration method of an adaptive filter based on rotational angular acceleration, which is used to adjust the cutoff frequency of the adaptive filter based on the angle data input therein, and the configuration method includes the following steps: S1, differential calculation of the acquired rotational angle data to obtain rotational angular velocity; S2, differential calculation of the acquired rotational angular velocity to obtain rotational angular acceleration; S3, selecting the cutoff frequency of the adaptive filter according to the acquired rotational angular acceleration, and configuring the adaptive filter based on the selected cutoff frequency. Since the cutoff frequency of the adaptive filter can be changed in a targeted manner according to the input data, the filtering effect of the adaptive filter is more targeted and the measurement result is more accurate. Wherein, the differential calculation is performed via an adder-subtractor.

[0025] In detail, the rotation angular velocity is:

[0026]

[0027] in, is the change of the rotation angle per unit time, and Δt is the unit time. In detail, during the measurement, f s The rotation angle data is sampled at a sampling rate of

[0028] Similarly, the rotational angular acceleration is:

[0029] a=Δω / Δt,

[0030] Among them, Δω is the change of rotation angular velocity per unit time.

[0031] According to an embodiment of the present invention, the cutoff frequency of the adaptive filter is selected according to the obtained rotational angular acceleration: S31. According to the rotational angular acceleration list range, the ranking value of the obtained rotational angular acceleration in the range list is obtained; S32. In the cutoff frequency list range, the corresponding cutoff frequency is obtained based on the ranking value; wherein the cutoff frequency list range is constructed based on the lowest cutoff frequency, the highest cutoff frequency and a preset list quantity value of the adaptive filter.

[0032] Table 1 Relationship between cut-off frequency interval division and K value

[0033]

[0034] In detail, the minimum cutoff frequency f of the adaptive filter is obtained. c_min , maximum cutoff frequency f c_max and the preset list quantity value K, and the constructed cutoff frequency list range is shown in Table 1. It can be seen that the cutoff frequencies are arranged in order of size, where K = 0 and f c_min Correspondingly, K = N / 2 and fc_mid Correspondingly, and K = N and f c_max Similarly, the list range of rotational angular acceleration is shown in Table 2. It can be seen that the rotational angular accelerations of different size intervals correspond to each K value in order of size.

[0035] Table 2 Relationship between K value and acceleration

[0036]

[0037] Figure 2 The graph of the selection of K value (corresponding cutoff frequency) according to the above method is shown. The horizontal axis represents time, the red line indicates the change of the speed of the sensor, and the right vertical axis indicates the specific value; in addition, the blue line indicates the selected K value, N, for example, 5. It can be seen that at the beginning of the time period (before 0.1 seconds), the speed increases rapidly, and the selected K value continues to rise from N-5 to N; then, from 0.1 seconds to 0.35 seconds, the speed remains unchanged, and the K value continues to drop to N-5 and remains; and then increases accordingly when the acceleration changes.

[0038] In addition, in order to obtain a default value with a wider adaptability range, according to an embodiment of the present invention, the ranking value is configured with adjustable upper and lower limits, K min and K max K can be set according to different practical applications. min and K max The filter has been set to a wide range of default values ​​based on a large number of enumerated application scenarios and generally does not need to be changed. Generally, modification is only required when the K value is fixed to a specific setting in a special operating scenario. For low-speed applications with a lot of inertia and low acceleration, K min It can be fixed to a lower empirical value, which is suitable for signals with lower output noise. However, in dynamic systems, if K min If K is set too low, valid data may be filtered out, thereby introducing additional angle errors. In addition, it is worth noting that if K is set too low, min =K max , then the filter cannot be adjusted adaptively, for example, setting K min =0 and K max =0, in which case the filter fixes the bandwidth to the minimum value.

[0039] According to an embodiment of the present invention, the filter includes a recursive filtering unit, that is, an IIR filter, and the system function and the difference equation of the IIR filter are as follows:

[0040]

[0041] Among them, H(z) indicates the system function, z indicates the input, y(n) is the current output, x(n) indicates the current input, b(i) and b i represents any input coefficient, a(i) and a i represents any output coefficient, M and N represent the input order and output order respectively.

[0042] Finally, it should be noted that the above embodiments are only used to illustrate the technical solution of the present invention rather than to limit it. Although the present invention has been described in detail with reference to the preferred embodiments, those skilled in the art should understand that the technical solution of the present invention can be modified or replaced by equivalents without departing from the purpose and scope of the technical solution of the present invention, which should be included in the scope of the claims of the present invention.

Claims

1. A method for configuring an adaptive filter based on rotational angular acceleration, for adjusting the cutoff frequency of the adaptive filter based on angle data input therein, It is characterized in that The configuration method comprises the following steps: S1, performing differential calculation on the acquired rotation angle data to obtain the rotation angular velocity; S2, performing differential calculation on the obtained rotational angular velocity to obtain the rotational angular acceleration; S3. Select a cutoff frequency of the adaptive filter according to the obtained rotational angular acceleration, and configure the adaptive filter based on the selected cutoff frequency.

2. A method for configuring an adaptive filter based on rotational angular acceleration as claimed in claim 1, It is characterized in that The rotation angular velocity is: in, is the change in rotation angle per unit time, and Δt is the unit time.

3. A configuration method for an adaptive filter based on rotational angular acceleration as claimed in claim 2, It is characterized in that The rotational angular acceleration is: a=Δω / Δt, Among them, Δω is the change of rotation angular velocity per unit time.

4. A configuration method for an adaptive filter based on rotational angular acceleration as claimed in claim 1, It is characterized in that The cutoff frequency of the adaptive filter is selected according to the obtained rotational angular acceleration: S31, according to the rotational angular acceleration list range, obtaining the ranking value of the obtained rotational angular acceleration in the range list; S32, obtaining a corresponding cutoff frequency in the cutoff frequency list range based on the sorting value; The cutoff frequency list range is constructed based on the lowest cutoff frequency, the highest cutoff frequency and a preset list quantity value of the adaptive filter.

5. A configuration method for an adaptive filter based on rotational angular acceleration as claimed in claim 4, It is characterized in that The ranking value is configured with adjustable upper and lower limits.

6. An adaptive filter for dynamically adjusting its cutoff frequency, It is characterized in that The method is configured as described in any one of claims 1 to 5.

7. An adaptive filter as claimed in claim 6, It is characterized in that The adaptive filter comprises a recursive filtering unit.

8. A rotation angle measurement method for obtaining the rotation angle of a device having a rotation angle sensor arranged thereon, It is characterized in that The following steps are involved: P1. Obtaining rotation angle data measured by the rotation angle sensor; P2. Using the adaptive filter as described in any one of claims 6-7 to filter the rotation angle data; P3. Process the filtered rotation angle data to obtain the rotation angle.

9. A computer-readable storage medium, It is characterized in that A computer program is stored thereon, and the computer program can be executed by a processor to implement the steps of the method according to any one of claims 1 to 5.

10. An electronic device, It is characterized in that include: one or more processors; as well as A memory, wherein the memory is used to store executable instructions; The one or more processors are configured to implement the steps of the method of any one of claims 1 to 5 by executing the executable instructions.

Citation Information

Cited By

  • Position-sensorless control method for super-spiral adaptive filtering sliding-mode observer

    CN121077309A

  • Vibration monitoring method for driving motor operation state

    CN122506364A