Inclinometer and method for accurately measuring data thereof

By combining signal acquisition and processing circuits, the inclinometer achieves accurate measurement, solving the problems of large size, high cost and complex installation of traditional inclinometers, and improving measurement accuracy and reliability.

CN108332715BActive Publication Date: 2024-11-05WUHAN HAIKUO SCI-TECH CO LTD
View PDF 5 Cites 0 Cited by

Patent Information

Application Number
CN201810037749.1
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2018-01-12
Publication Date
2024-11-05
Estimated Expiration
2038-01-12

AI Technical Summary

Technical Problem

Traditional inclinometers rely on insulated bottles and orthogonal installation, which results in problems such as large size, high cost, inconvenient installation and debugging, and reduced measurement accuracy.

Method used

By combining a signal acquisition terminal, signal processing circuit, multiplexer, AD converter, microcontroller and peripheral communication interface circuit, accurate measurement is achieved through temperature compensation and position correction, avoiding the need for thermos bottles and orthogonal installation.

Benefits of technology

This technology improves the measurement accuracy and reliability of inclinometers while reducing costs and operational complexity without relying on thermos bottles or orthogonal installation.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN108332715B_ABST
    Figure CN108332715B_ABST
Patent Text Reader

Abstract

The embodiment of the present invention provides an inclinometer and a method for accurately measuring data thereof, wherein the inclinometer comprises a signal acquisition terminal, a signal processing circuit, a multiplexer, an AD converter, a single-chip microcomputer and a peripheral communication interface circuit connected in sequence, wherein the multiplexer is also connected to the single-chip microcomputer; the peripheral communication interface circuit is connected to a communication interface and a test interface included in the inclinometer. The single-chip microcomputer is used to perform temperature compensation on the signal collected by the signal acquisition terminal, and is also used to perform position correction on the signal collected by the signal acquisition terminal, so that the inclinometer can achieve accurate measurement without relying on a thermos bottle or accurate orthogonal installation.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the field of data measurement, and in particular to an inclinometer and a method for accurately measuring data thereof. Background Art

[0002] In the field of oil well logging, inclinometers are needed to measure wellbore trajectory parameters and obtain engineering parameters such as well inclination, azimuth, and relative azimuth. Currently, inclinometers are mostly used to measure using three-axis accelerometers and three-axis magnetometers. Traditional three-axis accelerometers output analog signals of each axis, which will change with temperature. Therefore, traditional three-axis accelerometers are generally used with thermos bottles to ensure measurement accuracy. However, thermos bottles have the disadvantages of large size, high cost, and inconvenient installation and debugging. In addition, traditional inclinometers require that both the three-axis accelerometer and the three-axis magnetometer must be installed orthogonally, otherwise it will affect the measurement accuracy. Summary of the invention

[0003] The object of the present invention is to provide an inclinometer and a method for accurately measuring data thereof, wherein the inclinometer can achieve accurate measurement without relying on a thermos flask or accurate orthogonal installation.

[0004] The embodiment of the present invention is achieved as follows:

[0005] In a first aspect, an embodiment of the present invention provides an inclinometer, which includes a signal acquisition end, a signal processing circuit, a multiplexer, an AD converter, a single-chip microcomputer and a peripheral communication interface circuit connected in sequence, wherein the multiplexer is also connected to the single-chip microcomputer; the peripheral communication interface circuit is connected to a communication interface and a test interface included in the inclinometer, and the single-chip microcomputer is used to perform temperature compensation on the signal collected by the signal acquisition end, and is also used to perform position correction on the signal collected by the signal acquisition end.

[0006] In a preferred embodiment of the present invention, the above-mentioned signal acquisition end includes a three-axis accelerometer, a three-axis magnetometer and a temperature sensor, the signal processing circuit includes a filtering circuit and a temperature measurement circuit, the three-axis accelerometer and the three-axis magnetometer are respectively connected to the filtering circuit, and the temperature sensor is connected to the temperature measurement circuit.

