A frequency response characteristic detection device and test method of a posture detection system
Through the attitude detection system based on magnetic sensors, using a three-dimensional angle sensor and attitude test board, the input signal frequency is changed and the amplitude attenuation is calculated, the problem of low accuracy of the attitude detection system in the prior art under high frequency motion is solved, and the problem of low accuracy in the attitude detection system in high frequency motion is realized. Efficient and accurate frequency response characteristic testing provides reference for system design and application.
Patent Information
- Application Number
- CN202111144909.0
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2021-09-28
- Publication Date
- 2024-11-26
- Estimated Expiration
- 2041-09-28
AI Technical Summary
The existing attitude detection system is not very accurate in high frequency motion state, making it difficult to detect high-precision and high-frequency band frequency response characteristics, especially in the internal signal chain of the system, which makes it difficult to identify potential stability problems. .
Using a magnetic sensor-based attitude detection system, a three-dimensional angle sensor development platform and attitude test board are used to collect data using a six-axis IMU and a three-axis geomagnetic sensor, and the microprocessor performs signal processing and filtering fusion, combining RF wireless communication module with the upper machine The attitude angle is output in real time, the input sinusoidal motion signal is provided and the frequency is changed. By comparing the output signal with the input signal amplitude, the amplitude attenuation degree is calculated, and a Bode diagram or Nyquist diagram is drawn to judge the frequency response characteristics of the system.
It realizes efficient and accurate measurement of the frequency response characteristics of the attitude detection system, especially the attenuation of the output signal is obviously observed in the high frequency band, filling the gap in the existing medium frequency response characteristic testing methods, and providing a reference basis for system design and application. .
Smart Images

