CN106041925A - System for measuring advancing distance of pipeline robot - Google Patents
System for measuring advancing distance of pipeline robot Download PDFInfo
- Publication number
- CN106041925A CN106041925A CN201610366561.2A CN201610366561A CN106041925A CN 106041925 A CN106041925 A CN 106041925A CN 201610366561 A CN201610366561 A CN 201610366561A CN 106041925 A CN106041925 A CN 106041925A
- Authority
- CN
- China
- Prior art keywords
- acceleration
- signal
- motor
- sensor
- travel distance
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1628—Programme controls characterised by the control loop
- B25J9/1653—Programme controls characterised by the control loop parameters identification, estimation, stiffness, accuracy, error analysis
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1602—Programme controls characterised by the control system, structure, architecture
- B25J9/161—Hardware, e.g. neural networks, fuzzy logic, interfaces, processor
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1628—Programme controls characterised by the control loop
- B25J9/1651—Programme controls characterised by the control loop acceleration, rate control
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1674—Programme controls characterised by safety, monitoring, diagnostic
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1679—Programme controls characterised by the tasks executed
- B25J9/1684—Tracking a line or surface by means of sensors
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- Artificial Intelligence (AREA)
- Evolutionary Computation (AREA)
- Fuzzy Systems (AREA)
- Mathematical Physics (AREA)
- Software Systems (AREA)
- Gyroscopes (AREA)
Abstract
The invention discloses a system for measuring the advancing distance of a pipeline robot. The system comprises a motor, a motor driver, a sensor and a controller, wherein the motor generates a Hall pulse signal according to the movement state of the pipeline robot; the motor driver receives and transmits the Hall pulse signal; the sensor collects an acceleration data signal and an angular velocity data signal of operation of the motor; the controller is connected with the motor driver and receives the Hall pulse signal, and the controller is connected with the sensor and receives the acceleration data signal and the angular velocity data signal and comprises a judging module and a calculating module; and the judging module generates a judging signal according to the Hall pulse signal, and the calculating module works out the operating distance of the robot according to the judging signal, the acceleration data signal and the angular velocity data signal. According to the system for measuring the advancing distance of the pipeline robot, a no-cable mode is adopted, inconvenience caused by cable hauling is avoided, and the advancing resistance of the robot is also decreased; an acceleration sensor and a gyroscope sensor are combined with the machine motor, so that the calculated distance is more accurate; and operation is simple, and the data error is small.
Description
Technical field
The present invention relates to a kind of measurement pipe robot travel distance system.
Background technology
Common range finding is divided into cable and untethered, has cable mode by robot cable in tow according to the flexible length of cable
Degree determines its distance, and the method attachment device is too many, and pull stretch to advance to robot and bring certain resistance；Commonly
Untethered mode uses acceleration transducer to realize range finding, and it is applicable on smooth ground apply, but foreign material in pipeline
More, ground out-of-flatness, and due to the noise jamming of sensor self so that the data that robot single pass sensor records
Error is excessive.
Summary of the invention
The present invention is in order to overcome above deficiency, it is provided that a kind of pipe robot travel distance system of measuring, present invention employing
Design a kind of robot measurement based on acceleration transducer, gyro sensor and Hall step-by-step counting pipeline internal enter away from
From, in pipeline, situation is complicated, and internal foreign material or breakage are more so that robot can not be maintained at a plane when advancing
On, it is worth error very big if only relying on the travel distance that acceleration transducer obtains, and due to the noise of sensor self
Interference, even if robot is static, acceleration still has numerical value, thus causes the accumulation of error, designs for this present invention and passes at six axles
The method that motor Hall step-by-step counting judges robot motion's state is combined on the basis of sensor, low cost, simple to operate, and data
Error is little.
The technical scheme that the present invention provides is:
A kind of measurement pipe robot travel distance system, including:
Motor, it produces Hall pulse signal according to the kinestate of pipe robot；
Motor driver, it is connected with described motor, receives described Hall pulse signal and transmits；
Sensor, it is six axle sensors, and it is connected with described motor, gathers acceleration and the angular velocity data letter of motor rotation
Number；
Controller, it is connected and receives described Hall pulse signal, described controller and described sensing with described motor driver
Device connects and receives described acceleration and angular velocity data signal, and described controller includes judge module and computing module, described
Judge module produces according to Hall pulse signal and judges signal and be sent to described computing module, and described computing module is according to described
Judge that signal and described acceleration and angular velocity data signal calculate robot range ability.
Preferably, in described measurement pipe robot travel distance system, described six axle sensors include three axles
Acceleration transducer and three-axis gyroscope sensor.
Preferably, in described measurement pipe robot travel distance system, described computing module includes filtering meter
Calculate unit, coordinate transformation unit and integral and calculating unit.
Preferably, in described measurement pipe robot travel distance system, described filtering computing unit is
Kalman filter computing unit.
Preferably, in described measurement pipe robot travel distance system, described coordinate transformation unit is quaternary
Number conversion unit.
Preferably, in described measurement pipe robot travel distance system, described filtering computing unit is to described
The acceleration of sensor acquisition and angular velocity data signal are filtered estimating and are calculated acceleration filtering numerical value, and described coordinate turns
Changing unit acceleration filters numerical value to be converted into acceleration coordinate components value, described integral and calculating unit is sat according to described acceleration
Mark component value and judging unit judge that signal calculates the travel distance of robot.
The invention has the beneficial effects as follows that the present invention uses acceleration transducer, gyro sensor and Hall step-by-step counting to survey
Amount robot enters distance at pipeline internal, use the mode of untethered, it is to avoid cable pulls the inconvenience brought, and decreases machine
The running resistance of people, is combined acceleration transducer and gyro sensor with machine motor so that the distance of calculating is more accurate
Really, the present invention is simple to operate, and error in data is little.
Accompanying drawing explanation
Fig. 1 is the module connection diagram of the present invention；
Fig. 2 is the workflow schematic diagram of the present invention.
Detailed description of the invention
The present invention is described in further detail below in conjunction with the accompanying drawings, to make those skilled in the art with reference to description literary composition
Word can be implemented according to this.
In conjunction with Fig. 1 and Fig. 2, the present invention provides a kind of and measures pipe robot travel distance system, including: motor, its root
Hall pulse signal is produced according to the kinestate of pipe robot；Motor driver, it is connected with motor, receives Hall pulse letter
Number and transmit；Sensor, it is six axle sensors, and it is connected with motor, gathers acceleration and the angular velocity data of motor rotation
Signal；Controller, it is connected with motor driver and receives Hall pulse signal, and controller is connected with sensor and receives acceleration
Degree and angular velocity data signal controller include judge module and computing module, it is judged that module produces according to Hall pulse signal to be sentenced
Break signal is also sent to computing module, and computing module is according to judging that signal and acceleration and angular velocity data signal calculate machine
People's range ability.Wherein, six axle sensors include 3-axis acceleration sensor and three-axis gyroscope sensor, and computing module includes
Filtering computing unit, coordinate transformation unit and integral and calculating unit.Filtering computing unit is Kalman filter computing unit, coordinate
Converting unit is quaternary number conversion unit, and filtering computing unit is to the acceleration of described sensor acquisition and angular velocity data signal
Being filtered estimating and be calculated acceleration filtering numerical value, acceleration is filtered numerical value and is converted into acceleration coordinate by coordinate transformation unit
Component value, according to acceleration coordinate components value and judging unit, integral and calculating unit judges that signal calculates the traveling of robot
Distance.
When using the present invention to measure, the Hall in each sampling period is fed back by robot motor's driver in real time
Umber of pulse, controller determines, according to the umber of pulse in the cycle, the kinestate that robot is current: accelerate, slow down, static or
Current uniform velocity.Robot relies on motor to drive and advances, so the pulse signal of Hall encoder feedback determines machine
The kinestate that people is current.Sensor acquisition acceleration and angular velocity initial data, acceleration and angular velocity are also divided by controller
Do not carry out Kalman filter estimation, and carry out quaternary number calculating according to the value obtained after filtering, obtain accekeration and sit at geography
The component that mark is fastened, the robot that the computing module in controller judges according to the controller judge module in each calculating cycle
Acceleration is processed by kinestate, if machine man-made static, is not integrated acceleration calculating, current period
Displacement is 0, otherwise is integrated acceleration calculating, and obtains robot displacement in each direction, thus obtains machine
People's travel distance in pipeline.
Although embodiment of the present invention is disclosed as above, but it is not restricted in description and embodiment listed fortune
With, it can be applied to various applicable the field of the invention completely, for those skilled in the art, and can be easily real
The most other amendment, therefore under the general concept limited without departing substantially from claim and equivalency range, the present invention is not limited to
Specific details and shown here as with the legend described.
Claims (6)
1. measure pipe robot travel distance system for one kind, it is characterised in that including:
Motor, it produces Hall pulse signal according to the kinestate of pipe robot；
Motor driver, it is connected with described motor, receives described Hall pulse signal and transmits；
Sensor, it is six axle sensors, and it is connected with described motor, gathers acceleration and the angular velocity data letter of motor rotation
Number；
Controller, it is connected and receives described Hall pulse signal, described controller and described sensing with described motor driver
Device connects and receives described acceleration and angular velocity data signal, and described controller includes judge module and computing module, described
Judge module produces according to Hall pulse signal and judges signal and be sent to described computing module, and described computing module is according to described
Judge that signal and described acceleration and angular velocity data signal calculate robot range ability.
2. measurement pipe robot travel distance system as claimed in claim 1, it is characterised in that described six axle sensor bags
Include 3-axis acceleration sensor and three-axis gyroscope sensor.
3. measurement pipe robot travel distance system as claimed in claim 1, it is characterised in that described computing module includes
Filtering computing unit, coordinate transformation unit and integral and calculating unit.
4. measurement pipe robot travel distance system as claimed in claim 3, it is characterised in that described filtering computing unit
For Kalman filter computing unit.
5. measurement pipe robot travel distance system as claimed in claim 3, it is characterised in that described coordinate transformation unit
For quaternary number conversion unit.
6. measurement pipe robot travel distance system as claimed in claim 3, it is characterised in that described filtering computing unit
Acceleration and angular velocity data signal to described sensor acquisition are filtered estimating and are calculated acceleration filtering numerical value, described
Acceleration is filtered numerical value and is converted into acceleration coordinate components value by coordinate transformation unit, described integral and calculating unit according to described in add
Speed coordinate component value and judging unit judge that signal calculates the travel distance of robot.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201610366561.2A CN106041925A (en) | 2016-05-30 | 2016-05-30 | System for measuring advancing distance of pipeline robot |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201610366561.2A CN106041925A (en) | 2016-05-30 | 2016-05-30 | System for measuring advancing distance of pipeline robot |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| CN106041925A true CN106041925A (en) | 2016-10-26 |
Family
ID=57174935
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201610366561.2A Pending CN106041925A (en) | 2016-05-30 | 2016-05-30 | System for measuring advancing distance of pipeline robot |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN106041925A (en) |
Cited By (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN109900296A (en) * | 2019-03-22 | 2019-06-18 | 华南农业大学 | A kind of agricultural machinery working travel speed detection system and detection method |
| CN114609406A (en) * | 2022-03-28 | 2022-06-10 | 杭州电子科技大学 | Hall strip-based moving object quantity and speed measuring method |
Citations (10)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN2141783Y (en) * | 1992-10-12 | 1993-09-08 | 张可 | Automobile rearview and front view anti-collision device |
| CN2150530Y (en) * | 1993-04-05 | 1993-12-22 | 铁道部科学研究院运输及经济研究所 | Combination recording instrument for battery fork lift |
| CN1872614A (en) * | 2006-06-30 | 2006-12-06 | 宁波Gqy视讯股份有限公司 | Standing and seating two-way type balanced car with two wheels |
| KR20080094618A (en) * | 2007-04-19 | 2008-10-23 | (주)에스엠엘전자 | System and method for position estimation using enconders and accelerometers |
| EP2141507A1 (en) * | 2008-07-02 | 2010-01-06 | 02Micro, Inc. | Global positioning system and dead reckoning (GPS&DR) integrated navigation system |
| CN101866005A (en) * | 2009-04-20 | 2010-10-20 | 财团法人工业技术研究院 | Space sensing device, movable carrier and operation method for positioning and controlling same |
| CN101936735A (en) * | 2010-08-20 | 2011-01-05 | 上海置诚通信工程技术有限公司 | Wireless double-metering range type underground pipeline trajectory three-dimensional measuring instrument |
| CN203704945U (en) * | 2013-10-24 | 2014-07-09 | 上海佳友市政建筑有限公司 | Pipeline track gauge with novel distance metering wheels |
| CN105180934A (en) * | 2015-09-16 | 2015-12-23 | 成都四威高科技产业园有限公司 | AVG inertial navigation method |
| CN205120128U (en) * | 2015-11-16 | 2016-03-30 | 深圳大铁检测装备技术有限公司 | Three -dimensional gesture measuring apparatu of pipeline based on inertia measuring technique |
-
2016
- 2016-05-30 CN CN201610366561.2A patent/CN106041925A/en active Pending
Patent Citations (10)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN2141783Y (en) * | 1992-10-12 | 1993-09-08 | 张可 | Automobile rearview and front view anti-collision device |
| CN2150530Y (en) * | 1993-04-05 | 1993-12-22 | 铁道部科学研究院运输及经济研究所 | Combination recording instrument for battery fork lift |
| CN1872614A (en) * | 2006-06-30 | 2006-12-06 | 宁波Gqy视讯股份有限公司 | Standing and seating two-way type balanced car with two wheels |
| KR20080094618A (en) * | 2007-04-19 | 2008-10-23 | (주)에스엠엘전자 | System and method for position estimation using enconders and accelerometers |
| EP2141507A1 (en) * | 2008-07-02 | 2010-01-06 | 02Micro, Inc. | Global positioning system and dead reckoning (GPS&DR) integrated navigation system |
| CN101866005A (en) * | 2009-04-20 | 2010-10-20 | 财团法人工业技术研究院 | Space sensing device, movable carrier and operation method for positioning and controlling same |
| CN101936735A (en) * | 2010-08-20 | 2011-01-05 | 上海置诚通信工程技术有限公司 | Wireless double-metering range type underground pipeline trajectory three-dimensional measuring instrument |
| CN203704945U (en) * | 2013-10-24 | 2014-07-09 | 上海佳友市政建筑有限公司 | Pipeline track gauge with novel distance metering wheels |
| CN105180934A (en) * | 2015-09-16 | 2015-12-23 | 成都四威高科技产业园有限公司 | AVG inertial navigation method |
| CN205120128U (en) * | 2015-11-16 | 2016-03-30 | 深圳大铁检测装备技术有限公司 | Three -dimensional gesture measuring apparatu of pipeline based on inertia measuring technique |
Non-Patent Citations (2)
| Title |
|---|
| BURNO SICILIANO: "《机器人手册》", 30 November 2012, 机械工业出版社 * |
| 冯新宇: "《ARM Cortex-M3体系结构与编程》", 29 February 2016, 清华大学出版社 * |
Cited By (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN109900296A (en) * | 2019-03-22 | 2019-06-18 | 华南农业大学 | A kind of agricultural machinery working travel speed detection system and detection method |
| CN114609406A (en) * | 2022-03-28 | 2022-06-10 | 杭州电子科技大学 | Hall strip-based moving object quantity and speed measuring method |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN106671974B (en) | A kind of method for detecting parking stalls for Intelligent parking system | |
| CN105865461B (en) | A kind of car position system and method based on Multi-sensor Fusion algorithm | |
| CN103632062B (en) | Method and device for determining uphill and downhill running states of vehicle | |
| CN101443628B (en) | Moving body with tilt angle estimating mechanism | |
| CN104360366B (en) | Dead reckoning and GPS (global positioning system) combined positioning method | |
| CN105109490B (en) | Method for judging sharp turn of vehicle based on three-axis acceleration sensor | |
| CN102991505B (en) | A kind of road ahead Curvature Estimation method | |
| CN110203223A (en) | A kind of track irregularity detection device | |
| CN103884293B (en) | Squeegee action online testing device based on light stream and method of testing | |
| CN103606206B (en) | A kind of motoring condition cognitive method using motoring condition sensing device | |
| CN105716617A (en) | System and method for drawing driving track on basis of vehicle data | |
| CN110073172A (en) | For determining the method for the relative position of motor vehicle, for the position determination system and motor vehicle of motor vehicle | |
| CN105737853B (en) | A kind of drift calibration method of robot inertial navigation system | |
| CN111186490A (en) | Steering wheel corner estimation method and system based on Ackerman steering theorem | |
| CN106041925A (en) | System for measuring advancing distance of pipeline robot | |
| CN106864461A (en) | A kind of method that vehicle movement behavior is judged based on acceleration transducer | |
| CN101975582A (en) | Personnel motion trail tracking method and device | |
| CN105523084A (en) | Method for detecting turning angle of vehicle based on three-axis acceleration sensor | |
| CN103786770A (en) | Automotive steering wheel cover and automotive reversing assist system | |
| CN112193080B (en) | Attitude detection system, attitude detection method, computer device, and storage medium | |
| CN202896650U (en) | Automotive steering wheel cover and automotive parking assist system | |
| CN105059318B (en) | A kind of portable railway detector | |
| CN102419179A (en) | Method and device for positioning mobile robot and recording running track of mobile robot | |
| CN109900296A (en) | A kind of agricultural machinery working travel speed detection system and detection method | |
| CN107901913A (en) | The vehicle centroid side drift angle and coefficient of road adhesion estimating system of Multi-source Information Fusion |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| C06 | Publication | ||
| PB01 | Publication | ||
| C10 | Entry into substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| RJ01 | Rejection of invention patent application after publication |
Application publication date: 20161026 |
|
| RJ01 | Rejection of invention patent application after publication |