[0007] In a preferred embodiment of the present invention, the above-mentioned peripheral communication interface circuit includes a CAN modulation circuit and an RS232 modulation circuit. The single-chip microcomputer is connected to the CAN modulation circuit via a CAN bus and to the RS232 modulation circuit via a UART bus. The CAN modulation circuit is connected to the communication interface, and the RS232 modulation circuit is connected to the test interface.

[0008] In a preferred embodiment of the present invention, the above-mentioned single chip microcomputer is connected to the AD converter via an SPI bus.

[0009] In a preferred embodiment of the present invention, the above-mentioned filtering circuit includes a first resistor, a second resistor, a first capacitor, a second capacitor and a first amplifier, one end of the first resistor is connected to the three-axis accelerometer, and the other end is connected to an input end of the first amplifier, one end of the first capacitor is grounded, and the other end is connected to the one input end of the first amplifier, the output end of the first amplifier is connected to the second resistor and the other input end of the first amplifier in sequence, and the second capacitor is connected to the second resistor in parallel.

[0010] In a preferred embodiment of the present invention, the model of the first amplifier is OPA4140, the first resistor and the second resistor are precision resistors, and the first capacitor and the second capacitor are NPO capacitors.

[0011] In a preferred embodiment of the present invention, the temperature measurement circuit includes a third resistor, a fourth resistor, a fifth resistor, a sixth resistor and a second amplifier. The third resistor is connected to an input terminal of the second amplifier in parallel with the fourth resistor. One end of the fifth resistor is connected to the output terminal of the second amplifier and the other end is connected to the third resistor. One end of the sixth resistor is grounded and the other end is connected to another input terminal of the second amplifier.

[0012] In a preferred embodiment of the present invention, the AD converter model is CS5101.

[0013] In a preferred embodiment of the present invention, the RS232 modulation circuit comprises an RS232 transceiver driver chip, and the RS232 transceiver driver chip model is MAX3226.

[0014] In a preferred embodiment of the present invention, the CAN modulation circuit includes a CAN transceiver driver chip and a bus protection TVS tube connected to each other.

[0015] In a second aspect, an embodiment of the present invention provides a method for accurately measuring data, the method being applied to the inclinometer described in any embodiment of the first aspect, the inclinometer comprising a signal acquisition terminal, a signal processing circuit, a multiplexer, an AD converter, a single-chip microcomputer, and a peripheral communication interface circuit connected in sequence, the method comprising: the single-chip microcomputer acquiring seven signals collected by the signal acquisition terminal, the seven signals including a temperature signal; according to the temperature signal, based on the formula V(t)=F0+F1*t+F2*t 2 +F3*t 3, the single-chip microcomputer respectively calculates the base deviation and scale factor of each of the remaining six signals, F0, F1, F2 and F3 are temperature compensation parameters pre-stored in the single-chip microcomputer, and t is the temperature signal; the single-chip microcomputer obtains the seven AD quantization values ​​converted by the AD converter; the single-chip microcomputer calculates the output value of each signal after temperature compensation based on the base deviation and scale factor of each signal and each AD quantization value, which are ax, ay, az, mx, my, and mz respectively.

[0016] The beneficial effect of the embodiment of the present invention is as follows: the embodiment of the present invention provides an inclinometer and a method for accurately measuring data thereof, the inclinometer comprising a signal acquisition terminal, a signal processing circuit, a multiplexer, an AD converter, a single-chip microcomputer and a peripheral communication interface circuit connected in sequence, the multiplexer is also connected to the single-chip microcomputer; the peripheral communication interface circuit is connected to the communication interface and the test interface included in the inclinometer. The single-chip microcomputer is used to perform temperature compensation on the signal collected by the signal acquisition terminal, and is also used to perform position correction on the signal collected by the signal acquisition terminal, so that the inclinometer can achieve accurate measurement without relying on a thermos bottle or precise orthogonal installation.