Figure CN113932832B_ABST
Abstract
Description
Technical Field
[0001] The invention belongs to the technical field of magnetic sensor application and posture detection, and relates to a frequency response characteristic detection device of a posture detection system and a test method thereof. Background Art
[0002] With the widespread application of attitude detection systems in the aerospace military field, industrial control field, and civilian consumer field, higher requirements have been put forward for its frequency response characteristics, accuracy, stability, applicable conditions, and cost. In view of the defect of low accuracy of attitude detection systems in high-frequency motion, for example, in the aerospace field, the impact of aircraft vibration on accuracy; in the civilian consumer field, the attitude of drones cannot be calibrated in time after being hit; in terms of human posture, the attitude data is distorted during high-speed motion, etc. The study of the frequency response characteristics of attitude detection systems is even more important. At present, the frequency response characteristic test in the field of attitude detection is mainly aimed at the gyroscope and accelerometer inside the system, and the black box test of the entire system has not yet been carried out. The test equipment mainly includes single-axis or multi-axis rate turntables, angular vibration tables, electric vibration tables, and centrifuges. It is difficult to detect and evaluate the frequency characteristics of dynamic systems. The main challenges are that the excitation source with high accuracy and high frequency band cannot be provided, and there are unquantifiable links in the signal chain inside the system. However, the system will have a direct impact on the controller, which can help identify potential stability problems, so it is very necessary and important to provide a reference basis for the design and application of high-bandwidth systems. However, there is no good frequency response characteristic evaluation method at present. Therefore, the present invention provides a system frequency response characteristic evaluation method, which can meet the frequency response characteristic test of the posture detection system, and thus be applied to products in the field of low-cost consumer electronics.
[0003] The present invention provides a posture detection system based on a magnetic sensor and a method for testing its frequency response characteristics. The method implements a frequency response characteristic test of the system input motion signal from a low frequency band to a high frequency band based on the fact that the amplitude of the system output signal will attenuate as the frequency of the input signal increases. The present invention conducts a frequency response characteristic experiment on the posture detection system, compares the system output signal with the input motion signal through sine fitting, and finds that as the frequency of the input signal continues to increase, the output signal attenuates faster. The results show that this method can be used to test the frequency response characteristics of the posture detection system. Summary of the invention
[0004] The purpose of the present invention is to provide a device for detecting the frequency response characteristics of a posture detection system and a test method thereof. By obtaining the frequency characteristics of the posture detection system under test at a finite number of frequency points and obtaining a curve of amplitude variation with frequency, a Bode diagram or a Nyquist diagram is obtained to determine whether the system matches the input motion signal.
[0005] A frequency response characteristic detection device for an attitude detection system includes a three-dimensional angle sensor development platform, an attitude test board and a host computer (PC), wherein the attitude test board integrates a six-axis IMU (inertial measurement unit), a three-axis geomagnetic sensor, a microprocessor, an RF wireless communication module and a power management module. The attitude test board is installed on the three-dimensional angle sensor development platform, which is an electric platform that can rotate 360 degrees along the XYZ axes of the geographic coordinate system.
[0006] The six-axis IMU is used to collect the acceleration and angular rate information of the object under test, and transmit the collected information to the microprocessor; the three-axis geomagnetic sensor is used to obtain the magnetic field information of the object under test; the microprocessor is used to read the data collected by the six-axis IMU, and filter and fuse the data to obtain the relevant attitude angle; the microprocessor communicates remotely with the host computer through the RF wireless communication module and outputs the attitude angle in real time; the power management module is used to provide power to the six-axis IMU, three-axis geomagnetic sensor, microprocessor, and RF wireless communication module; the host computer is used to display the attitude angle.
[0007] The six-axis IMU and three-axis geomagnetic sensor communicate with the microprocessor through IIC. The microprocessor outputs the processed data to the host computer through the RF wireless communication module, so that the host computer can directly display the attitude angle of the system; the host computer can simultaneously display the roll angle, pitch angle, and yaw angle of the vehicle, so that users can monitor the movement in real time;
[0008] Based on the above device, there are the following frequency response characteristics test methods:
[0009] During the test, the attitude test board of the attitude detection system is installed on the three-dimensional angle sensor development platform. The three-dimensional angle sensor development platform is an electric platform that can rotate 360 degrees along the XYZ axes of the geographic coordinate system, and is used to provide input sinusoidal motion signals for the attitude detection system.
[0010] The frequency-changing sinusoidal motion signal is provided to the input end of the attitude detection system. The system converts the frequency-changing sinusoidal motion signal into an electrical signal. After signal processing and conversion by the microprocessor, an attitude angle corresponding to the input motion state is output in the form of a digital signal. The frequency of the system input signal is changed, and the degree of system attenuation is determined by comparing the output signal with the input signal amplitude, thereby realizing the frequency response characteristic test of the attitude detection system.
[0011] From the perspective of the attitude detection system, its input is an analog motion signal, and its output is a digital attitude angle. For the MEMS (micro-electromechanical system) attitude detection system, the six-axis IMU detects inertial motion as input, and the output is usually represented by a digital signal.
[0012] The frequency response characteristic describes the frequency at which the output signal of a certain frequency drops to 70.7% (-3dB) of the actual motion amplitude detected by the system. The attitude angle is mainly determined by the relationship between the carrier coordinate system and the geographic coordinate system, and is expressed by the three Euler angles of heading, pitch and roll; the heading, pitch and roll angles are defined by the carrier coordinate system relative to the geographic coordinate system. The rotation axis of the heading angle corresponds to the Z axis of the geographic coordinate system, the rotation axis of the pitch angle corresponds to the X axis of the geographic coordinate system, and the rotation axis of the roll angle corresponds to the Y axis of the geographic coordinate system.
[0013] Theoretically, the frequency response characteristics of the three attitude angles are consistent. Take the pitch angle as an example to test the frequency response characteristics of the system. Fix the attitude test board on the three-dimensional angle sensor development platform. The rotation axis of the pitch angle is the X-axis, which coincides with the rotation axis of the three-dimensional angle sensor development platform. The excitation signal of the system is the rotation process of the three-dimensional angle sensor development platform from 90° to -90°, and continuously increase its rotation speed. Then compare the sinusoidal signal fitted by the output signal to determine the attenuation degree. The amplitude attenuation degree is calculated by the following formula: attenuation degree = 20*log(CHout / CHin), where CHout is the system output signal amplitude and CHin is the system input signal amplitude.
[0014] Compared with the prior art, the present invention has the following advantages: by adopting the frequency response characteristic testing method of the posture detection system of the present invention, by changing the frequency of the input sinusoidal motion signal, the frequency response characteristics of the posture detection system can be measured efficiently and accurately, and in particular, the attenuation of the output signal can be clearly observed in the high frequency band, thereby filling the gap in the frequency response characteristic testing method of the posture detection system. BRIEF DESCRIPTION OF THE DRAWINGS
[0015] Figure 1 The hardware structure diagram of the posture detection system used in the present invention;
[0016] Figure 2 This is a schematic diagram of the structure of the three-dimensional angle sensor development platform used in the present invention;
[0017] Figures 3 to 10 The test result diagram for this application example is shown below;
[0018] Fig.11 Amplitude-frequency characteristic curve diagram for this application. DETAILED DESCRIPTION
[0019] In order to more clearly illustrate the technical solution of the embodiment of the present invention, the design of the present invention will be described in detail below in conjunction with specific embodiments. The following embodiments will help those skilled in the art to further understand the present invention, but do not limit the present invention in any form. It should be pointed out that, for those of ordinary skill in the art, several changes and improvements can also be made without departing from the concept of the present invention. These all belong to the protection scope of the present invention.
[0020] like Figure 1 As shown, a frequency response characteristic detection device of an attitude detection system includes a three-dimensional angle sensor development platform, an attitude test board and a host computer (PC), and the attitude test board integrates a six-axis IMU (inertial measurement unit), a three-axis geomagnetic sensor, a microprocessor, an RF wireless communication module and a power management module.
[0021] The six-axis IMU and the three-axis geomagnetic sensor communicate with the microprocessor through IIC (integrated circuit bus), and the microprocessor transmits the processed data to the host computer through the RF wireless communication module, and the host computer can directly display the original collected data and attitude angle data. The six-axis IMU measures the acceleration and angular rate of the object under test as collected data according to the command of the microprocessor; the six-axis IMU model in this embodiment is ICM42605; the three-axis geomagnetic sensor is used to measure the magnetic field in all directions of the object under test, and the three-axis geomagnetic sensor model in this embodiment is HMC5883L; the microprocessor module is used for measurement initialization, issuing measurement commands, saving and reading collected data, and performing data fusion on the collected data to obtain attitude angle information; the microprocessor model in this embodiment is STM32F103T8U6; the SWD interface is a serial debugging interface for program downloading and debugging; the RF wireless communication module is used for synchronous remote transmission and real-time output of attitude information; the wireless serial port module is connected to the wireless receiving module and is used to communicate with the host computer after receiving the attitude angle information. The RF wireless communication module model in this embodiment is NRF24L01.
[0022] From the perspective of the attitude detection system, its input is the analog motion signal, and its output is the attitude angle of the digital signal. Take the pitch angle as an example to test the frequency response characteristics of the system. Fix the attitude test board on the 3D angle sensor development platform. The rotation axis of the pitch angle is the X-axis, which coincides with the rotation axis of the 3D angle sensor development platform. Figure 2 The figure shows the schematic diagram of the structure of the three-dimensional angle sensor development platform. The X-axis, Y-axis, and Z-axis are controlled by the host computer to drive the motors of each axis to provide different rotation speeds, thereby providing an excitation source for the posture detection system.
[0023] The excitation signal of the system is to continuously increase the rotation speed of the three-dimensional angle sensor development platform through the rotation process from 90° to -90°. Then compare the output signal with the fitted sinusoidal signal to observe the output attenuation and analyze its frequency response characteristics. Test the system's attitude angle tracking under high-speed motion (taking the pitch angle as an example). ① Make the Y-axis of the test board consistent with the direction of the turntable axis; ② Set the axial speed of the three-dimensional angle sensor development platform to πrad / s for a uniform speed; ③ During the entire rotation process, record the pitch angle data. ④ Repeat the above steps to increase the turntable speed, and rotate at speeds of 2πrad / s, 3πrad / s, 4πrad / s, 5πrad / s, 6πrad / s, and 7πrad / s respectively, and record the system output pitch angle tracking. The test results are as follows Figures 3 to 10 The system output pitch angle amplitude attenuates -0.46dB at πrad / s, -0.48dB at 2πrad / s, -0.50dB at 3πrad / s, -0.85dB at 4πrad / s, -1.41dB at 5πrad / s, -3.07dB at 6πrad / s, and -8.75dB at 7πrad / s. The amplitude-frequency characteristic curve is drawn according to the amplitude attenuation degree of the sine fitting curve. The result is as follows: Fig.11 As shown in the figure, at around 5.6πrad / s, the amplitude decays to -3dB, which is used to determine the bandwidth of the system. The application scenario of the attitude detection system is determined by the bandwidth.
[0024] The above describes the specific real-time examples of the present invention. It should be understood that the present invention is not limited to the above specific implementations, and those skilled in the art can make various changes and modifications within the scope of the claims, which does not affect the essence of the present invention. In the absence of conflict, the embodiments of the present application and the features in the embodiments can be combined with each other at will.
Claims
1. A frequency response characteristic detection device for a posture detection system, characterized in that: It includes an attitude test board and a host computer. The attitude test board integrates a six-axis IMU, a three-axis geomagnetic sensor, a microprocessor, an RF wireless communication module and a power management module; The six-axis IMU is used to collect the acceleration and angular rate information of the object being measured, and transmit the collected information to the microprocessor; the three-axis geomagnetic sensor is used to obtain the magnetic field information of the object being measured; The microprocessor is used to read the data collected by the six-axis IMU and filter and fuse the data to obtain the relevant attitude angle; the microprocessor communicates remotely with the host computer through the RF wireless communication module and outputs the attitude angle in real time; The power management module is used to provide power to the six-axis IMU, three-axis geomagnetic sensor, microprocessor, and RF wireless communication module; the host computer is used to display the attitude angle; The six-axis IMU and three-axis geomagnetic sensor communicate with the microprocessor through IIC. The microprocessor outputs the processed data to the host computer through the RF wireless communication module, so that the host computer can directly display the attitude angle of the system; the host computer can simultaneously display the roll angle, pitch angle, and yaw angle of the vehicle, so that users can monitor the movement in real time; The attitude test board is installed on the 3D angle sensor development platform. The 3D angle sensor development platform is an electric platform that can rotate 360 degrees along the XYZ axis of the geographic coordinate system and is used to provide input sinusoidal motion signals for the attitude detection system. Based on the above device, there is the following method for testing the frequency response characteristics of the posture detection system: a sinusoidal motion signal with a frequency change is provided to the input end of the posture detection system, the system converts the sinusoidal motion signal with a frequency change into an electrical signal, and then after signal processing and conversion by a microprocessor, outputs a posture angle corresponding to the input motion state in the form of a digital signal; the frequency of the system input signal is changed, and the degree of system attenuation is determined by comparing the amplitude of the output signal with the input signal, thereby realizing the frequency response characteristics test of the posture detection system; The attenuation degree is calculated by the following formula: Attenuation degree=20*log(CHout / CHin); wherein CHout is the system output signal amplitude, and CHin is the system input signal amplitude.
