CN105922260A - 一种两核两轴履带式天然气管道机器人控制系统 - Google Patents
一种两核两轴履带式天然气管道机器人控制系统 Download PDFInfo
- Publication number
- CN105922260A CN105922260A CN201610400344.0A CN201610400344A CN105922260A CN 105922260 A CN105922260 A CN 105922260A CN 201610400344 A CN201610400344 A CN 201610400344A CN 105922260 A CN105922260 A CN 105922260A
- Authority
- CN
- China
- Prior art keywords
- robot
- natural gas
- controller
- synchronous motor
- arm controller
- 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.)
- Granted
Links
- VNWKTOKETHGBQD-UHFFFAOYSA-N methane Chemical compound C VNWKTOKETHGBQD-UHFFFAOYSA-N 0.000 title claims abstract description 98
- 239000003345 natural gas Substances 0.000 title claims abstract description 49
- 230000001360 synchronised effect Effects 0.000 claims abstract description 69
- 238000004891 communication Methods 0.000 claims abstract description 24
- 238000003860 storage Methods 0.000 claims abstract description 23
- 230000005355 Hall effect Effects 0.000 claims abstract description 18
- 238000007689 inspection Methods 0.000 claims abstract description 13
- 238000006073 displacement reaction Methods 0.000 claims description 50
- 238000000034 method Methods 0.000 claims description 28
- 230000006378 damage Effects 0.000 claims description 19
- 230000033001 locomotion Effects 0.000 claims description 15
- 238000001514 detection method Methods 0.000 claims description 13
- 238000012937 correction Methods 0.000 claims description 8
- 230000002093 peripheral effect Effects 0.000 claims description 7
- HBBGRARXTFLTSG-UHFFFAOYSA-N Lithium ion Chemical compound [Li+] HBBGRARXTFLTSG-UHFFFAOYSA-N 0.000 claims description 4
- 229910001416 lithium ion Inorganic materials 0.000 claims description 4
- 238000013500 data storage Methods 0.000 claims description 3
- 238000003786 synthesis reaction Methods 0.000 claims description 3
- 230000008901 benefit Effects 0.000 abstract description 6
- 230000004044 response Effects 0.000 abstract description 6
- 238000012545 processing Methods 0.000 abstract description 4
- 230000008569 process Effects 0.000 description 18
- 230000002159 abnormal effect Effects 0.000 description 6
- 230000004308 accommodation Effects 0.000 description 6
- 230000006870 function Effects 0.000 description 6
- 230000007246 mechanism Effects 0.000 description 6
- 230000005540 biological transmission Effects 0.000 description 5
- 230000000694 effects Effects 0.000 description 5
- 238000005516 engineering process Methods 0.000 description 5
- 239000007789 gas Substances 0.000 description 5
- 229910052761 rare earth metal Inorganic materials 0.000 description 5
- 150000002910 rare earth metals Chemical class 0.000 description 5
- 230000001133 acceleration Effects 0.000 description 4
- 238000010586 diagram Methods 0.000 description 4
- 238000011160 research Methods 0.000 description 4
- 230000011664 signaling Effects 0.000 description 4
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 description 4
- 238000013461 design Methods 0.000 description 3
- 238000004880 explosion Methods 0.000 description 3
- CURLTUGMZLYLDI-UHFFFAOYSA-N Carbon dioxide Chemical compound O=C=O CURLTUGMZLYLDI-UHFFFAOYSA-N 0.000 description 2
- 230000004888 barrier function Effects 0.000 description 2
- 238000011161 development Methods 0.000 description 2
- 230000018109 developmental process Effects 0.000 description 2
- 230000004807 localization Effects 0.000 description 2
- 239000000696 magnetic material Substances 0.000 description 2
- 239000000463 material Substances 0.000 description 2
- 239000000523 sample Substances 0.000 description 2
- GOLXNESZZPUPJE-UHFFFAOYSA-N spiromesifen Chemical compound CC1=CC(C)=CC(C)=C1C(C(O1)=O)=C(OC(=O)CC(C)(C)C)C11CCCC1 GOLXNESZZPUPJE-UHFFFAOYSA-N 0.000 description 2
- 238000004804 winding Methods 0.000 description 2
- RYGMFSIKBFXOCR-UHFFFAOYSA-N Copper Chemical compound [Cu] RYGMFSIKBFXOCR-UHFFFAOYSA-N 0.000 description 1
- RWSOTUBLDIXVET-UHFFFAOYSA-N Dihydrogen sulfide Chemical compound S RWSOTUBLDIXVET-UHFFFAOYSA-N 0.000 description 1
- 235000017899 Spathodea campanulata Nutrition 0.000 description 1
- 230000003466 anti-cipated effect Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000000903 blocking effect Effects 0.000 description 1
- 210000004556 brain Anatomy 0.000 description 1
- 230000001680 brushing effect Effects 0.000 description 1
- 229910002092 carbon dioxide Inorganic materials 0.000 description 1
- 239000001569 carbon dioxide Substances 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 238000004140 cleaning Methods 0.000 description 1
- 230000009194 climbing Effects 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 230000001276 controlling effect Effects 0.000 description 1
- 229910052802 copper Inorganic materials 0.000 description 1
- 239000010949 copper Substances 0.000 description 1
- 230000007423 decrease Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000004069 differentiation Effects 0.000 description 1
- 239000000428 dust Substances 0.000 description 1
- 230000005662 electromechanics Effects 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 238000003912 environmental pollution Methods 0.000 description 1
- 238000005530 etching Methods 0.000 description 1
- 230000005284 excitation Effects 0.000 description 1
- 239000002360 explosive Substances 0.000 description 1
- 229910000037 hydrogen sulfide Inorganic materials 0.000 description 1
- 230000001771 impaired effect Effects 0.000 description 1
- 239000012535 impurity Substances 0.000 description 1
- 230000002452 interceptive effect Effects 0.000 description 1
- 238000002372 labelling Methods 0.000 description 1
- 230000003902 lesion Effects 0.000 description 1
- 230000003137 locomotive effect Effects 0.000 description 1
- 230000007774 longterm Effects 0.000 description 1
- 238000005461 lubrication Methods 0.000 description 1
- 238000012423 maintenance Methods 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 239000003550 marker Substances 0.000 description 1
- 239000011159 matrix material Substances 0.000 description 1
- 230000005055 memory storage Effects 0.000 description 1
- 229910001172 neodymium magnet Inorganic materials 0.000 description 1
- 230000010349 pulsation Effects 0.000 description 1
- 230000001105 regulatory effect Effects 0.000 description 1
- 238000005096 rolling process Methods 0.000 description 1
- 238000005070 sampling Methods 0.000 description 1
- 230000011218 segmentation Effects 0.000 description 1
- 238000009987 spinning Methods 0.000 description 1
- 238000012876 topography Methods 0.000 description 1
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/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
- B25J5/00—Manipulators mounted on wheels or on carriages
- B25J5/005—Manipulators mounted on wheels or on carriages mounted on endless tracks or belts
-
- 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/1694—Programme controls characterised by use of sensors other than normal servo-feedback from position, speed or acceleration sensors, perception control, multi-sensor controlled systems, sensor fusion
-
- 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/1694—Programme controls characterised by use of sensors other than normal servo-feedback from position, speed or acceleration sensors, perception control, multi-sensor controlled systems, sensor fusion
- B25J9/1697—Vision controlled systems
-
- F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
- F16—ENGINEERING ELEMENTS AND UNITS; GENERAL MEASURES FOR PRODUCING AND MAINTAINING EFFECTIVE FUNCTIONING OF MACHINES OR INSTALLATIONS; THERMAL INSULATION IN GENERAL
- F16L—PIPES; JOINTS OR FITTINGS FOR PIPES; SUPPORTS FOR PIPES, CABLES OR PROTECTIVE TUBING; MEANS FOR THERMAL INSULATION IN GENERAL
- F16L55/00—Devices or appurtenances for use in, or in connection with, pipes or pipe systems
- F16L55/26—Pigs or moles, i.e. devices movable in a pipe or conduit with or without self-contained propulsion means
- F16L55/28—Constructional aspects
- F16L55/30—Constructional aspects of the propulsion means, e.g. towed by cables
- F16L55/32—Constructional aspects of the propulsion means, e.g. towed by cables being self-contained
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0246—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means
- G05D1/0248—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means in combination with a laser
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0259—Control of position or course in two dimensions specially adapted to land vehicles using magnetic or electromagnetic means
- G05D1/0263—Control of position or course in two dimensions specially adapted to land vehicles using magnetic or electromagnetic means using magnetic strips
-
- F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
- F16—ENGINEERING ELEMENTS AND UNITS; GENERAL MEASURES FOR PRODUCING AND MAINTAINING EFFECTIVE FUNCTIONING OF MACHINES OR INSTALLATIONS; THERMAL INSULATION IN GENERAL
- F16L—PIPES; JOINTS OR FITTINGS FOR PIPES; SUPPORTS FOR PIPES, CABLES OR PROTECTIVE TUBING; MEANS FOR THERMAL INSULATION IN GENERAL
- F16L2101/00—Uses or applications of pigs or moles
- F16L2101/30—Inspecting, measuring or testing
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Mechanical Engineering (AREA)
- Automation & Control Theory (AREA)
- Robotics (AREA)
- Chemical & Material Sciences (AREA)
- Electromagnetism (AREA)
- General Physics & Mathematics (AREA)
- Remote Sensing (AREA)
- Radar, Positioning & Navigation (AREA)
- Aviation & Aerospace Engineering (AREA)
- Combustion & Propulsion (AREA)
- General Engineering & Computer Science (AREA)
- Artificial Intelligence (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Multimedia (AREA)
- Optics & Photonics (AREA)
- Evolutionary Computation (AREA)
- Software Systems (AREA)
- Mathematical Physics (AREA)
- Fuzzy Systems (AREA)
- Manipulator (AREA)
Abstract
本发明公开了一种两核两轴履带式天然气管道机器人控制系统，所述的控制器采用双核控制器，包括ARM控制器和DSP处理器，所述的基于CCD图像采集单元和图像存储单元均与DSP处理器通讯连接，所述的湿度采集单元和基于霍尔效应管道探伤采集单元均与ARM控制器通讯连接。通过上述方式，本发明提高了能源的利用率和减少机器人体积，自主发明了基于ARM+DSP的全新双核控制模式，控制器以ARM控制器为处理器核心，DSP处理器实现图像采集数字信号的实时处理并与ARM控制器通讯，把ARM控制器从复杂的工作当中解脱出来，实现两轴三相永磁同步电机的实时控制，并响应DSP处理器中断，实现数据通信和存储实时信号。
Description
技术领域
本发明涉及大型管道机器人的领域，尤其涉及一种两核两轴履带式天然气管道机器人控制系统。
背景技术
天然气管道的输送介质属于易燃、易爆物质，介质中含有的硫化氢、二氧化碳、游离水、粉尘等杂质，使敷设的管道处于内外腐蚀条件，甚至有的时候内部会产生阻塞情况发生。再加上环境、地质、气象和水文灾害、管材及设计缺陷、操作失误乃至人为破坏等因素，管道的安全受到众多因素的威胁。
1989年6月4日，前苏联的一条输气管道发生泄漏，两列对开火车在距离泄漏点1 公里外的铁路线上通过时，火车磨擦产生火花引起了泄漏的天然气体爆炸，造成600多人死亡，数百公顷森林烧毁；2000年8月，美国新墨西哥州东南部一条720 mm口径的输气管道发生天然气爆炸，引起连天大火并至少造成 10人死亡，在30多公里以外的地方都可以看见巨型火球冲上天空，爆炸后地面留下一道长25m、深6m的大坑；我国的石油天然气管道亦曾多次发生事故，管道发生爆破、泄漏、停输等事故不仅造成巨大财产损失，而且也危害到生态环境。
管道机器人是一种可以沿着管道内部或者是外部自动行走，携带一种或多种传感器和操作机械，在操作人员的控制下或者是计算机自动控制下完成一系列管道作业的机电一体化系统。管道机器人的研究开始于上个世纪四十年代，到了70年代由于微电子技术、计算机技术、自动化技术的发展和进步，国外管道机器人技术于90年代初得到了迅猛发展，研制了许多实验样机，并取得了大量的研究成果。
用管道机器人巡检天然气管道，不仅可以提高管道检测的效率，而且对于改善劳动条件，减轻劳动强度，提高作业效率，降低作业成本，保障人身安全都有着十分重要的意义。但是国内还没有采用管道机器人巡检天然气管道，天然气管道爆炸时有发生，造成了巨大的经济损失和环境污染。
一个实用的天然气管道机器人必须具备以下几个部分：
1）图像采集系统：图像采集系统可以发现管道内已经出现的问题，并可以为工作人员提供管道受损和阻塞情况，为更换管道或者是清理管道提供可靠依据；
2）损伤采集系统：损伤采集系统可以及时发现管道系统外壁出现的异常情况，避免了管道而长期破损导致抗压能力减弱，最终导致天然气大量泄露而产生爆炸事故发生；
3）湿度探测和阻塞物探测：如果湿度过大，天然气管道的输送介质易于形成管道腐蚀，同时部分物质会堆积起来产生阻塞情况；
4）电机：执行电机是管道机器人的动力实施部件，它实时转化电源的能量，根据管道机器人微处理器的指令来执行机器人在天然气管道内的相关行走动作；
5）算法：算法是天然气管道机器人的灵魂，由于天然气管道是一个封闭的管道，内部情况非常复杂，天然气管道机器人必须采用一定的智能算法才能准确的从管道内一点到达另外一点，形成点对点的巡检，并实时存储采集图像、管道水汽信息、管道阻塞信息、管道受损情况和受损位置信息；
6）微处理器：微处理器是天然气管道机器人的核心部分，是天然气管道机器人的大脑，管道内所有的信息，包括管道内的湿度、阻塞情况、管道损伤信息以及损伤位置信息、电机状态信息、电池状态信息等都需要经过微处理器处理并做出相应的判断。
国内对管道机器人的研究只是刚刚起步，均是采用单核控制器，均处于实验室样机设计阶段，离大规模使用具有一定的距离，主要面临以下问题：
（1）受控制技术影响，所有的管道机器人均采用单核控制器，控制器的计算能力较弱，管道机器人无法快速处理实时环境，且机器人行走速度较低，巡查管道速度较慢，受外界干扰影响稳定性较差；
（2）对于采用电机驱动的管道机器人所携带的能源均采用可充电蓄电池，这些蓄电池均是通过简单的串联和并联后形成高压大电流能源系统，均没有保护电路，寿命较短，正常工作时经常出现异常甚至干扰到管道机器人的工作；
（3）对于采用步进电机或者是直流电机驱动的管道机器人来说，受电机自身效率的影响，能源利用率较低，导致机器人在管道内移动距离较短；
（4）对于采用步进电机或者是直流电机驱动的管道机器人来说，受电机功率密度的影响，由于所采用的电机体积均较大，最终导致机器人的体积较大，重量较重，严重影响了管道机器人的使用范围；
（5）管道机器人运动状态自我调整能力较差，受控制方式影响，机器人在管道内的姿态参数识别较差，机器人无法识别自我平面与管道主平面的夹角，导致机器人行走时出现倾斜，甚至有时会翻车，导致任务失败；
（6）对于有阻塞的天然气管道，普通的轮式机器人与地面接触面积较少，越障能力较弱，有的时候甚至无法越过障碍物，最终无法巡检完成任务。
永磁同步电动机的定子与普通电励磁同步电动机具有相同的定子结构，只是转子上以钕铁硼稀土永磁材料作为磁极取代了同步机的励磁磁极和励磁绕组，使电动机的结构较为简单，且省去了容易出故障的集电环和电刷，实现了无刷化，提高了电动机运行的可靠性。因为不需励磁电流，因此可以省去励磁绕组的铜耗，极大提高了电机的效率；稀土永磁材料的使用使得电机功率密度较高，所以电机的体积可以做得更小，适合体积要求比较高的场合。永磁同步电动机除了有明显的节能效果外，还具有转速准确、噪声低的特性，稀土永磁同步电机基于转子磁场定向或者是基于矢量控制系统能够实现高精度、高动态性能、大范围的调速或定位控制，这些特性使得稀土永磁同步电机特别适合使用于管道机器人这些要求比较特殊的机器人控制系统中。
履带式移动机构是轮式移动机构的拓展，履带本身起着给车轮连续铺路的作用。相对于轮式机构，履带式移动机构有着诸多优点，如：支承面积大，接地比压小；滚动阻力小，通过性能较好；越野机动性好；履带支承面上有履齿，不易打滑，牵引附着性能好，有利于发挥较大的牵引力；变位履带式移动机构通过改变履带的位置或履带的机构形式以达到适应不同环境的要求，两履带的夹角可以调节，以适应不同的作业管径。
发明内容
本发明主要解决的技术问题是提供一种两核两轴履带式天然气管道机器人控制系统，自主研发了基于ARM +DSP的全新双核控制模式，控制器以ARM控制器为处理器核心，DSP处理器实现图像采集数字信号的实时处理并与ARM控制器通讯，把ARM控制器从复杂的工作当中解脱出来，实现两轴三相永磁同步电机的实时控制，并响应DSP处理器中断，实现数据通信和存储实时信号。
为解决上述技术问题，本发明采用的一个技术方案是：提供了一种两核两轴履带式天然气管道机器人控制系统，包括电源装置、控制器、永磁同步电机X、永磁同步电机Y、基于CCD图像采集单元、图像存储单元、湿度采集单元、基于霍尔效应管道探伤采集单元以及管道机器人，所述的电源装置单独提供电流驱动所述的控制器，所述的控制器采用双核控制器，包括ARM控制器和DSP处理器，所述的ARM控制器和DSP处理器进行通讯连接，所述的ARM控制器分别发出第一控制信号和第二控制信号，由所述的第一控制信号和第二控制信号分别控制所述的永磁同步电机Y和永磁同步电机X的信号合成之后再控制管道机器人的运动，所述的基于CCD图像采集单元和图像存储单元均与DSP处理器通讯连接，所述的湿度采集单元和基于霍尔效应管道探伤采集单元均与ARM控制器通讯连接。
在本发明一个较佳实施例中，所述的电源装置采用锂离子电池。
在本发明一个较佳实施例中，所述的第一控制信号和第二控制信号均为PWM波控制信号。
在本发明一个较佳实施例中，所述的ARM控制器采用STM32F746；所述的DSP处理器采用TMS320F2812。
在本发明一个较佳实施例中，所述的管道机器人包括机器人壳体、激光位移传感器、磁导航传感器、距离修正传感器、三轴加速度计以及同步带，所述的激光位移传感器分别安装在机器人壳体的前端，所述的磁导航传感器和距离修正传感器均设置在机器人壳体上并位于激光位移传感器的下方，所述的同步带分别设置在机器人壳体的左右两侧边并分别与永磁同步电机X和永磁同步电机Y连接，所述的三轴加速度计设置在机器人壳体上并位于永磁同步电机X和永磁同步电机Y之间。
在本发明一个较佳实施例中，所述的激光位移传感器包括前方激光位移传感器、左激光位移传感器和右激光位移传感器，所述的前方激光位移传感器设置在机器人壳体正前方的中间位置，所述的左激光位移传感器和右激光位移传感器分别斜向设置在机器人壳体正前方的左右两端。
在本发明一个较佳实施例中，所述的同步带采用两轴六轮驱动模式，是由一根内周表面设有等间距齿的封闭环形履带和相应的带轮所组成。
在本发明一个较佳实施例中，所述的天然气管道机器人控制系统还设置有上位机程序、运动控制程序、基于DSP图像采集以及基于霍尔效应管道损伤探测，所述的上位机程序还包括管道读取、位置定位和电源信息，所述的运动控制程序还包括基于ARM两轴永磁同步电机伺服控制、数据存储和I/O控制，所述的基于DSP图像采集和基于霍尔效应管道损伤探测分别与基于CCD图像采集单元和基于霍尔效应管道探伤采集单元通讯连接。
在本发明一个较佳实施例中，所述的天然气管道机器人控制系统还包括光电编码器，所述的光电编码器分别安装在永磁同步电机X和永磁同步电机Y上。
本发明的有益效果是：本发明的两核两轴履带式天然气管道机器人控制系统，采用效率和功率密度均较高的永磁同步电机替代了步进电机、直流电机等电机，提高了能源的利用率和减少机器人体积，为了提高运算速度，保证自动管道机器人系统的稳定性和可靠性，本发明在基于ARM控制器中引入DSP处理器数字信号处理器，形成基于ARM+DSP的全新双核控制器，此控制器充分考虑电池在这个系统的作用，把控制系统中工作量最大的两轴永磁同步电机伺服系统、管道读取、电源信息交给ARM控制器处理，充分发挥ARM控制器数据处理速度相对较快的特点，而图像数据采集和存储等功能交给DSP处理器完成，这样就实现了ARM控制器与DSP处理器的分工，同时二者之间也可以进行通讯，实时进行数据交换和调用。
附图说明
为了更清楚地说明本发明实施例中的技术方案，下面将对实施例描述中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本发明的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其它的附图，其中：
图1 是本发明带有两核两轴履带式天然气管道机器人控制系统一较佳实施例的原理图；
图2是管道机器人二维结构示意图；
图3是图1的程序图；
图4是管道机器人巡检原理图。
具体实施方式
下面将对本发明实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅是本发明的一部分实施例，而不是全部的实施例。基于本发明中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其它实施例，都属于本发明保护的范围。
如图1所示，本发明实施例包括：
一种两核两轴履带式天然气管道机器人控制系统，包括电源装置、控制器、永磁同步电机X、永磁同步电机Y、基于CCD图像采集单元、图像存储单元、湿度采集单元、基于霍尔效应管道探伤采集单元以及管道机器人，所述的电源装置单独提供电流驱动所述的控制器，所述的控制器采用双核控制器，包括ARM控制器和DSP处理器，所述的ARM控制器和DSP处理器进行通讯连接，所述的ARM控制器分别发出第一控制信号和第二控制信号，由所述的第一控制信号和第二控制信号分别控制所述的永磁同步电机Y和永磁同步电机X的信号合成之后再控制管道机器人的运动，所述的基于CCD图像采集单元和图像存储单元均与DSP处理器通讯连接，所述的湿度采集单元和基于霍尔效应管道探伤采集单元均与ARM控制器通讯连接。其中，所述的电源装置采用锂离子电池；所述的第一控制信号和第二控制信号均为PWM波控制信号。
上述中，所述的ARM控制器采用STM32F746；所述的DSP处理器采用TMS320F2812。
STMicroelectronics
所生产的全新STM32F7 MCU系列产品，是全球第一个量产且拥有32位元ARM控制器 Cortex-M7处理器的微控制器。Cortex-M7是Cortex-M系列产品中最新推出且效能最高的处理器核心，全新STM32F7 MCU是ST的STM32 MCU系列产品中效能最高的一项产品，结合了Cortex-M7核心与高阶外围装置，可提升应用程序效能、新增新功能、延长电池寿命、确保安全以及尽可能减少使用外部元件以节省成本与空间等无可比拟的优点。
STM32F7系列产品包括STM32F745 及STM32F746，这两项产品都配备拥有浮点运算单位及DSP处理器扩充功能的Cortex-M7核心，运算速度最高 216MHz。STM32F7
MCU系列产品将ARM控制器
Cortex-M7效能超越早期核心(譬如Cortex-M4)的优势运用到极致，效能达到将近DSP处理器 两倍，使此 MCU 非常适合用于高速电机控制之应用。
TMS320F2812是基于代码兼容的C28x内核的新型高性能32位定点数字信号处理器，C28x内核的指令执行周期达到了6.67ns，最高运行频率可以达到150MHz，F2812集成有许多外设，提供了整套的片上系统，其片上外设主要包括2×8路12位ADC(最快80ns转换时间)，2路SCI，1路SPI，1路McBSP，1路eCAN接口等，并带有两个事件管理模块(EVA、EVB)。另外，该器件还有3个独立的32位CPU定时器，以及多达56个独立编程的GPIO引脚。F2812采用统一编址方式，芯片内部有18K的SARAM，包括MO、M1、L0、L1、H0共5个存储块，各存储块保持独立，可以在同一机器周期对不同的RAM块进行访问，从而减少流水线时延。而且F2812内部有128K字的FLASH，地址空间3D8000h-3F7FFFh，适用于低功耗、高性能的控制系统。此外F2812提供了外部存储器扩展接口(XINTF)，方便进行系统扩展，其寻址空间可以达到1MB；上述特点使得F2812在具备数字信号处理器卓越的数据处理能力的同时，又具有适于控制的片内外设及接口，可广泛应用于各种高性能的系统控制中，上述特点使得TMS320F2812特别适合巡检机器人的图形采集、图像存储和位置信息存储。
为了能够精确导引管道机器人进行自动检测， 本发明采用两套传感器导航模式（一套磁传感器导航，一套激光位移传感器导航），本发明的管道机器人二维结构如图2所示：所述的管道机器人包括机器人壳体K、激光位移传感器、磁导航传感器ME1、距离修正传感器S、三轴加速度计A1以及同步带T，所述的激光位移传感器分别安装在机器人壳体K的前端，所述的磁导航传感器ME1和距离修正传感器S均设置在机器人壳体K上并位于激光位移传感器的下方，所述的同步带T分别设置在机器人壳体K的左右两侧边并分别与永磁同步电机X和永磁同步电机Y连接，所述的三轴加速度计A1设置在机器人壳体K上并位于永磁同步电机X和永磁同步电机Y之间。其中，所述的激光位移传感器包括前方激光位移传感器LSF、左激光位移传感器LSL和右激光位移传感器LSR，所述的前方激光位移传感器LSF设置在机器人壳体K正前方的中间位置，所述的左激光位移传感器LSL和右激光位移传感器LSR分别斜向设置在机器人壳体K正前方的左右两端。
磁导航传感器ME1时刻检测管道中的磁条，并依此传感器为第一导航判据，当磁条不存在或导航偏离距离较大时，左激光位移传感器LSL和右激光位移传感器LSR共同作用判断前进方向与左右管壁的距离，并作为管道机器人直线运动提供导航依据，前方激光位移传感器LSF为管道机器人前进障碍物的判别提供依据以及停车做判据。
为了提高管道机器人在密闭管道过程中行走导航的稳定性，实现姿态的自动调整以及自主导航能力，本发明在天然气管道机器人伺服硬件系统中加入了三轴加速度计A1。在管道机器人行走管道期间全程开启三轴加速度计A1，三轴加速度计A1用来测量管道机器人三个前进方向的角加速度，控制器根据测得的角加速度通过连续积分得到其倾斜角度。当管道机器人的姿态发生变化超过设定阀值时，在一个新的采样周期控制器就立即对其位置补偿，避免管道机器人在行走过程中因为倾斜过大而翻到现象的发生，提高了其快速行走导航时的稳定性；如果对三轴加速度计A1进行连续积分，且把它变换到导航坐标系中，管道机器人在密闭管道中可以不依赖于任何外部信息就能够得到其在导航坐标系中的加速度、速度、偏航角和位置等信息，所产生的导航信息连续性好而且噪声非常低，极大增强了管道机器人的自主惯性导航能力。
同步带T传动是由一根内周表面设有等间距齿的封闭环形履带和相应的带轮所组成。运动时，带齿与带轮的齿槽相啮合传递运动和动力，是一种啮合传动，因而具有齿轮传动、链传动和平带传动的各种优点。同步带K传动具有准确的传动比，无滑差，可获得恒定的速比，可精密传动，传动平稳，能吸震，噪音小，传动效率高，不需润滑，无污染，特别适合在不允许有污染和工作环境较为恶劣的场合下正常工作，结构紧凑特别适用多轴传动，因此本发明采用同步带技术形成两轴六轮驱动模式。
本发明为了解决国内管道机器人存在的问题，研发了一种由两台稀土永磁同步电机差速驱动的六轮履带式双核天然气管道机器人，四个辅助轮通过同步带分别与左右驱动电机机械链接，左右侧的多个轮分别通过履带机械链接，然后天然气管道机器人依靠其携带传感器进行巡检大型天然气管道。
本发明在吸收国外先进控制思想的前提下，自主发明了基于ARM+DSP的全新双核控制模式。本次设计的控制器原理图如图1：控制器以ARM控制器为处理器核心，DSP处理器实现图像采集数字信号的实时处理并与ARM控制器通讯，把ARM控制器从复杂的工作当中解脱出来，实现两轴三相永磁同步电机的实时控制，并响应DSP处理器中断，实现数据通信和存储实时信号。
如图3所示，所述的两核两轴履带式天然气管道机器人控制系统还设置有上位机程序、运动控制程序、基于DSP图像采集以及基于霍尔效应管道损伤探测，所述的上位机程序还包括管道读取、位置定位和电源信息，所述的运动控制程序还包括基于ARM两轴永磁同步电机伺服控制、数据存储和I/O控制，所述的基于DSP图像采集和基于霍尔效应管道损伤探测分别与基于CCD图像采集单元和基于霍尔效应管道探伤采集单元通讯连接。
为达上述目的，本发明采取以下技术方案， 为了提高能源的利用率和减少机器人体积，本系统用效率和功率密度均较高的永磁同步电机替代了步进电机、直流电机等电机；为了提高运算速度，保证自动管道机器人系统的稳定性和可靠性，本发明在基于ARM控制器的控制器中引入数字信号处理器DSP处理器，形成基于ARM+DSP的全新双核控制器，此控制器充分考虑电池在这个系统的作用，把控制系统中工作量最大的两轴永磁同步电机伺服系统、管道读取、电源信息交给ARM控制器处理，充分发挥ARM控制器数据处理速度相对较快的特点，而图像数据采集和存储等功能交给DSP处理器完成，这样就实现了ARM控制器与DSP处理器的分工，同时二者之间也可以进行通讯，实时进行数据交换和调用。
如图4所示，对于本文设计的ARM+DSP双核控制器，在电源装置打开状态下，ARM控制器先对管道机器人电源装置SOC（荷电状态）进行判断，如果电池能源较低，控制器会发出报警信号；如果电池能源较高，先由PC机通过USB接口把巡检天然气管道长度和半径等信息输入给ARM控制器，然后管道机器人被放到管道检测口，机器人先进入自锁状态，等待入口阀门F1打开，当前方激光位移传感器LSF确定入口阀门F1打开后，管道机器人进入待检缓冲区域，然后入口阀门F1关闭，入口阀门F2打开，管道机器人进入管道检测区域；管道机器人携带的图像采集系统、湿度采集系统和管道损伤探测装置均开启，管道机器人按照设定速度沿着巡检路线快速巡检，ARM控制器按照磁导航传感器ME1参数二次调整管道机器人永磁同步电机X和永磁同步电机Y的PWM输出，实现两台永磁同步电机的实时伺服控制，DSP处理器通过CCD实时采集管道信息并存储，如果对巡检某一个位置有疑问，将与ARM控制器通讯，ARM控制器发出停车指令使管道机器人停车，然后通过DSP处理器二次图像采集和损伤探测装置对管道系统的状态进行判断。
参照图1，图2，图3和图4，其具体的功能实现如下：
1）管道机器人的电源装置打开后，ARM控制器会对电源装置SOC进行判断，如果电源装置SOC较低时，ARM控制器将禁止两台永磁同步电机工作，电机输入PWM波被封锁，同时报警传感器将工作并发出报警信号；如果电源装置SOC正常，管道机器人进入待工作状态，等待工作命令；
2）人工借助PC机把把管道长度、半径和管道地形图等信息通过USB接口传入到ARM控制器，由ARM控制器预先处理管道信息，然后人工引导管道机器人到管道检测的开始端，为了精确导航管道机器人在封闭管道中的行走，ARM控制器首先开启管道机器人基于三轴加速度计的惯性导航模式；
3）管道机器人ARM控制器开始通过磁导航传感器ME1读取地面导航磁条，然后磁导航传感器ME1的反馈值与实际设定中心值相比较，ARM控制器根据偏差的大小通过其内部三闭环伺服控制程序自动调整永磁同步电机X和永磁同步电机Y的PWM输出，使管道机器人沿着导航磁条慢速前进，同时前方激光位移传感器LSF将工作，ARM控制器实时检测管道机器人与前方入口阀门F1的距离D，然后在可靠停车范围内自动停车，原地自锁；
4）当前方激光位移传感器LSF检测到入口阀门F1打开时，管道机器人将开启自动巡航模式，控制器ARM控制器将实时记录管道机器人沿着磁条运动的距离，当控制器确定机器人完全进入待检区域后，入口阀门F1将再次关闭；天然气泄露装置检测到入口阀门F1完全关闭后，入口阀门F2将打开，此时前方激光位移传感器LSF将二次判断前方入口阀门F2的状态，确定前方阀门打开无误后，管道机器人开始进入巡检区域检测天然气管道内部实际情况；
5）管道机器人进入检测区域后，ARM控制器先根据磁导航传感器ME1的反馈，读取管道机器人实际的位置信息和三轴加速度计A1的数值，并与设定位置相比较，确定管道机器人偏离中心距离和倾斜的角度，ARM控制器再结合电机电流反馈、光电编码器反馈和三轴加速度计的反馈，根据其内部三闭环伺服控制程序得到两台永磁同步电机的PWM波控制信号，并通过驱动电路实时调整管道机器人姿态，使管道机器人稳定运行在磁条中心附近，ARM控制器并实时记录机器人已经运行的直线距离，距离修正传感器S时刻检测地面修正标志，一旦读取到修正装置，ARM控制器记录的位置距离信息要以修正标志的位置信息为准，消除机器人在行走时的所造成的位置误差；
6）如果管道机器人在正常运动过程中受到外界干扰或者是遇到磁条断裂，磁导航传感器ME1无法读取到地面磁条信息，此时左激光位移传感器LSL和右激光位移传感器LSR将开启工作，二者将测得的距离输入给ARM控制器，控制器与设定值相比较得到偏离中心的位置，ARM控制器再结合电机电流反馈、光电编码器反馈和三轴加速度计的反馈，根据其内部三闭环伺服控制程序得到两台永磁同步电机的PWM控制信号，并通过驱动电路实时调整管道机器人姿态，使管道机器人稳定运行在管道平面中心附近，ARM控制器并实时记录机器人已经运行的直线距离，距离修正传感器S时刻检测地面修正标志，一旦读取到修正装置，ARM控制器记录位置距离信息要以修正标志的位置信息为准，消除机器人行走时的位置误差；
7）在管道机器人运动过程中，图像采集系统中的CCD时刻开启，DSP处理器并实时存储CCD采集到的图像，DSP处理器把采集的图像与设定的标准管道信息进行比对，如果二者比对结果出现较大差距，为了防止误操作，DSP处理器立即发出二次中断请求，ARM控制器立即响应DSP处理器中断，并让管道机器人停车，DSP处理器控制CCD二次采集管道信息，DSP处理器二次存储该图像并与标准管道信息进行比对得到最新结果并存储，ARM控制器重新开启永磁同步电机X和永磁同步电机Y使机器人沿着管道导航标志继续前行；
8）在管道机器人运动过程中，湿度采集系统中的湿度传感器时刻开启，ARM控制器实时存储湿度传感器采集到的湿度信息，并与设定的标准管道湿度信息进行比对，如果二者比对结果出现较大差距，为了防止误操作，ARM控制器通过内部三闭环伺服控制程序主动调整两台永磁同步电机X和电机Y的PWM控制信号，降低管道机器人的速度使其慢速通过有疑问区域，同时ARM控制器立即向DSP处理器发出中断请求，DSP处理器立即响应ARM控制器中断，并加大CCD管道采集信息中液态水的比对，DSP处理器存储该区域的液态水疑似图像和实际位置信息，然后ARM控制器控制管道机器人继续前行，当通过疑似区域后，ARM控制器通过内部三闭环伺服控制程序主动调整两台永磁同步电机X和电机Y的PWM控制信号，恢复管道机器人的速度使其正常巡检管道；
9）在管道机器人运动过程中，前方激光位移传感器LSF时刻开启，ARM控制器实时处理前方位置信息，当在管道运行前方有异常物时，前方激光位移传感器LSF探测值将出现异常，ARM控制器会通过内部三闭环伺服控制程序主动调整两台永磁同步电机X和电机Y的PWM控制信号，降低管道机器人的速度使其慢速驶向障碍物，同时ARM控制器立即向DSP处理器发出中断请求，DSP处理器立即响应ARM控制器中断，并加大CCD管道采集信息中堵塞物的比对，DSP处理器存储该区域的堵塞疑似图像和实际位置信息，由于本次设计的管道机器人是多轮履带式结构，所以ARM控制器控制管道机器人可以通过越过障碍物并可继续前行，当通过疑似区域后，ARM控制器通过内部三闭环伺服控制程序主动调整两台永磁同步电机X和电机Y的PWM控制信号，恢复管道机器人的速度使其正常巡检管道；
10）在管道机器人运动过程中，基于霍尔效应的管道探伤传感器将工作，当管道运行前方探测值出现异常，ARM控制器会通过内部三闭环伺服控制程序主动调整两台永磁同步电机X和电机Y的PWM控制信号，降低管道机器人的速度使其慢速驶向管道损伤疑似区域，同时ARM控制器立即向DSP处理器发出中断请求，DSP处理器立即响应ARM控制器中断，并加大CCD管道采集信息中管道损伤的比对，如果DSP处理器发现疑似管道损伤图像将存储此图像，如果DSP处理器未发现管道损伤图像，将记录疑似损伤实际位置信息，并标记外部损伤。当通过疑似区域后，ARM控制器通过内部三闭环伺服控制程序主动调整两台永磁同步电机X和电机Y的PWM控制信号，恢复管道机器人的速度使其正常巡检管道；
11）在管道机器人运动过程中，ARM控制器会时刻储存所经过的管道所处的位置或者是经过的参考点，并根据这些距离信息由ARM控制器计算得到相对下一个参考点管道机器人永磁同步电机X和永磁同步电机Y分别要运行的距离、速度和加速度，ARM控制器再结合电机电流反馈、光电编码器反馈和地面磁条的反馈，根据其内部三闭环伺服控制程序得到两台永磁同步电机的PWM控制信号，使管道机器人按照设定速度快速前行；
12）在运动过程中如果管道机器人发现距离求解出现死循环将向ARM控制器发出中断请求，ARM控制器会对中断做第一时间响应，ARM控制器将禁止管道机器人在对距离信息修正，ARM控制器根据管道磁条导航标志反馈、左激光位移传感器LSL和右激光位移传感器LSR的反馈，实时调整永磁同步X电机和电机Y的速度，保证机器人向着出口缓慢驶出，并放弃一切采集工作；
13）装在永磁同步电机X和永磁同步电机Y上的光电编码器会输出其位置信号A和位置信号B，光电编码器的位置信号A脉冲和B脉冲逻辑状态每变化一次，ARM控制器内的位置寄存器会根据电机X和电机Y的运行方向加1或者是减1；光电编码器的位置信号A脉冲和B脉冲和Z脉冲同时为低电平时，就产生一个INDEX信号给ARM控制器内部寄存器，记录永磁同步电机的绝对位置，然后换算成管道机器人在管道检测系统中的具体位置；
14）管道机器人在运行过程ARM控制器根据其内部算法实时计算电源装置SOC，如果控制器发现电源能量较低时，ARM控制器会与DSP处理器通讯，并通过DSP处理器关闭CCD图像采集工作和图像存储工作，并通过其内部三闭环伺服控制系统程序调整永磁同步电机X和永磁同步电机Y的PWM输出，使管道机器人以较慢的速度驶向出口处，保证管道机器人能够顺利到出口处；
15）在管道机器人巡检过程中，如果伺服控制器检测到永磁同步电机的转矩出现脉动，由于本发明采用的永磁同步电机控制是基于矢量控制，因此控制器会很容易补偿此干扰，减少了电机转矩对巡检机器人运动过程的影响；
16）当管道机器人驶向出口阀门的过程中，其携带的前方激光位移传感器LSF会时刻检测其与阀门之间的位移，当确定出口阀门F3在打开状态，管道机器人将开启巡航模式，控制器ARM控制器实时记录管道机器人已经沿着磁条运动的距离，当确定管道机器人完全进入出口待检区域后，出口阀门F3将关闭，天然气抽吸装置将抽吸待检区域的天然气情况，当天然气泄露装置未检测到待检区域有天然气残留时，出口阀门F4将打开，此时前方激光位移传感器LSF将二次判断前方出口阀门F4的状态，确定前方出口阀门F4打开无误后，管道机器人驶出检测管道，回到检测终点，等待下一个检测命令。
本发明具有的有益效果是：
1：在管道机器人运动过程中，充分考虑了电池在这个系统中的作用，基于ARM+DSP双核控制器时刻都在对其状态进行监测和运算，既避免了由于大电流放电而引起的锂离子电池过度老化现象的发生，又可以有效预测电池的能量，为管道机器人巡检提供了有效保证；
2：由ARM控制器处理管道机器人两只永磁同步电机基于矢量控制的伺服控制，使得控制比较简单，大大提高了运算速度，解决了单片机软件运行较慢的瓶颈，缩短了开发周期短，并且程序可移植能力强；
3：本发明基本实现全贴片元器件材料，实现了单板控制，不仅节省了控制器占用空间，而且有利于管道机器人体积和重量的减轻；
4：本发明管道机器人采用永磁同步电机替代了传统机器人系统中常用的步进电机、直流电机、直流无刷电机，由于其体积较小，效率较高，使得管道机器人体积可以进一步缩小，能源利用率大大提高；
5：由于采用基于矢量控制的永磁同步电机，使得调速范围比较宽，调速比较平稳，即使在低速阶段电机的脉动转矩也非常小，有利于提高系统的动态性能；
6：由于本控制器采用DSP处理器处理图形采集和存储的大量数据与算法，把ARM控制器从繁重的工作量中解脱出来，有效地防止了程序的“跑飞”，抗干扰能力大大增强；
7：在控制中，ARM控制器可以根据机器人外围运行情况适时调整两轴永磁同步电机伺服控制的PID参数，实现分段P、PD、PID控制和非线性PID控制，使系统动态性能大大提高；
8：管道机器人上配备有湿度采集系统，可以轻易地检测出管道里的湿度异常区域，可有效查出管道水滴的存在；
9：管道机器人上配备有图像采集系统，可以轻易地检测出管道内部管道腐蚀等异常情况，并有效存储其图像；
10：基于DSP处理器的图像存储功能使得管道机器人完成任务后方便工作人员读取巡检结果，可以轻易的从存储结果中读取管道受损信息和具体位置，然后及时维修；
11：管道机器人上配备有基于霍尔效应的损伤探测采集系统，可以轻易地检测出管道外部管道腐蚀和损伤等异常情况，有利于及早发现问题管道。
12：三轴加速度计A1的加入可有效探测管道机器人偏离管道平面的倾斜角度，ARM控制器会时刻对此角度进行调整，有效控制了管道机器人的姿态；
13：磁导航传感器ME1和激光位移传感器的加入使得系统导航具有一定的冗余度，极大提高了管道机器人的稳定性；
14：同步带技术的加入使得六个轮都具有动力，同时履带的加入有效增加了管道机器人在管道中接触的面积，使机器人可以有效通过具有障碍阻塞物区域，提高了环境适应性。
综上诉述，本发明的两核两轴履带式天然气管道机器人控制系统，采用效率和功率密度均较高的永磁同步电机替代了步进电机、直流电机等电机，提高了能源的利用率和减少机器人体积，为了提高运算速度，保证自动管道机器人系统的稳定性和可靠性，本发明在基于ARM控制器中引入DSP处理器数字信号处理器，形成基于ARM+DSP的全新双核控制器，此控制器充分考虑电池在这个系统的作用，把控制系统中工作量最大的两轴永磁同步电机伺服系统、管道读取、电源信息交给ARM控制器处理，充分发挥ARM控制器数据处理速度相对较快的特点，而图像数据采集和存储等功能交给DSP处理器完成，这样就实现了ARM控制器与DSP处理器的分工，同时二者之间也可以进行通讯，实时进行数据交换和调用。
以上所述仅为本发明的实施例，并非因此限制本发明的专利范围，凡是利用本发明说明书内容所作的等效结构或等效流程变换，或直接或间接运用在其它相关的技术领域，均同理包括在本发明的专利保护范围内。
Claims (9)
1.一种两核两轴履带式天然气管道机器人控制系统，其特征在于，包括电源装置、控制器、永磁同步电机X、永磁同步电机Y、基于CCD图像采集单元、图像存储单元、湿度采集单元、基于霍尔效应管道探伤采集单元以及管道机器人，所述的电源装置单独提供电流驱动所述的控制器，所述的控制器采用双核控制器，包括ARM控制器和DSP处理器，所述的ARM控制器和DSP处理器进行通讯连接，所述的ARM控制器分别发出第一控制信号和第二控制信号，由所述的第一控制信号和第二控制信号分别控制所述的永磁同步电机Y和永磁同步电机X的信号合成之后再控制管道机器人的运动，所述的基于CCD图像采集单元和图像存储单元均与DSP处理器通讯连接，所述的湿度采集单元和基于霍尔效应管道探伤采集单元均与ARM控制器通讯连接。
2.根据权利要求1所述的天然气管道机器人控制系统，其特征在于，所述的电源装置采用锂离子电池。
3.根据权利要求1所述的天然气管道机器人控制系统，其特征在于，所述的第一控制信号和第二控制信号均为PWM波控制信号。
4.根据权利要求1所述的天然气管道机器人控制系统，其特征在于，所述的ARM控制器采用STM32F746；所述的DSP处理器采用TMS320F2812。
5.根据权利要求1所述的天然气管道机器人控制系统，其特征在于，所述的管道机器人包括机器人壳体、激光位移传感器、磁导航传感器、距离修正传感器、三轴加速度计以及同步带，所述的激光位移传感器分别安装在机器人壳体的前端，所述的磁导航传感器和距离修正传感器均设置在机器人壳体上并位于激光位移传感器的下方，所述的同步带分别设置在机器人壳体的左右两侧边并分别与永磁同步电机X和永磁同步电机Y连接，所述的三轴加速度计设置在机器人壳体上并位于永磁同步电机X和永磁同步电机Y之间。
6.根据权利要求5所述的天然气管道机器人控制系统，其特征在于，所述的激光位移传感器包括前方激光位移传感器、左激光位移传感器和右激光位移传感器，所述的前方激光位移传感器设置在机器人壳体正前方的中间位置，所述的左激光位移传感器和右激光位移传感器分别斜向设置在机器人壳体正前方的左右两端。
7.根据权利要求5所述的天然气管道机器人控制系统，其特征在于，所述的同步带采用两轴六轮驱动模式，是由一根内周表面设有等间距齿的封闭环形履带和相应的带轮所组成。
8.根据权利要求1所述的天然气管道机器人控制系统，其特征在于，所述的天然气管道机器人控制系统还设置有上位机程序、运动控制程序、基于DSP图像采集以及基于霍尔效应管道损伤探测，所述的上位机程序还包括管道读取、位置定位和电源信息，所述的运动控制程序还包括基于ARM两轴永磁同步电机伺服控制、数据存储和I/O控制，所述的基于DSP图像采集和基于霍尔效应管道损伤探测分别与基于CCD图像采集单元和基于霍尔效应管道探伤采集单元通讯连接。
9.根据权利要求1所述的天然气管道机器人控制系统，其特征在于，所述的天然气管道机器人控制系统还包括光电编码器，所述的光电编码器分别安装在永磁同步电机X和永磁同步电机Y上。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201610400344.0A CN105922260B (zh) | 2016-06-08 | 2016-06-08 | 一种两核两轴履带式天然气管道机器人控制系统 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201610400344.0A CN105922260B (zh) | 2016-06-08 | 2016-06-08 | 一种两核两轴履带式天然气管道机器人控制系统 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN105922260A true CN105922260A (zh) | 2016-09-07 |
| CN105922260B CN105922260B (zh) | 2018-04-27 |
Family
ID=56832803
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201610400344.0A Active CN105922260B (zh) | 2016-06-08 | 2016-06-08 | 一种两核两轴履带式天然气管道机器人控制系统 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN105922260B (zh) |
Cited By (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN106627894A (zh) * | 2016-12-15 | 2017-05-10 | 广州中国科学院先进技术研究所 | 一种纵向两轮自平衡机器人及控制系统 |
| CN110500470A (zh) * | 2019-09-09 | 2019-11-26 | 浙江工业大学之江学院 | 一种具有相对位置导航功能的管道爬行机器人 |
Citations (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN101887037A (zh) * | 2010-04-27 | 2010-11-17 | 丹东奥龙射线仪器有限公司 | 轮式x射线探伤机器人装置 |
| US20150105907A1 (en) * | 2013-10-10 | 2015-04-16 | Seiko Epson Corporation | Robot controller, robot system, robot, robot control method, and program |
| CN105159325A (zh) * | 2015-08-24 | 2015-12-16 | 铜陵学院 | 一种基于stm32f407和fpga两轮高速灭火机器人伺服控制器 |
| CN105169610A (zh) * | 2015-08-24 | 2015-12-23 | 铜陵学院 | 基于两轮高速全自动灭火机器人的双核伺服控制系统 |
| CN205281258U (zh) * | 2015-12-31 | 2016-06-01 | 浙江同筑科技有限公司 | 基于arm的agv双层控制系统 |
-
2016
- 2016-06-08 CN CN201610400344.0A patent/CN105922260B/zh active Active
Patent Citations (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN101887037A (zh) * | 2010-04-27 | 2010-11-17 | 丹东奥龙射线仪器有限公司 | 轮式x射线探伤机器人装置 |
| US20150105907A1 (en) * | 2013-10-10 | 2015-04-16 | Seiko Epson Corporation | Robot controller, robot system, robot, robot control method, and program |
| CN105159325A (zh) * | 2015-08-24 | 2015-12-16 | 铜陵学院 | 一种基于stm32f407和fpga两轮高速灭火机器人伺服控制器 |
| CN105169610A (zh) * | 2015-08-24 | 2015-12-23 | 铜陵学院 | 基于两轮高速全自动灭火机器人的双核伺服控制系统 |
| CN205281258U (zh) * | 2015-12-31 | 2016-06-01 | 浙江同筑科技有限公司 | 基于arm的agv双层控制系统 |
Cited By (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN106627894A (zh) * | 2016-12-15 | 2017-05-10 | 广州中国科学院先进技术研究所 | 一种纵向两轮自平衡机器人及控制系统 |
| CN110500470A (zh) * | 2019-09-09 | 2019-11-26 | 浙江工业大学之江学院 | 一种具有相对位置导航功能的管道爬行机器人 |
| CN110500470B (zh) * | 2019-09-09 | 2023-12-26 | 浙江工业大学之江学院 | 一种具有相对位置导航功能的管道爬行机器人 |
Also Published As
| Publication number | Publication date |
|---|---|
| CN105922260B (zh) | 2018-04-27 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN105856234B (zh) | 一种三核两轴履带式高速天然气管道机器人控制系统 | |
| CN105856235B (zh) | 一种无线传输两核六轴履带式天然气管道机器人控制系统 | |
| CN105881537B (zh) | 一种三核四轴履带式高速天然气管道机器人控制系统 | |
| CN105856237A (zh) | 无线传输三核四轴履带式高速天然气管道机器人控制系统 | |
| CN106078734A (zh) | 一种无线传输两核四轴履带式天然气管道机器人控制系统 | |
| CN105045288A (zh) | 一种单轮全自动中速灭火机器人伺服控制系统 | |
| CN105922260B (zh) | 一种两核两轴履带式天然气管道机器人控制系统 | |
| CN106094617A (zh) | 无线传输三核八轴履带式高速天然气管道机器人控制系统 | |
| CN111564881A (zh) | 一种高压输电线路巡检机器人智能充电装置及控制方法 | |
| CN105856236A (zh) | 无线传输四核四轴履带式快速天然气管道机器人控制系统 | |
| CN105922263A (zh) | 一种两核六轴履带式天然气管道机器人控制系统 | |
| CN105856238B (zh) | 四核六轴无线传输履带式快速天然气管道机器人控制系统 | |
| CN105945951A (zh) | 一种三核八轴履带式快速天然气管道机器人控制系统 | |
| CN105856239B (zh) | 一种三核八轴履带式高速天然气管道机器人控制系统 | |
| CN201307245Y (zh) | 割草机器人导航系统 | |
| CN106078735A (zh) | 一种三核六轴履带式高速天然气管道机器人控制系统 | |
| CN105953026A (zh) | 一种三核两轴履带式快速天然气管道机器人控制系统 | |
| CN106003058B (zh) | 一种两核四轴履带式天然气管道机器人控制系统 | |
| CN106078737A (zh) | 无线传输四核十轴履带式快速天然气管道机器人控制系统 | |
| CN105881539B (zh) | 一种两核八轴无线传输履带式天然气管道机器人控制系统 | |
| CN105922259A (zh) | 一种三核四轴履带式快速天然气管道机器人控制系统 | |
| CN105881538A (zh) | 一种三核六轴履带式快速天然气管道机器人控制系统 | |
| CN105911916A (zh) | 无线传输三核六轴履带式高速天然气管道机器人控制系统 | |
| CN105320147A (zh) | 一种单轮双核中低速灭火机器人伺服控制系统 | |
| CN106078736A (zh) | 一种无线传输两核十轴履带式天然气管道机器人控制系统 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| C06 | Publication | ||
| PB01 | Publication | ||
| C10 | Entry into substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| GR01 | Patent grant | ||
| GR01 | Patent grant |