[0017] Other features and advantages of the present invention will be described in the following description, and partly become apparent from the description, or be understood by implementing the embodiments of the present invention. The purpose and other advantages of the present invention can be realized and obtained by the structures particularly pointed out in the written description, claims and drawings. BRIEF DESCRIPTION OF THE DRAWINGS

[0018] In order to more clearly illustrate the technical solutions of the embodiments of the present invention, the drawings required for use in the embodiments are briefly introduced below. It should be understood that the following drawings only show certain embodiments of the present invention and therefore should not be regarded as limiting the scope. For ordinary technicians in this field, other related drawings can be obtained based on these drawings without creative work.

[0019] Figure 1 is a schematic structural diagram of an inclinometer provided by a first embodiment of the present invention;

[0020] Figure 2 is a structural block diagram of an inclinometer provided by a first embodiment of the present invention;

[0021] Figure 3 It is a structural block diagram of a signal acquisition terminal and a signal processing circuit of an inclinometer provided by a first embodiment of the present invention;

[0022] Figure 4 is a circuit diagram of a filter circuit of an inclinometer provided by a first embodiment of the present invention;

[0023] Figure 5 is a circuit diagram of a temperature measurement circuit of an inclinometer provided by a first embodiment of the present invention;

[0024] Figure 6 is a circuit diagram of a CAN modulation circuit of an inclinometer provided by a first embodiment of the present invention;

[0025] Figure 7 is a flow chart of a method for accurately measuring data provided by a second embodiment of the present invention;

[0026] Figure 8 It is a flow chart of another method for accurately measuring data provided by the third embodiment of the present invention.

[0027] Icons: 100 - inclinometer; 110 - signal acquisition terminal; 111 - three-axis accelerometer; 112 - three-axis magnetometer; 113 - temperature sensor; 120 - signal processing circuit; 121 - filter circuit; 122 - temperature measurement circuit; 130 - multiplexer; 140 - AD converter; 150 - single-chip microcomputer; 160 - peripheral communication interface circuit. DETAILED DESCRIPTION

[0028] In order to make the purpose, technical solutions and advantages of the embodiments of the present invention clearer, the technical solutions in the embodiments of the present invention will be clearly and completely described below in conjunction with the drawings in the embodiments of the present invention. Obviously, the described embodiments are part of the embodiments of the present invention, not all of the embodiments. Generally, the components of the embodiments of the present invention described and shown in the drawings here can be arranged and designed in various different configurations.

[0029] Therefore, the following detailed description of the embodiments of the present invention provided in the accompanying drawings is not intended to limit the scope of the invention claimed for protection, but merely represents selected embodiments of the present invention. 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.

[0030] It should be noted that similar reference numerals and letters denote similar items in the following drawings, and therefore, once an item is defined in one drawing, further definition and explanation thereof is not required in subsequent drawings.

[0031] In the description of the present invention, it should be noted that the terms "center", "upper", "lower", "left", "right", "vertical", "horizontal", "inside", "outside", etc. indicate positions or positional relationships based on the positions or positional relationships shown in the accompanying drawings, or the positions or positional relationships in which the product of the invention is usually placed when in use. 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 position, be constructed and operated in a specific position, and therefore cannot be understood as limiting the present invention. In addition, the terms "first", "second", "third", etc. are only used to distinguish the description, and cannot be understood as indicating or implying relative importance.

[0032] In addition, the terms "horizontal", "vertical", "overhanging" and the like do not mean that the components are required to be absolutely horizontal or overhanging, but can be slightly tilted. For example, "horizontal" only means that its direction is more horizontal than "vertical", and does not mean that the structure must be completely horizontal, but can be slightly tilted.

[0033] In the description of the present invention, it is also necessary to explain that, unless otherwise clearly specified and limited, the terms "set", "install", "connect", and "connect" 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 elements. For ordinary technicians in this field, the specific meanings of the above terms in the present invention can be understood according to specific circumstances.

