Patent Application
20200400419
The present disclosure relates to the technical field of engineering measurement and pipeline measurement, and, more particularly, to an inertial navigation/odometer based pipeline three-dimensional curve measuring robot and an implementation method therefor.
A pipeline is a common linear shaped channel structure, which can not only be applied to transporting a plurality of fluid substances, including transporting natural gas, oil, water and more, but also can be applied as a machine running channel, such as a soil structure deformation observation pipeline. A pipeline measurement generally refers to a measurement for a three-dimensional shape curve of a pipeline. A current commonly used pipeline measurement is generally aiming at a plurality of needs including management and inspection, and is applied to grasping a position and a trend of a pipeline, such as a petroleum pipeline measurement, an underground pipeline measurement, and more. According to a relative position relationship between an instrument and the pipeline, the pipeline measurement may be divided into an external measurement and an internal measurement, wherein the external measurement generally uses a plurality of methods including an electromagnetic wave, a sound wave, a tracer and more, to measure the position and the trend of the pipeline. However, due to a barrier of buried soil, accuracy thereof is generally poor, no more than a decimeter scale. The internal measurement generally adopts a measuring robot for a measurement. Currently, the measuring robot mostly adopts a sensors-combination of gyro/odometer, also, a mechanical structure thereof is applied to ensuring the measuring robot for measurement moving on a center line of the pipeline. However, due to a plurality of reasons including a mechanical structure design, a sensor device configuration, a calculation algorithm, and more, currently a highest measurement accuracy of a measuring robot measurement is mostly at a centimeter scale (within a pipeline length of 100 meters), which can only be applied in a conventional pipeline position and trend measurement. On a whole, an accuracy of an existing pipeline measurement technology can only reach the centimeter scale. However an accuracy requirement for a deformation monitoring is at a millimeter scale (within a pipeline length of 100 m), thus an existing measurement method and equipment cannot meet the requirement for the deformation monitoring of a pipeline.
Therefore, the current technology needs to be improved and developed.
According to the above described defects, the purpose of the present disclosure is providing a pipeline three-dimensional curve measuring robot and an implementation method therefor, in order to solve a defect in the prior art that, the measurement accuracy of a measuring device is at the centimeter scale only, thus cannot meet the requirement for the deformation monitoring of a pipeline.
A technical solution of the present disclosure to solve the technical problems is as follows:
The present disclosure provides a first embodiment as a pipeline three-dimensional curve measuring robot, wherein comprising:
an electronic bin, a sliding rod connecting to a center of each of both sides of the electronic bin, a wheel bracket connecting to the sliding rod through a linear bearing, at least two sets of walking wheels evenly arrange on the wheel bracket, at least one set of odometer wheels having an independent retractable wheel bracket arranged on the sliding rod on one side, and an encoder installed on each of the odometer wheels; each of the sliding rod on each of both sides of the linear bearing has a spring installed;
the electronic bin has an inertial measurement unit (IMU), a collection control module and a power supply module arranged on a collection board inside the electronic bin;
each of the walking wheels makes a geometric center of the inertial measurement unit locate on a central axis of the electronic bin, by the springs contracting synchronously;
the collection control module, applied to controlling the inertial measurement unit and the encoder to collect a plurality of measurement data, and compares the measurement data with a plurality of three-dimensional curve data at a plurality of reference time points of the pipeline, and obtaining a deformation quantity of the three-dimensional curve of the pipeline.
Optionally, the collection control module further has an FPGA unit and a crystal oscillator unit arranged;
the inertial measurement unit connects to the FPGA unit through an RS-422 to LVTTL interface;
the FPGA unit establishes a communication connection with a host computer unit through a UART interface and a USB-to-serial interface respectively; applied to triggering and controlling the inertial measurement unit and the encoder to synchronously collect the measurement data and upload the measurement data collected to the host computer unit, according to a clock signal output from the crystal oscillator unit;
the host computer unit sends a data collection control instruction to the FPGA unit through the UART interface, and receives the measurement data through the USB-to-serial interface.
Optionally, each of both ends of the sliding rod has a power traction device arranged;
the power traction device comprises: a driving motor and an electric winch; the driving motor drives a cable on the electric winch to tow the measuring robot to move back and forth.
Optionally, a quantity of the walking wheels is three, and three of the walking wheels are arranged equally and symmetrically.
Optionally, a quantity of the odometer wheels is three, and three of the odometer wheels are arranged equally and symmetrically.
Optionally, the power supply module connects to all of the inertial measurement unit, the FPGA unit, the crystal oscillator unit, and the host computer unit.
The present disclosure further provides an implementation method of a measuring robot measuring the pipeline three-dimensional curve, wherein comprising:
controlling the measuring robot to move back and forth in the pipeline while keeping the geometric center of the inertial measurement unit being consistent with the central axis of the electronic bin, while controlling the inertial measurement unit and the encoder unit to collect the measurement data;
comparing the measurement data collected by the inertial measurement unit and the encoder to the three-dimensional curve data at the reference time points of the pipeline, and obtaining a deformation quantity of the three-dimensional curve of the pipeline.
Optionally, the step of controlling the measuring robot to move back and forth in the pipeline while keeping the geometric center of the inertial measurement unit being consistent with the central axis of the electronic bin further comprising:
each of the walking wheels achieves keeping the geometric center of the inertial measurement unit locating on the central axis of the electronic bin by the spring arranged on the sliding pole contracting synchronously, and at least one set of the odometer wheels on each independent contraction wheel bracket making an independent contraction;
through the power traction devices arranged on both ends of the sliding rode, the measuring robot is controlled to move back and forth in the pipeline.
Optionally, the collection board further has an FPGA unit, a crystal oscillator unit and a host computer unit arranged;
the method further comprises:
the FPGA unit triggers and controls the inertial measurement unit and the encoder to synchronously collect the measurement data and upload the measurement data collected to the host computer unit, according to the clock signal output from the crystal oscillator unit;
the host computer unit compares the measurement data received with the three-dimensional curve data at the reference time points of the pipeline, and the deformation quantity of the three-dimensional curve of the pipeline is then obtained.
Benefits: the present disclosure provides a pipeline three-dimensional curve measuring robot and an implementation method therefor, by tensioning the walking wheels synchronously, a measuring point of a pipeline measuring vehicle is kept always maintaining on the central axis of the pipeline, and by tensioning the odometer wheel independently, a high-precision mileage measurement is achieved, and by a high-precision integrated collection board, a synchronous data collection of a multi-path odometer and a high-precision inertial navigation is achieved. By an inertial navigation measuring device provided by the present disclosure, a measurement accuracy of the deformation in a pipeline three-dimensional curve at a millimeter-scale can achieved, and a requirement of monitoring the deformation can be satisfied.
In order to make the purpose, technical solution and the advantages of the present disclosure clearer and more explicit, further detailed descriptions of the present disclosure are stated here, referencing to the attached drawings and some embodiments of the present disclosure. It should be understood that the detailed embodiments of the disclosure described here are used to explain the present disclosure only, instead of limiting the present disclosure.
Aiming at a problem in the prior art that, a pipeline measuring device has a relatively low accuracy, the present disclosure provides a high-precision three-dimensional curve measuring robot for monitoring pipeline deformation, and an implementation method therefor. Specifically, the present disclosure applies the pipeline as a deformation monitoring device, which is buried in a deformation position to be monitored during constructing a civil structure, measuring a three-dimensional curve of the pipeline by a measuring robot for a pipeline, and comparing with a plurality of curves in different periods, to realize monitoring a structure deformation quantity.
A first embodiment provided by the present disclosure is a pipeline three-dimensional curve measuring robot, shown as
an electronic bin 20, a sliding rod 10 connecting to a center of each of both sides of the electronic bin 20, a wheel bracket connecting to the sliding rod 10 through a linear bearing 102, at least two sets of walking wheels 103 evenly distributed on the wheel bracket, at least one set of odometer wheel 104 having an independent retractable wheel bracket arranged on the sliding rod 10 on one side, and an encoder installed on each of the odometer wheels; each of the sliding rod 10 on each of both sides of the linear bearing 102 has a spring 101 installed;
in the electronic bin 20, it has an inertial measurement unit 201, a collection control module and a power supply module arranged;
each set of the walking wheel 103 makes a geometric center of the inertial measurement unit 201 be consistent with a central axis of the electronic bin 20, by the springs contracting synchronously;
the collection control module controls the inertial measurement unit 201 and the encoder 105 to collect a plurality of measurement data, and compares the measurement data with a plurality of three-dimensional curve data at a plurality of reference time points of the pipeline, before obtaining a deformation quantity of the three-dimensional curve of the pipeline.
The measuring robot provided by the present disclosure has the electronic bin arranged, the walking wheels and the odometer wheels are arranged on the sliding poles on both sides of the electronic bin. The electronic bin is arranged at a center of the measuring robot as a whole, while a center of the inertial measurement unit arranged on a collection board locates on a central axis of the electronic bin, and locates also on a central axis of the pipeline.
Walking wheels are arranged on both sides of the electronic bin after being synchronously tensioned, each side has at least one set of walking wheels arranged, each set of walking wheels has three walking wheels equally distributed, the walking wheels 103 are mounted on the wheel bracket, a wheel of the walking wheel 103 is made of a wear-resistant resin material with a suitable hardness. The wheel bracket connects to the sliding rod through the linear bearing 102, and each end of the linear bearing 102 on the sliding rod 10 has a spring arranged, making the three walking wheels contract synchronously, and ensuring that the wheel bracket is tensioned in the pipeline, so a central axis of a frame is consistent with the central axis of the pipeline. An elasticity of the spring on the sliding rod 10 is adjustable, that ensures the walking wheels be able to strictly fit a wall of the pipeline.
On each odometer wheel 104, there is an encoder 105 installed one-to-one correspondently; the encoder 105 converts a mechanical geometric displacement on an output shaft of the odometer wheel into a pulse or a digital quantity through a photoelectric conversion, before transmitting the pulse or the digital quantity to the collection control module connected. The sliding rods 10 on both ends of the linear bearing 102 has a spring 101 arranged.
Combing together the rear view of the measuring robot shown in
The collection board has an FPGA unit and a crystal oscillator unit arranged;
combining with
The FPGA unit triggers and controls the inertial measurement unit and the encoder to synchronously collect the measurement data and upload the measurement data collected to the host computer unit, according to a clock signal output from the crystal oscillator unit;
the host computer unit sends a data collection control instruction to the FPGA unit through the UART interface, and receives the measurement data through the USB-to-serial interface.
The collection board further has a power supply module arranged to supply power, the power supply module connects to all of the inertial measurement unit, the FPGA unit, the crystal oscillator unit, and the host computer unit.
A multi-sensor integrated measurement system arranged on the collection board is a core of the measuring robot. In the electronic bin, the multi-sensor integrated measurement system is composed of a plurality of modules including a core control of the FPGA unit, the crystal oscillator unit having a high-precision time reference source, the inertial measurement unit, the host computer unit, the power supply module and more. In the present disclosure, an FPGA unit is adopted to integrate the inertial measurement unit and a three-way high-precision encoder. Specifically, a high steady-voltage and temperature-control supplied quartz crystal having a frequency temperature stability of 1 ppm is used as a system time reference source. It takes time as a trigger source to trigger data synchronization by the FPGA unit, to control the inertial measurement unit (IMU) and a photoelectric encoder to simultaneously collect and upload the measurement data.
The host computer unit sends out a collection control instruction to the
FPGA unit through the UART interface first. And after receiving a trigger command, the FPGA unit uploads a plurality of pipeline measurement data to the host computer unit for analysis and storage through the USB-to-serial interface according to an established protocol in a real time. The collection control module realizes a synchronous collection and transmission control for a plurality of data from the multi-sensors, having a strong anti-interference ability. Achieving time synchronization among multi-sensors at a microsecond scale, through a characteristic of parallel control of the FPGA unit, is a hardware basis for a high-precision data fusion.
In order to make the measuring robot move in the pipeline, as shown in
Specifically, a winch composed of a small automated motor and a strong thin fiber cable is applied as a traction power for the measuring robot. During an operation, a motion of the measuring robot is controlled by controlling a motion of the driving motor. By arranging an electric winch on each of both ends of the pipeline, the measuring robot may reciprocate in the pipeline and perform multiple measurements. Rebuilding the power traction device with a programmable driving servo motor, it is able to realize an automatic movement and measurement of the measuring robot.
An operation of the measuring robot is divided into three stages, comprising a preparation stage, a measurement stage and an ending stage. During the preparation stage of a measurement, the electric winches are placed at both ends of the pipeline to be tested, and threading a cable of strong thin fiber on the electric winch into the pipeline by a threader, before connecting the cable to a universal pull ring at each of both ends of the measuring robot for the pipeline. During the measurement stage, a power switch of a measuring robot is turned on, and the measuring robot rests for 5-10 minutes at a nozzle of the pipeline for an initialization. After the initialization, a state of one winch working and one winch rotating is ensured, so the measuring robot can move back and forth multiple times in the pipeline, to achieve a plurality of measurements in a same pipeline section for deformation monitoring. At an end of the measurement, it is ensured that the measuring robot stays stationary in a pipeline for 5-10 minutes. During the ending stage, the measuring robot is taken out and the cable on the electric winch is untied.
A second embodiment provided by the present disclosure is an implementation method of a measuring robot measuring the pipeline three-dimensional curve, shown as
step S71, controlling the measuring robot to keep the geometric center of the inertial measurement unit on the central axis of the electronic bin, and move back and forth in the pipeline, while controlling the inertial measurement unit and the encoder unit to collect the measurement data.
In the present step, specifically, by arranging the power traction device on both ends of the sliding rod, the measuring robot is controlled to move back and forth; the power traction device comprises: a driving motor and an electric winch; the driving motor drives a cable on the electric winch to tow the measuring robot to move back and forth. In order to ensure an accuracy of the measurement data, it is further necessary to ensure that the geometric center of the inertial measurement unit is located on the central axis of the electronic bin.
Step S72, comparing the measurement data collected by the inertial measurement unit and the encoder to the three-dimensional curve data at the reference time points of the pipeline, and obtaining a deformation quantity of the three-dimensional curve of the pipeline.
Specifically, the step of controlling the measuring robot to keep the geometric center of the inertial measurement unit on the central axis of the electronic bin, and to move back and forth in the pipeline, further comprising:
each of the walking wheels achieves keeping the geometric center of the inertial measurement unit locating on the central axis of the electronic bin by the spring arranged on the sliding pole contracting synchronously, and at least one set of the odometer wheels on each independent contraction wheel bracket making an independent contraction;
through the power traction devices arranged on both ends of the sliding rode, the measuring robot is controlled to move back and forth in the pipeline.
Specifically, in order to ensure a collection of the measurement data smooth and a data transmission, the collection board further has an FPGA unit and a crystal oscillator unit arranged;
The method further comprises:
the FPGA unit triggers and controls the inertial measurement unit and the encoder to synchronously collect the measurement data and upload the measurement data collected to the host computer unit, according to the clock signal output from the crystal oscillator unit;
the host computer unit compares the measurement data received with the three-dimensional curve data at the reference time points of the pipeline, and the deformation quantity of the three-dimensional curve of the pipeline is then obtained.
Benefits: The present disclosure provides a pipeline three-dimensional curve measuring robot and an implementation method therefor. The measuring robot comprises: an electronic bin, a sliding rod connecting to a center of each of both sides of the electronic bin, a wheel bracket connecting to the sliding rod through a linear bearing, at least two sets of walking wheels equally distributed on the wheel bracket, at least one set of odometer wheels having an independent retractable wheel bracket arranged on the sliding rod on one side, and an encoder installed on each of the odometer wheels; inside the electronic bin, there is an inertial measurement unit arranged on a collection board. When making a measurement, the measuring robot is controlled to keep the geometric center of the inertia measuring unit locating on the center axil of the electronic bin before moving back and forth in the pipeline, while the inertia measuring unit collects the measuring data at a same time; comparing the measurement data collected by the inertial measurement unit and the encoder to the three-dimensional curve data at the reference time points of the pipeline, a deformation quantity of the three-dimensional curve of the pipeline is achieved. By tensioning the walking wheels synchronously, a measuring point of a pipeline measuring vehicle is always kept on the central axis of the pipeline, and by tensioning the odometer wheel independently, a high-precision odometer measurement is achieved, while by a high-precision integrated collection board, a synchronous data collection from a multi-path odometer and a high-precision inertial navigation is achieved. By an inertial navigation measuring device disclosed in the present disclosure, measurement accuracy at a millimeter-scale of the deformation in a pipeline three-dimensional curve can achieved, and a requirement on monitoring the deformation can be satisfied.
It should be understood that, the application of the present disclosure is not limited to the above examples listed. Ordinary technical personnel in this field can improve or change the applications according to the above descriptions, all of these improvements and transforms should belong to the scope of protection in the appended claims of the present disclosure.
| Number | Date | Country | Kind |
|---|---|---|---|
| 201910054508.2 | Jan 2019 | CN | national |
This application is a national stage application of PCT Patent Application No. PCT/CN 2019/121384, filed on 28 Nov. 2019, which claims priority to Chinese Patent Application No. 201910054508.2, filed on 21 Jan. 2019, the content of all of which is incorporated herein by reference.
| Filing Document | Filing Date | Country | Kind |
|---|---|---|---|
| PCT/CN2019/121384 | 11/28/2019 | WO | 00 |
