Tilt angle sensor batch calibration method and device independent of rotary table
By constructing an error model and linear least squares solution on the inclination sensor, batch calibration of inclination sensors without relying on the turntable is achieved, solving the problem of high-precision turntable dependence and low efficiency in the existing technology, and improving calibration efficiency and accuracy.
Patent Information
- Application Number
- CN202411087354.4
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-09
- Publication Date
- 2024-11-15
AI Technical Summary
The existing inclination sensor calibration methods rely on high-precision rotary tables, resulting in large investment, limited load capacity, low debugging efficiency, and no batch performance, and need to communicate with the upper computer, affecting efficiency.
The batch calibration method of inclination sensors that do not rely on the turntable is adopted. By determining six unrelated calibration surfaces, the error model of the three-axis accelerometer and the linear least squares method are used to calibrate the inclination sensors by themselves to reduce the dependence on the turntable and the upper computer.
It can achieve batch calibration without high-precision turntables, reduce costs, expand calibration quantity, reduce communication requirements, improve debugging efficiency, simple operation, and calibration accuracy is no lower than traditional methods.
Smart Images

Figure CN118960784A_ABST
Abstract
Description
Technical Field
[0001] The invention relates to the field of tilt sensor product calibration production, and in particular to a method and device for batch calibration of tilt sensors that do not rely on a turntable. Background Art
[0002] Tilt sensor products need to be debugged and calibrated during the production process. Most of the existing calibration methods use a precision turntable for calibration. Due to the limitations of the turntable space and load, generally only a small number of tilt sensor products can be calibrated at the same time with a tooling plate. In addition, the tilt sensor calibration requires comparing its own error data with the precision turntable data, and then calibrating to reduce the error. In addition, the inclination sensor and turntable also need to communicate with the host computer and receive the host computer's control and data acquisition commands, resulting in low debugging efficiency.
[0003] Therefore, the above-mentioned inclination sensor calibration method relying on a precision turntable faces the disadvantages of large investment in high-precision turntable equipment, limited turntable load capacity, limited number of debugging, low debugging efficiency due to interactive communication between the inclination sensor and the host computer, and poor batch production. Summary of the invention
[0004] In order to solve the technical problem in the background technology, the present invention provides a batch calibration method of inclination sensors that does not rely on a turntable, comprising the following steps:
[0005] 1) Determine six independent calibration surfaces and install the inclination sensor to be calibrated on the calibration device;
[0006] 2) adjusting the inclination sensor to be calibrated to the angular positions of the six calibration surfaces in turn, collecting the acceleration measurement output value data at each angular position after a set static time;
[0007] 3) Calibration is achieved through the self-calibration method of the tilt sensor.
[0008] Furthermore, the step 3) specifically includes the following steps:
[0009] 31) Construct the error model of the three-axis accelerometer of the inclination sensor;
[0010] 32) The acceleration measurement output value data at the angular positions of the six calibration surfaces, i.e., the acceleration measurement output values of the three-axis accelerometer X, Y, and Z axes, are solved by linear least squares method to obtain the sensitivity and zero bias corresponding to the three-axis accelerometer X, Y, and Z axes.
[0011] Furthermore, in step 31), the error model of the three-axis accelerometer is specifically:
[0012] A s =Ka+b
[0013] Among them, A s is the acceleration true value matrix, K is the meter sensitivity matrix, a is the acceleration measurement output value matrix, b is the zero bias matrix, and:
[0014] A s =[A x A y A z ] T , a=[a x a y a z ] T , b=[b x b y b z ] T
[0015] In the formula, A x , A y , A z are the acceleration true value matrices of the three-axis accelerometer X, Y, and Z axes, respectively, x , k y , k z are the sensitivities of the X, Y, and Z axes of the three-axis accelerometer, a x 、a y 、a z are the acceleration measurement output values of the three-axis accelerometer X, Y, and Z axes, respectively, and b x 、b y 、b z They are the zero bias of the X, Y, and Z axes of the three-axis accelerometer respectively.
[0016] Furthermore, the acceleration true value matrix A s Satisfies the following formula:
[0017]
[0018] Right now:
[0019]
[0020] Where g is the acceleration due to gravity.
[0021] Furthermore, the step 32) specifically includes the following steps:
[0022] 321) For the acceleration real value matrix A s The formula is transformed and sorted, then we have:
[0023]
[0024] in,
[0025]
[0026] 323) According to the measured output values at the selected six calibration surface positions, the unknown parameters P = [p1 p2 p3 p4 p5 p6] are solved by using the linear least squares method. T , then:
[0027] P=(H T H) -1 H T d
[0028]
[0029] In the formula, H is the intermediate matrix, d is the constant matrix, a x (1)~a x (6) a y (1)~a y (6) a z (1)~a z (6) are the acceleration measurement output values of the three-axis accelerometer on the X, Y, and Z axes at the first to sixth calibration surface positions, respectively;
[0030] 323) According to the unknown parameters P = [p1 p2 p3 p4 p5 p6] T Calculate in sequence k x , k y , k z and [b x b y b z ] T , then:
[0031]
[0032] 324) Write the sensitivity and zero bias of the three-axis accelerometer X, Y, and Z axes into the memory of the dual-axis inclination sensor to complete the self-calibration of the inclination sensor.
[0033] A device for batch calibration of inclination sensors comprises a fixed frame, a rotating shaft which is fixedly connected to the fixed frame at one end and connected to a motor at the other end, and a tooling plate which is hinged to the fixed frame through a rotating member, wherein a plurality of circular through holes are provided on the tooling plate, and a calibration station is arranged at each of the circular through holes, and an inclination sensor to be calibrated is clamped and installed at each of the calibration stations.
[0034] Furthermore, each of the calibration stations has the same structure, including a slide rail with a U-shaped cross-section fixed on the side wall of the circular through hole, four sliders installed on the slide rail and capable of sliding and positioning on the slide rail, and a clamping piece fixed on the slider at one end, and the other end of the clamping piece is pressed into contact with the outer surface of the inclination sensor housing to be calibrated.
[0035] Furthermore, the slide rail is provided with a plurality of limiting teeth or limiting holes arranged at equal intervals, and the inner surface of each slider is provided with a tooth-shaped protrusion or a hemispherical protrusion that cooperates with the limiting teeth or the limiting holes, so as to limit the sliding slider when adjusting the angle position.
[0036] Furthermore, the clamping member adopts a retractable threaded telescopic rod or an elastic clamping block made of rubber material, so as to clamp the inclination sensor to be calibrated from four directions.
[0037] Furthermore, the tooling board is also provided with a signal wiring row and a power supply row connected to an external power supply.
[0038] Compared with the prior art, the present invention has the following advantages:
[0039] 1. Self-calibration can be performed without a turntable, reducing the investment cost of high-precision turntable;
[0040] 2. The number of installations is not affected by the load capacity of the turntable and the number can be expanded;
[0041] 3. No need to interact with the host computer, reducing communication tooling;
[0042] 4. Simple operation, no need for imperative communication. BRIEF DESCRIPTION OF THE DRAWINGS
[0043] Figure 1 is a flow chart of the method of the present invention;
[0044] Figure 2 It is a flow chart of the self-calibration method of the tilt sensor;
[0045] Figure 3 This is a schematic diagram of the structure of the inclination sensor batch calibration tooling.
[0046] Description of reference numerals:
[0047] 1. Tooling plate, 2. Fixed frame, 3. Rotating shaft, 4. Inclination sensor, 5. Rotating part, 11. Slide rail, 12. Slider, 13. Clamping part, 14. Power supply bus. DETAILED DESCRIPTION
[0048] The present invention is described in detail below in conjunction with the accompanying drawings and specific embodiments. This embodiment is implemented based on the technical solution of the present invention, and provides a detailed implementation method and specific operation process, but the protection scope of the present invention is not limited to the following embodiments.
[0049] It should be noted that in this specification, similar reference numerals and letters denote similar items in the following drawings, and therefore, once an item is defined in one drawing, it does not need to be further defined and explained in the subsequent drawings.
[0050] In the description of this embodiment, it should be noted that the terms "upper", "lower", "inner", "bottom", etc. indicate orientations or positional relationships based on the orientations or positional relationships shown in the accompanying drawings, or are the orientations or positional relationships in which the inventive product is usually placed when used. They are only for the convenience of describing the present invention and simplifying the description, and do not indicate or imply that the device or element referred to must have a specific orientation, be constructed and operated in a specific orientation, and therefore cannot be understood as a limitation on the present invention.
[0051] The terms “first”, “second”, etc. are only used for distinguishing descriptions and should not be understood as indicating or implying relative importance.
[0052] In the description of this embodiment, it is also necessary to explain that, unless otherwise clearly specified and limited, the terms "set", "connected", and "connected" should be understood in a broad sense, for example, it can be a fixed connection, a detachable connection, or an integral connection; it can be a mechanical connection or an electrical connection; it can be a direct connection, or it can be indirectly connected through an intermediate medium, or it can be the internal communication of two components. For ordinary technicians in this field, the specific meanings of the above terms in this embodiment can be understood according to specific circumstances.
[0053] To make the objectives, technical solutions and advantages of the present invention more clear, the embodiments of the present invention will be further described in detail below with reference to the accompanying drawings.
[0054] Example
[0055] In order to solve the problems mentioned in the background technology, the present invention provides a batch calibration method and device for inclination sensors that do not rely on a turntable. The method is based on the measurement characteristics of the dual-axis inclination sensor itself, adopts a self-calibration method, does not require a high-precision turntable, can effectively improve the batch calibration performance of the inclination sensor, and does not require control interactive communication with a host computer, thereby greatly improving the calibration efficiency.
[0056] like Figure 1 As shown, the batch calibration method of the tilt sensor that does not rely on a turntable of the present invention has the following steps:
[0057] Step 1: Fix the inclinometer product to be calibrated on the tooling board and select six unrelated calibration surfaces (in this example, the six surfaces of the inclinometer product housing can be selected as calibration surfaces. If there are special verification requirements, non-surface positions can also be selected);
[0058] Step 2: Connect the inclination sensor products to be calibrated to the power supply, so that each inclination sensor product is in batch debugging mode, and the indicator light is on;
[0059] Step 3: Power on multiple inclinometer products to be calibrated fixed on the tooling board in batches, adjust the position to the first calibration surface, and keep them stationary for 5 seconds at the current calibration surface position. The indicator lights are uniformly lit, and the three-axis acceleration value data of the current position of each inclinometer product to be calibrated (i.e., the acceleration measurement output value of the three-axis accelerometer X, Y, and Z axes) is collected and automatically written into the memory of the inclinometer product. After the writing is completed, the indicator light goes out, indicating that the data collection and writing work of the current calibration surface position is completed;
[0060] Step 4: Rotate the tooling to the next calibration surface and repeat step 3 until the data collection and writing work of all six calibration surfaces is completed. When the data collection and writing of the sixth calibration surface position is completed, the indicator light flashes to indicate that the data collection and writing work of all six calibration surfaces is completed;
[0061] Step 5: Perform self-calibration of the inclinometer without relying on a turntable based on the collected three-axis acceleration data of the six calibration surfaces, and complete the calibration of all inclinometer products to be calibrated.
[0062] like Figure 2 As shown, in the present invention, the tilt sensor self-calibration method comprises the following steps:
[0063] 1. Construct the error model of the three-axis accelerometer as follows:
[0064] A s =Ka+b
[0065] Among them, A s is the acceleration true value matrix, K is the meter sensitivity matrix, a is the measurement output value matrix, b is the zero bias matrix, and:
[0066] A s =[A x A y A z ] T , a=[a x a y a z ] T , b=[b x b y bz ] T
[0067] In the formula, A x , A y , A z are the true values of acceleration of the X, Y, and Z axes of the three-axis accelerometer, k x , k y , k z are the sensitivities of the X, Y, and Z axes of the three-axis accelerometer, a x 、a y 、a z are the acceleration measurement output values of the three-axis accelerometer X, Y, and Z axes, respectively, and b x 、b y 、b z They are the zero bias of the X, Y, and Z axes of the three-axis accelerometer respectively.
[0068] Among them, the acceleration true value matrix A s Satisfies the following formula:
[0069]
[0070] Right now:
[0071]
[0072] Where g is the acceleration due to gravity.
[0073] 2. The measured output values of the three-axis accelerometer X, Y, and Z axes at the six calibration surface positions collected are solved by the linear least squares method to obtain the sensitivity and zero bias of the three-axis accelerometer X, Y, and Z axes, which specifically includes the following steps:
[0074] 21. Divide both sides of equation (2) After transformation and arrangement, we can get:
[0075]
[0076] in,
[0077]
[0078] 22. According to the measured output values at the selected six calibration surface positions, use the linear least squares method to solve the unknown parameters P = [p1 p2 p3 p4 p5 p6] T , then:
[0079] P=(H T H) -1 H T d
[0080]
[0081] In the formula, H is the intermediate matrix, d is the constant matrix, a x (1)~a x (6) a y (1)~a y (6) a z (1)~a z (6) are the acceleration measurement output values of the three-axis accelerometer on the X, Y, and Z axes at the first to sixth calibration surface positions, respectively;
[0082] 23. Since it is impossible to determine the positive and negative zero bias of the three-axis accelerometer X, Y, and Z axes, first calculate the value based on the unknown parameters P = [p1p2 p3 p4 p5 p6] T Calculated
[0083]
[0084] In the calculation Then, we continue to calculate k x , k y , k z , then:
[0085]
[0086] Finally, we calculated [b x b y b z ] T Then we have:
[0087]
[0088] 24. Write the sensitivity and zero bias of the X, Y, and Z axes of the three-axis accelerometer into the memory of the dual-axis inclination sensor to complete the self-calibration of the inclination sensor.
[0089] The inclination sensor self-calibration method adopted by the present invention only needs to select six positions that do not interfere with each other in a static state to obtain the output under static conditions to solve the model error parameters. The solution can be completed using only the built-in single-chip microcomputer processing of the inclination sensor to obtain the final calibration result. It does not have too high requirements on the solution capability of the single-chip microcomputer and is suitable for large-scale rapid calibration.
[0090] like Figure 3As shown, in order to realize the above-mentioned batch calibration method of the inclination sensor that does not rely on the turntable, the present invention also provides a batch calibration device of the inclination sensor that does not rely on the turntable, the device comprises a tooling plate 1 for mounting a plurality of inclination sensors 4, a fixing frame 2, a rotating shaft 3 and an external power supply, one end of the rotating shaft 3 is connected to the motor transmission, and the other end is fixedly connected to the fixing frame 2, the fixing frame 2 is made of a light metal (such as aluminum alloy) as a whole, and can rotate in a plane driven by the rotating shaft 3;
[0091] The tooling plate 1 is made of aluminum alloy or hard plastic, and the thickness in this example is set to 2-3 cm. Its inner end surface is fixed to the fixing frame 2 through two rotating parts 5 (the number is selected according to the actual load situation, and 2 or more can be selected) torque hinges or friction hinges. The present invention uses torque hinges or friction hinges to enable the tooling plate 1 to rotate within a range of 180° and to hover at any angle position;
[0092] A plurality of circular through holes with the same radius are provided on the main body of the tooling plate 1 in an orthogonal arrangement (or other arrangements), and a calibration station is provided at each through hole. The structure of each calibration station is the same, including a U-shaped slide rail 11 fixed on the side wall of the circular through hole, four sliders 12 installed on the slide rail 11 and capable of sliding and positioning on the slide rail 11, and a clamping member 13 fixed on the slider 12 at one end, and the other end of the clamping member 13 is pressed and contacted with the outer surface of the housing of the inclination sensor 4 to be calibrated;
[0093] The slide rail 11 is provided with a plurality of limiting teeth or limiting holes arranged at equal intervals, and the inner surface of each slider 12 is provided with a tooth-shaped protrusion or a hemispherical protrusion that matches the limiting teeth or the limiting holes. When the sliding slider 12 is adjusted in angle, the limiting teeth match the tooth-shaped protrusion or the limiting holes match the hemispherical protrusion, so that the slider 12 can be fixed in the slide rail 11 without slipping;
[0094] The clamping member 13 can be a retractable threaded telescopic rod or an elastic clamping block made of rubber material, which is used to clamp the inclination sensor 4 to be calibrated from four directions without slipping. When a threaded telescopic rod is used, the threaded part on the rotating adjustment rod is rotated to extend the rod body and then press it against the outer shell surface of the inclination sensor 4 to achieve clamping. When an elastic clamping block is used, the inclination sensor is directly placed in the space between the four elastic clamping blocks. The four elastic clamping blocks are subjected to pressure and are tightly attached to the outer shell surface of the inclination sensor to complete the clamping operation.
[0095] In this example, the horizontal plane is taken as the plane where the X-axis and the Y-axis are located, the direction parallel to the axis of the rotating shaft 3 is taken as the Y-axis, and the vertical direction is taken as the Z-axis. When using the device for debugging, the rotating shaft 3 is first placed at the initial zero-degree position, the tooling plate 1 is placed in a horizontal position, and multiple inclination sensors to be calibrated are respectively installed and clamped on each calibration station, and then the external power supply is connected to the power supply row 14 on the tooling plate 1, and the power lines of each inclination sensor to be calibrated installed and fixed on the calibration station are respectively connected to the corresponding power supply ports of the power supply row 14;
[0096] After the wiring is completed, the tooling plate 1 is first placed in a horizontal position, the shaft 3 is in the initial angle position, and the positions of the four sliders 12 are rotated to adjust the positions so that the top surface of the inclination sensor to be calibrated faces the positive direction of the Z axis, and the two adjacent side surfaces face the positive directions of the X axis and the Y axis respectively. This is used as the initial position and the inclination sensor to be calibrated is adjusted to the batch debugging mode. Then, according to the selected six calibration surface positions, the rotation angle of the shaft 3 is controlled, the hinge rotation angle is adjusted, and the four sliders 12 are rotated to adjust the angle so that the position of the inclination sensor to be calibrated is stationary at the selected position, and the measurement output values of the X, Y, and Z axes of the three-axis accelerometer at the six calibration surface positions are respectively collected, and the above-mentioned batch calibration method for inclination sensors that does not rely on a turntable is used to complete the debugging and calibration.
[0097] In summary, the present invention provides a batch calibration device for inclination sensors that does not rely on a turntable and has rotational freedom in the X, Y, and Z axes respectively. It can not only stably clamp multiple inclination sensors to be calibrated in batches, but also can make the inclination sensors to be calibrated be located at the selected six calibration surface positions by adjusting the angles of the rotating shaft 3, the hinge and the slider 12 respectively, so as to realize batch calibration, have a wide adjustable range, and do not require a host computer and control communication. In addition, based on the batch calibration device, the present invention also provides a batch calibration method for inclination sensors that does not rely on a turntable. The method does not require the use of a high-precision turntable or high-precision control of the angle. It only needs to set six independent calibration surface positions to achieve calibration through the built-in batch calibration program of the inclination sensor to be calibrated (the program is used to implement a self-calibration method). The operation is convenient and fast, and can greatly improve the calibration efficiency and reduce costs. The calibration accuracy is not lower than the calibration method using a high-precision turntable, and the method has broad promotion prospects.
[0098] The preferred specific embodiments of the present invention are described in detail above. It should be understood that a person skilled in the art can make many modifications and changes based on the concept of the present invention without creative work. Therefore, any technical solution that can be obtained by a person skilled in the art through logical analysis, reasoning or limited experiments based on the concept of the present invention on the basis of the prior art should be within the scope of protection determined by the claims.
Claims
1. A batch calibration method for inclination sensors that does not rely on a turntable, characterized in that: The following steps are involved: 1) Determine six independent calibration surfaces and install the inclination sensor to be calibrated on the calibration device; 2) adjusting the inclination sensor to be calibrated to the angular positions of the six calibration surfaces in turn, collecting the acceleration measurement output value data at each angular position after a set static time; 3) Calibration is achieved through the self-calibration method of the tilt sensor.
2. A method for batch calibration of inclination sensors independent of a turntable according to claim 1, characterized in that: The step 3) specifically comprises the following steps: 31) Construct the error model of the three-axis accelerometer of the inclination sensor; 32) The acceleration measurement output value data at the angular positions of the six calibration surfaces, i.e., the acceleration measurement output values of the three-axis accelerometer X, Y, and Z axes, are solved by linear least squares method to obtain the sensitivity and zero bias corresponding to the three-axis accelerometer X, Y, and Z axes.
3. A method for batch calibration of tilt sensors independent of a turntable according to claim 2, characterized in that: In step 31), the error model of the three-axis accelerometer is specifically: A s =Ka+b Among them, A s is the acceleration true value matrix, K is the meter sensitivity matrix, a is the acceleration measurement output value matrix, b is the zero bias matrix, and: A s =[A x A y A z ] T 、 a=[a x a y a z ] T 、b=[b x b y b z ] T In the formula, A x , A y , A z are the acceleration true value matrices of the three-axis accelerometer X, Y, and Z axes, respectively, x , k y , k z are the sensitivities of the X, Y, and Z axes of the three-axis accelerometer, a x 、a y 、a z are the acceleration measurement output values of the three-axis accelerometer X, Y, and Z axes, respectively, and b x 、b y 、b z They are the zero bias of the X, Y, and Z axes of the three-axis accelerometer respectively.
4. A method for batch calibration of tilt sensors independent of a turntable according to claim 3, characterized in that: The acceleration true value matrix A s Satisfies the following formula: Right now: Where g is the acceleration due to gravity.
5. The method for batch calibration of tilt sensors independent of a turntable according to claim 4, characterized in that: The step 32) specifically comprises the following steps: 321) For the acceleration real value matrix A s The formula is transformed and sorted, then we have: in, 322) According to the measured output values at the selected six calibration surface positions, the unknown parameters P = [p1 p2 p3 p4 p5 p6] are solved by using the linear least squares method. T , then: P=(H T H) -1 H T d In the formula, H is the intermediate matrix, d is the constant matrix, a x (1)~a x (6) a y (1)~a y (6) a z (1)~a z (6) are the acceleration measurement output values of the three-axis accelerometer on the X, Y, and Z axes at the first to sixth calibration surface positions, respectively; 323) According to the unknown parameters P = [p1 p2 p3 p4 p5 p6] T Calculate in sequence k x , k y , k z and [b x b y b z ] T , then: 324) Write the sensitivity and zero bias of the three-axis accelerometer X, Y, and Z axes into the memory of the dual-axis inclination sensor to complete the self-calibration of the inclination sensor.
6. A calibration device for implementing the batch calibration method of the tilt sensor according to any one of claims 1 to 5, characterized in that: The device comprises a fixed frame (2), a rotating shaft (3) having one end fixedly connected to the fixed frame and the other end connected to a motor, and a tooling plate (1) hingedly connected to the fixed frame (2) via a rotating member (5), wherein the tooling plate (1) is provided with a plurality of circular through holes, and a calibration station is arranged at each of the circular through holes, and an inclination sensor (4) to be calibrated is clamped and installed at each of the calibration stations.
7. The calibration device according to claim 6, characterized in that: Each of the calibration stations has the same structure, and comprises a slide rail (11) with a U-shaped cross section fixed on the side wall of the circular through hole, four sliders (12) mounted on the slide rail (11) and capable of sliding and positioning on the slide rail (11), and a clamping member (13) with one end fixed on the slider (12), and the other end of the clamping member (13) is in pressing contact with the outer surface of the shell of the inclination sensor (4) to be calibrated.
8. The calibration device according to claim 7, characterized in that: The slide rail (11) is provided with a plurality of limiting teeth or limiting holes arranged at equal intervals, and the inner surface of each slider (12) is provided with a tooth-shaped protrusion or a hemispherical protrusion that cooperates with the limiting teeth or the limiting holes, so as to limit the position when the sliding slider (12) adjusts the angular position.
9. The calibration device according to claim 7, characterized in that: The clamping member (13) is a retractable threaded telescopic rod or an elastic clamping block made of rubber material, and is used to clamp the inclination sensor (4) to be calibrated from four directions.
10. The calibration device according to claim 6, characterized in that: The tooling plate (1) is also provided with a signal wiring row and a power supply row connected to an external power source.
Citation Information
Cited By
High-efficiency calibration device and method for calibration of inclinometer
CN119309603A