[0034] Please refer to Figure 1 as well as Figure 2 The present embodiment provides an inclinometer 100 , which includes a signal acquisition terminal 110 , a signal processing circuit 120 , a multiplexer 130 , an AD converter 140 , a single chip microcomputer 150 and a peripheral communication interface circuit 160 .

[0035] Among them, the signal acquisition terminal 110, the signal processing circuit 120, the multiplexer 130, the AD converter 140, the single-chip microcomputer 150 and the peripheral communication interface circuit 160 are electrically connected in sequence. In addition, the multiplexer 130 is also connected to the single-chip microcomputer 150 so that the single-chip microcomputer 150 controls the channel selection of the multiplexer 130. The peripheral communication interface circuit 160 is connected to the communication interface and the test interface included in the inclinometer 100 to facilitate the output of data.

[0036] Please see Figure 3Furthermore, the signal acquisition end 110 includes a three-axis accelerometer 111, a three-axis magnetometer 112 and a temperature sensor 113, the signal processing circuit 120 includes a filter circuit 121 and a temperature measurement circuit 122, the three-axis accelerometer 111 and the magnetometer 112 are respectively connected to the filter circuit 121, and the temperature sensor 113 is connected to the temperature measurement circuit 122.

[0037] The three-axis accelerometer 111 can collect three-axis acceleration signals (analog signals) AX, AY, and AZ, the three-axis magnetometer 112 can collect three-axis magnetic signals (analog signals) MX, MY, and MZ, and the temperature sensor 113 can collect temperature signals TEMP.

[0038] Since the three-axis accelerometer 111 and the three-axis magnetometer 112 are respectively connected to the filter circuit 121, and the temperature sensor 113 is connected to the temperature measurement circuit 122, the analog signals collected by the three-axis accelerometer 111 and the three-axis magnetometer 112 can be input into the filter circuit 121 as the input signal of the filter circuit 121; the temperature signal TEMP collected by the temperature sensor 113 can be input into the temperature measurement circuit 122 as the input signal of the temperature measurement circuit 122. It is worth pointing out that the filtering circuit 121 is a low-pass filtering circuit and includes at least six filtering channels. Preferably, the present embodiment directly selects six low-pass filtering circuits for introduction, so that each of the three-axis acceleration signals AX, AY, and AZ collected by the three-axis accelerometer 111 is respectively connected to one filtering channel of the filtering circuit 121, and each of the three-axis magnetic signals MX, MY, and MZ collected by the three-axis magnetometer 112 is also respectively connected to one filtering channel of the filtering circuit 121, that is, the six signals AX, AY, AZ, MX, MY, and MZ are respectively connected to one filtering channel.

[0039] Among them, please see Figure 4 , the filtering circuit 121 can use a low-pass filter to filter out the high-frequency components in the signal to ensure measurement accuracy. Specifically, for each filtering channel of the filtering circuit 121, a first resistor R1, a second resistor R2, a first capacitor C1, a second capacitor C2 and a first amplifier D1 can be included. One end of the first resistor R1 is connected to the signal output end of the three-axis accelerometer 111 or the three-axis magnetometer 112, and the other end is connected to an input end of the first amplifier D1. One end of the first capacitor C1 is grounded, and the other end is connected to the one input end of the first amplifier D1. The output end of the first amplifier D1 is connected to the second resistor R2 and the other input end of the first amplifier D1 in sequence, and the second capacitor C2 is connected in parallel with the second resistor R2.

[0040] Among them, the cutoff frequency of the filter circuit 121 connected to the three-axis accelerometer 111 is higher than the cutoff frequency of the filter circuit 121 connected to the three-axis magnetometer 112, which can be achieved by adjusting the resistance and capacitance values, so that a better dynamic response can be obtained, and advanced technologies such as acceleration correction and rotation speed measurement can be realized. It is worth pointing out that software filtering is required when used to calculate the posture, so that the cutoff frequency of the three-axis accelerometer 111 is consistent with the cutoff frequency of the three-axis magnetometer 112. Specifically, the signal of the three-axis accelerometer 111 is oversampled (8 times the signal acquisition frequency of the three-axis magnetometer 112), and then the mean filter is used for calculation. This is because the three-axis accelerometer 111 is very sensitive to vibration, and the signal interference is large during the measurement process. The processing method of oversampling and mean filtering greatly improves the accuracy and stability of the calculation.

[0041] Please see Figure 5 The temperature measurement circuit 122 may include a third resistor R3, a fourth resistor R4, a fifth resistor R5, a sixth resistor R6 and a second amplifier D2. The third resistor R3 is connected in parallel with the fourth resistor R4 and connected to an input terminal of the second amplifier D2. One end of the fifth resistor R5 is connected to the output terminal of the second amplifier D2 and the other end is connected to the third resistor R3. One end of the sixth resistor R6 is grounded and the other end is connected to the other input terminal of the second amplifier D2. For the temperature signal TEMP, the temperature measurement circuit 122 uses a biasing method to make the output temperature signal within the AD sampling range (i.e. ±4.5V).

[0042] The first amplifier D1 and the second amplifier D2 may be of OPA4140, the first resistor R1, the second resistor R2, the third resistor R3, the fourth resistor R4, the fifth resistor R5 and the sixth resistor R6 are precision resistors (0.01% accuracy), and the first capacitor C1 and the second capacitor C2 are NPO capacitors. That is, the components constituting the filter circuit 121 and the temperature measurement circuit 122 are all electronic components with high precision and low temperature drift, which ensures the measurement accuracy and reduces the measurement error.

[0043] The signal processing circuit 120 is connected to the multiplexer 130, and the seven signals (AX, AY, AZ, MX, MY, MZ, TEMP) modulated by the signal processing circuit 120 are sent to the 8-to-1 multiplexer 130. The channel selection of the multiplexer 130 is controlled by the single-chip microcomputer 150. The output signal of the multiplexer 130 enters the AD converter 140, and the AD converter 140 quantizes each of the seven signals to obtain the AD quantization value of each signal converted into a digital signal.

[0044] Among them, the accuracy of the AD converter 140 is the most critical indicator. This embodiment uses the CS5101, a 16-bit 100KHz throughput conversion chip. The high accuracy of the AD converter 140 improves the overall measurement accuracy of the inclinometer 100, and the low temperature drift characteristic of the AD converter 140 reduces the difficulty of temperature compensation correction.

[0045] The AD converter 140 is connected to the single-chip microcomputer 150 via the SPI bus, and there is also a reset control line and a busy waiting state line STBY. The reset control line is used to control the reset process of the converter 140. During the reset, the chip performs a self-calibration process to ensure the conversion accuracy of the chip under various temperature environments. The single-chip microcomputer 150 is also directly connected to the multiplexer 130, so that the single-chip microcomputer 150 can obtain the seven signals before analog-to-digital conversion, and can also obtain the AD quantization value of each signal in the seven signals. Based on the seven signals before analog-to-digital conversion and the AD quantization value of each signal in the seven signals, the single-chip microcomputer 150 can perform temperature compensation and position correction on each AD quantization value of the seven signals except the temperature TEMP signal.

[0046] For details, please see Figure 7 The process of temperature compensation of each AD channel quantization value except the temperature TEMP signal in the seven channels of signals by the single chip microcomputer 150 is as follows:

[0047] Step S110: Acquire seven signals (AX, AY, AZ, MX, MY, MZ, TEMP) collected by the signal collection terminal 110.

[0048] Step S120: the single chip microcomputer obtains seven-channel AD quantization values ​​converted by the AD converter.

[0049] Step S130: According to the temperature signal TEMP (t in the formula), based on the formula V(t) = F0 + F1*t + F2*t2 + F3*t3, the single chip microcomputer calculates the base deviation and the scale factor of each of the remaining six signals.

[0050] Among them, the base deviation is expressed as Bxx, the scale factor is expressed as Sxx, (xx represents AX, AY, AZ, MX, MY, MZ), F0, F1, F2 and F3 are temperature compensation parameters pre-stored in the EEPROM of the microcontroller, totaling 4*2*6=48 floating point numbers, and t is the temperature signal.

[0051] Step S140: the single chip microcomputer calculates the output value of each signal after temperature compensation based on the base deviation and scale factor of each signal and each AD quantization value.

[0052] The calculation formula is:

[0053] ax=(AD AX *9 / 65536) / S AX –B AX ;

[0054] ay=(AD AY *9 / 65536) / S AY –B AY ;

[0055] az=(AD AZ *9 / 65536) / S AZ –B AZ ;

[0056] mx=(AD MX *9 / 65536) / S MX –B MX ;

[0057] my=(AD MY *9 / 65536) / S MY –B MY ;

[0058] mz=(AD MZ *9 / 65536) / S MZ –B MZ ;

[0059] Among them, AX, AY, AZ, MX, MY, and MZ correspond to ax, ay, az, mx, my, and mz respectively after temperature compensation; ADxx is the AD quantization value, Sxx is the scale coefficient, Bxx is the base deviation, and xx represents AX, AY, AZ, MX, MY, and MZ.

[0060] Among them, the temperature compensation range is -20℃ ̄175℃.

[0061] When measuring data, the inclinometer 100 of the present invention can perform temperature compensation on the data based on the above-mentioned temperature compensation method, thereby reducing the error caused by temperature on the data and no longer relying on a thermos bottle for data measurement.

[0062] In addition, see Figure 8 The process of position correction of each AD channel quantization value of the seven channels of signals except the temperature TEMP signal by the single chip microcomputer 150 is as follows:

[0063] Step S210: Acquire seven signals (AX, AY, AZ, MX, MY, MZ, TEMP) collected by the signal collection terminal 110.

[0064] Step S220: obtaining seven-channel AD quantization values ​​converted by the AD converter.

[0065] Step S230: According to the temperature signal TEMP (t in the formula), based on the formula V(t) = F0 + F1*t + F2*t2 + F3*t3, the single chip microcomputer calculates the base deviation and the scale factor of each of the remaining six signals.

[0066] Step S240: Based on the base deviation and scale factor of each signal and each AD quantization value, the output value of each signal after temperature compensation is calculated, a total of six signals, namely ax, ay, az, mx, my, and mz.

[0067] For the detailed process of the above steps S210 to S240 , please refer to S110 to S140 .

[0068] Step S250: Calculate the corrected acceleration and the corrected three-axis magnetometer output value based on the following formula:

[0069] ax'=ax*CAxx+ay*CAxy+az*CAxz;

[0070] ay'=ax*CAyx+ay*CAyy+az*CAyz;

[0071] az'=ax*CAzx+ay*CAzy+az*CAzz;

[0072] mx'=mx*CMxx+my*CMxy+mz*CMxz;

[0073] my'=mx*CMyx+my*CMyy+mz*CMyz;

[0074] mz'=mx*CMzx+my*CMzy+mz*CMzz;

[0075] Among them, ax', ay', az' are the components of the corrected acceleration, mx', my', mz' are the components of the corrected three-axis magnetometer output value, CAnn and CMnn are two sets of pre-saved position correction coefficients. Both sets of position correction coefficients are represented by 3X3 matrices, and the values ​​in the matrix are represented by CAnn and CMnn here.

[0076] The components of the acceleration after position correction and the components of the three-axis magnetometer output value can correct the data errors caused by the installation position deviation of the three-axis magnetometer 112 and the three-axis accelerometer 111, eliminating the tedious work of regular fine-tuning of the sensors of the instrument, and the fixed installation without adjustment greatly enhances the reliability of the instrument.

[0077] The peripheral communication interface circuit 160 may include a CAN modulation circuit and an RS232 modulation circuit. The single-chip microcomputer 150 is connected to the CAN modulation circuit via a CAN bus and to the RS232 modulation circuit via a UART bus. The CAN modulation circuit is connected to the communication interface of the inclinometer 100, and the RS232 modulation circuit is connected to the test interface of the inclinometer 100. The temperature-compensated and calibrated data may be output via the peripheral communication interface circuit 160.

[0078] The RS232 modulation circuit includes an RS232 transceiver driver chip, and the RS232 transceiver driver chip model is MAX3226. Figure 6 The CAN modulation circuit includes a CAN transceiver driver chip and a bus protection TVS tube connected to each other.

[0079] The embodiment of the present invention provides an inclinometer 100 and a method for accurately measuring data thereof. The inclinometer 100 includes a signal acquisition terminal 110, a signal processing circuit 120, a multiplexer 130, an AD converter 140, a single chip microcomputer 150 and a peripheral communication interface circuit 160 connected in sequence, wherein the multiplexer 130 is also connected to the single chip microcomputer 150; the peripheral communication interface circuit 160 is connected to the communication interface and the test interface included in the inclinometer 100. The single chip microcomputer 150 can perform temperature compensation correction on the base deviation and scale factor of the signal acquisition terminal 110, and removes the thermos bottle under the premise of ensuring the measurement accuracy, so that the inclinometer 100 is greatly improved in terms of cost, volume and operation convenience; in addition, the single chip microcomputer 150 can correct the installation position deviation of the signal acquisition terminal 110, eliminating the tedious work of the inclinometer 100 having to perform regular fine adjustment of the sensor, and the fixed installation without adjustment greatly enhances the reliability of the instrument.

[0080] The above description is only a preferred embodiment of the present invention and is not intended to limit the present invention. For those skilled in the art, the present invention may have various modifications and variations. Any modification, equivalent replacement, improvement, etc. made within the spirit and principle of the present invention shall be included in the protection scope of the present invention.

Claims

1. An inclinometer, characterized in that: It comprises a signal acquisition terminal, a signal processing circuit, a multiplexer, an AD converter, a single-chip microcomputer and a peripheral communication interface circuit connected in sequence, wherein the multiplexer is also connected to the single-chip microcomputer; the peripheral communication interface circuit is connected to a communication interface and a test interface included in the inclinometer; the single-chip microcomputer is used to perform temperature compensation on the signal collected by the signal acquisition terminal, and is also used to perform position correction on the signal collected by the signal acquisition terminal; Wherein, the signal acquisition end includes a three-axis accelerometer, a three-axis magnetometer and a temperature sensor, the signal processing circuit includes a filtering circuit and a temperature measurement circuit, the three-axis accelerometer and the three-axis magnetometer are respectively connected to the filtering circuit, the temperature sensor is connected to the temperature measurement circuit, the three-axis accelerometer can collect three-axis acceleration signals AX, AY, AZ, the three-axis magnetometer can collect three-axis magnetic signals MX, MY, MZ, and the temperature sensor can collect temperature signals t; The single chip microcomputer is used to obtain seven signals collected by the signal collection end, wherein the seven signals include a temperature signal; obtain seven AD quantization values ​​converted by the AD converter; and according to the temperature signal, based on the formula V(t)=F0+F1*t+F2*t 2 +F3*t 3 , respectively calculating the base deviation and scale factor of each of the remaining six signals in the seven signals except the temperature signal, F0, F1, F2 and F3 are temperature compensation parameters pre-stored in the single-chip microcomputer, and t is the temperature signal; based on the base deviation and scale factor of each signal and each AD quantization value, the output value of each signal after temperature compensation is calculated, which are ax, ay, az, mx, my, and mz respectively; Among them, the output value of each signal after temperature compensation is calculated based on the base deviation and scale coefficient of each signal and each AD quantization value, which are ax, ay, az, mx, my, and mz, respectively, using the following formula: ax=(AD AX *9 / 65536) / S AX –B AX ; is=(AD AY *9 / 65536) / S AY –B AY ; az=(AD AZ *9 / 65536) / S AZ –B AZ ; mx=(AD MX *9 / 65536) / S MX –B MX ; my=(AD MY *9 / 65536) / S MY –B MY ; mz=(AD MZ *9 / 65536) / S MZ –B MZ ; Among them, after temperature compensation, AX, AY, AZ, MX, MY, and MZ correspond to ax, ay, az, mx, my, and mz respectively; ADxx is the AD quantization value, Sxx is the scale coefficient, Bxx is the base deviation, and xx represents AX, AY, AZ, MX, MY, and MZ.

2. The inclinometer according to claim 1, characterized in that The peripheral communication interface circuit includes a CAN modulation circuit and an RS232 modulation circuit. The single-chip microcomputer is connected to the CAN modulation circuit via a CAN bus and to the RS232 modulation circuit via a UART bus. The CAN modulation circuit is connected to the communication interface, and the RS232 modulation circuit is connected to the test interface.

3. The inclinometer according to claim 1, characterized in that The single chip microcomputer is connected to the AD converter via an SPI bus.

4. The inclinometer according to claim 1, characterized in that The filtering circuit includes a first resistor, a second resistor, a first capacitor, a second capacitor and a first amplifier, one end of the first resistor is connected to the three-axis accelerometer, and the other end is connected to an input end of the first amplifier, one end of the first capacitor is grounded, and the other end is connected to the one input end of the first amplifier, the output end of the first amplifier is connected to the second resistor and the other input end of the first amplifier in sequence, and the second capacitor is connected to the second resistor in parallel.

5. The inclinometer according to claim 4, characterized in that The model of the first amplifier is OPA4140, the first resistor and the second resistor are precision resistors, and the first capacitor and the second capacitor are NPO capacitors.

6. The inclinometer according to claim 1, characterized in that The temperature measurement circuit includes a third resistor, a fourth resistor, a fifth resistor, a sixth resistor and a second amplifier. The third resistor is connected to an input end of the second amplifier after being connected in parallel with the fourth resistor. One end of the fifth resistor is connected to the output end of the second amplifier, and the other end is connected to the third resistor. One end of the sixth resistor is grounded, and the other end is connected to the other input end of the second amplifier.

7. The inclinometer according to claim 1, characterized in that The AD converter model is CS5101.

8. The inclinometer according to claim 1, characterized in that: The single chip microcomputer is also used for: The corrected acceleration and the corrected three-axis magnetometer output value are calculated based on the following formula: ax'=ax*CAxx+ay*CAxy+az*CAxz; ay'=ax*CAyx+ay*CAyy+az*CAyz; az'=ax*CAzx+ay*CAzy+az*CAzz; mx'=mx*CMxx+my*CMxy+mz*CMxz; my'=mx*CMyx+my*CMyy+mz*CMyz; mz'=mx*CMzx+my*CMzy+mz*CMzz; Among them, ax', ay', az' are components of the calibrated acceleration, mx', my', mz' are components of the calibrated output value of the three-axis magnetometer, and CAnn and CMnn are pre-stored position correction coefficients.

Citation Information

Patent Citations

  • Sensitive axis non-orthogonal compensation correction method in accelerometer application of realizing inclination measurement

    CN103090882A

  • LM_BP-algorithm-based temperature compensation method and system of micro-silicon accelerometer

    CN104950135A

  • Inclinometer

    CN207703205U

  • INCLINOMETER

    RU111890U1

  • Integrated-strapdown-air-data sensor system

    US4303978A