首页 / 国际专利分类库 / 作业;运输 / 无轨陆用车辆 / 一种多环境适应探测机器人及其进行铁路检修的方法

一种多环境适应探测机器人及其进行路检修的方法

申请号 CN201710424412.1 申请日 2017-06-07 公开(公告)号 CN107247455A 公开(公告)日 2017-10-13
申请人 金华市兴飞机器人有限公司; 发明人 张坛;
摘要 本 发明 涉及一种多环境适应探测 机器人 。一种多环境适应探测机器人及其进行 铁 路环境检修的方法,包括底盘、装置仓盒、固定轮组、万向轮组、同步轨轮组,底盘上设置装置仓盒,装置仓盒内设置锂 电池 组 和 控制器 组,底盘两侧,装置仓盒底部设置固定轮组和万向轮组,同步轨轮组设置在装置仓盒的内传动仓内或夹在固定轮组和万向轮组之间;四个固定轮组分别安置在底盘前驱动处和后驱动处,包括四只 驱动轮 ,驱动轮左右两侧的同轴处个设置一只共两对;底盘还设置有万向轮分别安置在底盘的前驱动处的中间,驱动轮上还设置活动窄轨轮套,活动窄轨轮套和活动窄轨轮相互铰接,所述活动窄轨轮包括运动支链 水 平关节轮、垂直同步轮、立式轮、三种各轮各自独立。
权利要求

1.一种多环境适应探测机器人,其特征是:包括底盘(1)、装置仓盒(2)、固定轮组(3)、万向轮组(4)、同步轨轮组(5),底盘上设置装置仓盒,装置仓盒内设置锂电池组(6)和控制器组(7),底盘两侧,装置仓盒底部设置固定轮组和万向轮组,同步轨轮组设置在装置仓盒的内传动仓(8)内或夹在固定轮组和万向轮组之间;
所述仓盒顶端设置有支撑柱(9),支撑柱头端设置摇摆头(10),摇摆头的两端设置摄像传感头(11),所述摇摆头外套还合有L形加具板(12);
所述摇摆头包括外壳(13),外壳底部设置平面转动轴(14),转动轴内套设平面转动轴承(15),平面转动轴承套合在平面转动电机的机轴(16)上,平面转动轴由平面转动电机驱动;所述摇摆头横向设置上下扳动轴(17),上下扳动轴左右各设置1只摄像传感头,所述上下扳动轴包括横联杆(18);
四个固定轮组分别安置在底盘前驱动处(19)和后驱动处(20),包括四只驱动轮(201),驱动轮左右两侧的同轴处个设置一只共两对;
底盘还设置有万向轮(21)分别安置在底盘的前驱动处的中间,所述万向轮包括转动片(22),转动节(23)、万向转动轮(24),转动片中心设置转动节,绕转动节上下设置万向转动轮,转动节包括转向轴承(25)和转向轴杆(26),转向轴杆固定在转向齿轮盘(27)上;
所述驱动轮包括独立驱动组(28)、驱动轴组(29),轮连接轴接(30)、主动轮(31),所述主动轮中轴处的主动轮圆轴(32)处设置螺丝套接轴承(33),套接轴承内插接扣连接轮(34)连接轮连接轴,轮连接轴接内套合锁接驱动轴组,驱动轴组齿合设置在独立驱动组的动输出轴上;驱动轮上还设置活动窄轨轮套(35),活动窄轨轮套和活动窄轨轮相互铰接,所述活动窄轨轮包括运动支链平关节轮(36)、垂直同步轮(37)、立式轮(38)、三种各轮各自独立,组成圆形,其中垂直同步轮上设置有车桨(39),立式轮和运动支链水平关节轮之间连接有铰接杆(101);
三者相交的轴心点处设置有转动驱动装置(40)、执行器电机托架(41)、执行器电机(42),所述旋转杆组(43)固定在执行器电机上,旋转杆组上连接电机托架,执行器电机安装在执行器电机托架上,所述垂直同步轮包括与执行器电机外壳固定连接的同步轮支架(44)所述同步轮支架上固定连接有推扩连轴件(45),所述旋转杆组被活动窄轨轮(46)套合顺同步轮支架的移槽(47)移动,所述同步轮通过同步带与执行器电机连接。
2.根据权利要求1所述的一种多环境适应探测机器人,其特征是:
所述运动支链水平关节轮、垂直同步轮、立式轮三个轮子的安装中心在水平平面上位于同一圆周,所述的两个驱动轮均是独立的采用带有霍尔效应传感器的轮毅式直流无刷电机作为驱动电机的驱动轮;控制器是采用工作于双极模式下的全桥PWMDC/DC变换器来驱动直流无刷电机的控制器。
3.根据权利要求1所述的一种多环境适应探测机器人,其特征是:
所述装置仓盒尾端设置扩展线口(48),扩展线口设置扩展连线(49),扩展连线牵引连接弹簧测量轮(50)。
4.一种利用多环境适应探测机器人进行路环境检修的方法:
实施方法:步骤1:在驱动轮外套合螺接上活动窄轨轮套,利用活动窄轨轮套和活动窄轨轮进行连接,将支链水平关节轮上的扩展口中插入扳动扩展轴,扳动扩展轴的末端和同齿离合轮相套合连接,同齿离合轮上设置皮带,皮带连接到垂直同步轮的内扳动杆上(结构与张紧轮类似),利用张紧轮结构,活动窄轨轮的大小会进行扩大和缩小;
步骤2:将本机器人放置在铁轨的旁侧的砂石道床上,启动机器人,驱动轮开始运作,固定轮组的控制器组包括硬件部分和软件部分,其中硬件部分由信号采集/处理电路和驱动电路两部分构成,软件部分包括信号采集与处理程序、驱动控制程序、过流保护程序、CAN通信程序和差速控制程序;
所述控制器组的控制器的硬件部分中的信号采集/处理电路由霍尔位置信号采集/处理电路和霍尔电流信号采集/处理电路两部分构成;
控制器组的的驱动控制程序的流程是:电池信号采集-电池完好-电池供电-电机获得电供应-电机前端的驱动轴工作开始,驱动轮上的轮履高低探测器启动-启动前驱动A轮或前驱动B轮,或前驱动A轮和前驱动B轮-机器人前进开始;
步骤2:将本机器人放置在铁轨的旁侧的砂石道床上,启动机器人,驱动轮开始运作,固定轮组的控制器组包括硬件部分和软件部分,其中硬件部分由信号采集/处理电路和驱动电路两部分构成,软件部分包括信号采集与处理程序、驱动控制程序、过流保护程序、CAN通信程序和差速控制程序;
所述控制器组的控制器的硬件部分中的信号采集/处理电路由霍尔位置信号采集/处理电路和霍尔电流信号采集/处理电路两部分构成;
所述霍尔位置信号采集/处理电路包括三个高频的电阻R22, R72和R73,三个低频的电阻R9, R10和R11,及匹配数量设置的0.001uf电容C5, C6和C7,电阻R22的一端接++5V,电阻R22的另一端接电阻R9,并接出信号线HALLla,电阻R9的另一端接电容C5,并接出信号先HALLlain,电容C5的另一端接地,电阻R72的一端接++5V,电阻R72的另一端接电阻R10,并接出信号线HALLlb,电阻R10的另一端接电容C6,并接出信号先HALLlbin,电容C6的另一端接地,电阻R73的一端接++5V,电阻R73的另一端接电阻R11,并接出信号线HALLlc,电阻R11的另一端接电容C7,并接出信号先HALLlcin,电容C7的另一端接地,其中,HALLain,HALLbin,HALLcin为电机的霍尔位置信号线,HALLa,HALLb,HALLc接DSP的捕捉引脚;霍尔电流信号采集/处理电路包括四个ACS712电流传感器U11, U12, U13和U14,四个100pf的电容C49, C50, C51和C52,四个5. 1K的电阻R32, R62, R65和R67,四个lnf的电容C53, C54, C55和C56,及四个高频的电阻R68, R69, R70和R71, U11的1和U11的2引脚短接接工RA+, U 11的
3和U11的4引脚短接接工RA-, U 11的5引脚接地,U11的6引脚接电容C53,电容C53的另一端接地,U11的7引脚接电阻R32,电阻R32的另一端接电阻R68,并接出工RAout,电阻R68的另一端接地,U11的8引脚接电容C49并接++5V,电容C49的另一端接地,U12的1和U12的2引脚短接接RB+, U 12的3和U12的4引脚短接接RB-, U 12的5引脚接地,U12的6引脚接电容C54,电容C54的另一端接地,U12的7引脚接电阻R62,电阻R62的另一端接电阻R69,并接出RBout,电阻R69的另一端接地,U12的8引脚接电容C50并接++5V,电容C50的另一端接地,U13的1和U13的
2引脚短接接工LA+, U 13的3和U13的4引脚短接接工LA-, U 13的5引脚接地,U13的6引脚接电容C55,电容C55的另一端接地,U13的7引脚接电阻R65,电阻R65的另一端接电阻R70,并接出工LAout,电阻R70的另一端接地,U13的8引脚接电容C51并接++5V,电容C51的另一端接地,U14的1和U14的2引脚短接接工LB+,U14的3和U14的4引脚短接接工LB-,U14的5引脚接地,U14的6引脚接电容C56,电容C56的另一端接地,U14的7引脚接电阻867,电阻867的另一端接电阻871,并接出工LBout,电阻871的另一端接地,U14的8引脚接电容C52并接++5V,电容C52的另一端接地;
所述控制器组的驱动电路为直流无刷电机的驱动电路,由MOSFET构成的三相全桥逆变电路组成,包括一片轮履高低探测器82136,一个0. luf的电容C22,二个高频电阻826,827,一个5. 1电阻835,三个FR107的二极管D2,D3,D4,三个luf的电解电容C28,C29,C30,二个
100uf的电解电容C34,C35,六个MOSFET管Q1,Q2,Q3,Q4,Q5,Q6,若干个220V电阻R37,R38,R39,R40,R42,R45,六个200K电阻850,851,852,853, 855, 857,一个三针的端口CON1,轮履高低探测器82136的1引脚接++12V,轮履高低探测器82136的9引脚接地,轮履高低探测器
82136的10引脚接电阻827,电阻827的另一端接电容C22并同时接++12V,轮履高低探测器
82136的11引脚接电阻826,电阻826的另一端接电容C22并同时接+12V,电容C22的另一端接地,轮履高低探测器82136的12和轮履高低探测器82136的13引脚短接接地,轮履高低探测器82136的14引脚接电阻845,电阻845的另一端接MOSFET管Q6的G极,并接电阻857,电阻857的另一端接MOSFET管Q6的S极,并接地,轮履高低探测器82136的15引脚接电阻842,电阻842的另一端接MOSFET管Q5的G极,并接电阻855,电阻855的另一端;
接MOSFET管Q5的S极,并接地,轮履高低探测器82136的16引脚接电阻840,电阻840的另一端接MOSFET管Q4的G极,并接电阻853,电阻853的另一端接MOSFET管Q4的S极,并接地,轮履高低探测器82136的18引脚接电解电容C30的一极,并与MOSFET管Q6的D极相接,接端口CON1的3号位置,电解电容C30的+极接二极管D4,二极管D4的另一端接电阻835,轮履高低探测器82136的19引脚接电阻839,电阻839的另一端接MOSFET管Q3的G极,并接电阻852,电阻
852的另一端接MOSFET管Q5的S极,并接端口CON1的3号位置,轮履高低探测器82136的22引脚接电解电容C29的一极,并与MOSFET管Q5的D极接,接出RB+,RB一接端口CON1的2号位置,电解电容C29的+极接二极管D3,二极管D3的另一端接电阻835,23引脚接
电阻838,电阻838的另一端接MOSFET管Q2的G极,并接电阻851,电阻851的另一端接MOSFET管Q2的S极,并接RB+,26引脚接电解电容C28的一极,并与MOSFET管Q4的D极接,接出工RA+,工RA一接端口CON1的1号位置,电解电容C28的+极接二极管D2,二极管D2的另一端接电阻835,27引脚接电阻837,电阻837的另一端接MOSFET管Q1的G极,并接电阻850,电阻850的另一端接MOSFET管Q1的S极,并接工 RA+,28引脚接电解电容C28+极,
电阻835的另一端接++12V,MOSFET管Q1,Q2,Q3的D极接B+,并接电解电容C34的+极,电解电容C34的一极接电解电容C35的+极,电解电容C35的一极接地;
控制器组的的驱动控制程序的流程是:电池信号采集-电池完好-电池供电-电机获得电供应-电机前端的驱动轴工作开始,驱动轮上的轮履高低探测器启动-启动前驱动A轮或前驱动B轮,或前驱动A轮和前驱动B轮-机器人前进开始;
步骤3:前进过程处理,遇到右坑,前驱动B轮停止运行,后轮组全部停止运行,万向轮调节为3点和7点位置,启动前驱动A轮,整车会随前驱动A轮向左转向,将机器人从右坑中拉出;遇到左坑,前驱动B轮停止运行,后轮组全部停止运行,万向轮调节为3点和7点位置,启动前驱动A轮,整车会随前驱动A轮向右转向,将机器人从右坑中拉出;中间高两边底地形处理,支链水平关节轮上的扩展口中插入扳动扩展轴开始运行,前驱动A轮和前驱动B轮停止运行,万向转轮开始运行,万向转轮的,两个轮体转动道12点和6点位置,活动窄轨轮开始运行,驱动电机带动张紧皮带上的垂直同步轮的内扳动杆,将张紧皮带的长度放开,张紧皮带的长度边长,在变长的同时,垂直同步轮、立式轮开始呈八字形张开,原本活动窄轨轮的大小小于或等于驱动轮的大小变得扩大,这时候再启动固定轮组,带动活动窄轨轮进行转动,活动窄轨轮会利用自身的轮道和轮道边沿的拨桨拨动砂石进入坑道内,同时中间的万向轮也会进行前进移动,一旦拨动的砂石能够进行垫住住驱动轮的移动了,机器人就会从两个同时坑道的路中移动出来了;
步骤4,信息采集摄像头启动,进行录像,录像经过自身插取得CDMS卡进行网络传输给控制中心,机器人的装置仓盒后尾还设置有弹簧测量轮,绕弹簧测量轮设置感应器,弹簧测量轮拖安装在机器人的车尾,在启动中先由检测人员手动卡扣入铁轨,随机器人前进,在铁轨的工字结构中进行滚动前进;弹簧测量轮上设置有永磁铁,永磁铁片的间隔道中设置有弹性传感器,弹性传感器记录震动数据,将震动数据传递给数据中间,传递的震动幅度数据波动越小,说明铁轨越正常,没有变形,如果震动幅度数据波动越大,说明铁轨已经变形,需要进行维护。
5.根据权利要求3所述的一种利用多环境适应探测机器人进行铁路环境检修的方法:
其特征是:所述弹簧测量轮感应器的信号采集/处理程序的流程是:弹性感应器定制的标准数据溢出触发A/D电信号转换一》A/D中断标志位发出1个Adflag = 1信号一》电流值信号发出,控制器记录一个波动信号,A/D转换操作一》将A/D转换结果存入变量中一送发给电流调节器一》霍尔位置信号检测一》换相程序一》记录周期计数器time_ cnt+1一Time_ cnt}
200,一》(记录完成)否一》速度更新标志=1;一》(记录完成)是一》慢周期标志位flag_san = 
1一》里程更新标志=1,一》(记录里程距离)是一》结束;一》否一》进度更新程序一》退回一》倒车复检。

说明书全文

一种多环境适应探测机器人及其进行路检修的方法

技术领域

[0001] 本发明涉及自动化机器人领域,具体的是一种多环境适应探测机器人。

背景技术

[0002] 探测机器人技术是机器人技术中的一个重要分支,他装备有多个侦查装置和系统,应用于测量、探测、救援、侦查等多个领域,上天、平地、入海、下河也都有它的身影,它的研究始于二十世纪六十年代,其主要目标是研究应用人工智能技术,在复杂环境下系统地自主推理、规划和控制。自主式移动机器人是具有高度的自规划、自组织和自适应能,适合于在复杂的环境中工作的一种智能机器人,具有模型不确定性、系统的高度非线性和控制的复杂性,机器人的运动机构则是机器人移动平台的一个重要组成部分,它直接影响到机器人运动的稳定性、灵活性和可操作性。因此,合理选择和设计机器人的运动机构是移动机器人设计的一个重要方面,运动能力越强那么他能活动的范围和适应的地形就越大,这样的探测机器人一直是我们的研究方向。

发明内容

[0003] 本发明的目的是提供一种多环境适应探测机器人他拥有抗震的轮式活动底盘,同时还有适应轨道高速运动的活动窄轨轮,同时活动窄轨轮上设计有拨桨,主要用于铁路路基砂石过多的情况,能利用拨桨扒砂石进行有效的前进,还能利其使本机器人拥有一定的坑活动能力,特别适应铁路轨道的探测和利用,帮助人们检修铁路,减轻铁路工人的负担。
[0004] 本发明是通过下述技术方案实现的:一种多环境适应探测机器人,包括底盘(1)、装置仓盒(2)、固定轮组(3)、万向轮组(4)、同步轨轮组(5),底盘上设置装置仓盒,装置仓盒内设置锂电池组(6)和控制器组(7),底盘两侧,装置仓盒底部设置固定轮组和万向轮组,同步轨轮组设置在装置仓盒的内传动仓(8)内或夹在固定轮组和万向轮组之间;所述仓盒顶端设置有支撑柱(9),支撑柱头端设置摇摆头(10),摇摆头的两端设置摄像传感头(11),所述摇摆头外套还合有L形加具板(12);
所述摇摆头包括外壳(13),外壳底部设置平面转动轴(14),转动轴内套设平面转动轴承(15),平面转动轴承套合在平面转动电机的机轴(16)上,平面转动轴由平面转动电机驱动;所述摇摆头横向设置上下扳动轴(17),上下扳动轴左右各设置1只摄像传感头,所述上下扳动轴包括横联杆(18);
四个固定轮组分别安置在底盘前驱动处(19)和后驱动处(20),包括四只驱动轮(201),驱动轮左右两侧的同轴处个设置一只共两对;
底盘还设置有万向轮(21)分别安置在底盘的前驱动处的中间,所述万向轮包括转动片(22),转动节(23)、万向转动轮(24),转动片中心设置转动节,绕转动节上下设置万向转动轮,转动节包括转向轴承(25)和转向轴杆(26),转向轴杆固定在转向齿轮盘(27)上;
所述驱动轮包括独立驱动组(28)、驱动轴组(29),轮连接轴接(30)、主动轮(31),所述主动轮中轴处的主动轮圆轴(32)处设置螺丝套接轴承(33),套接轴承内插接扣连接轮(34)连接轮连接轴,轮连接轴接内套合锁接驱动轴组,驱动轴组齿合设置在独立驱动组的动力输出轴上;驱动轮上还设置活动窄轨轮套(35),活动窄轨轮套和活动窄轨轮相互铰接,所述活动窄轨轮包括运动支链水平关节轮(36)、垂直同步轮(37)、立式轮(38)、三种各轮各自独立,组成圆形,其中垂直同步轮上设置有车桨(39),立式轮和运动支链水平关节轮之间连接有铰接杆(101);
三者相交的轴心点处设置有转动驱动装置(40)、执行器电机托架(41)、执行器电机(42),所述旋转杆组(43)固定在执行器电机上,旋转杆组上连接电机托架,执行器电机安装在执行器电机托架上,所述垂直同步轮包括与执行器电机外壳固定连接的同步轮支架(44)所述同步轮支架上固定连接有推扩连轴件(45),所述旋转杆组被活动窄轨轮(46)套合顺同步轮支架的移槽(47)移动,所述同步轮通过同步带与执行器电机连接。
[0005] 作为优选所述运动支链水平关节轮、垂直同步轮、立式轮三个轮子的安装中心在水平平面上位于同一圆周,所述的两个驱动轮均是独立的采用带有霍尔效应传感器的轮毅式直流无刷电机作为驱动电机的驱动轮;控制器是采用工作于双极模式下的全桥PWMDC/DC变换器来驱动直流无刷电机的控制器;作为优选所述装置仓盒尾端设置扩展线口,扩展线口设置扩展连线,扩展连线牵引连接弹簧测量轮。
[0006] 一种利用多环境适应探测机器人进行铁路环境检修的方法:步骤1:在驱动轮外套合螺接上活动窄轨轮套,利用活动窄轨轮套和活动窄轨轮进行连接,将支链水平关节轮上的扩展口中插入扳动扩展轴,扳动扩展轴的末端和同齿离合轮相套合连接,同齿离合轮上设置皮带,皮带连接到垂直同步轮的内扳动杆上(结构与张紧轮类似),利用张紧轮结构,活动窄轨轮的大小会进行扩大和缩小;步骤2:将本机器人放置在铁轨的旁侧的砂石道床上,启动机器人,驱动轮开始运作,固定轮组的控制器组包括硬件部分和软件部分,其中硬件部分由信号采集/处理电路和驱动电路两部分构成,软件部分包括信号采集与处理程序、驱动控制程序、过流保护程序、CAN通信程序和差速控制程序;
所述控制器组的控制器的硬件部分中的信号采集/处理电路由霍尔位置信号采集/处理电路和霍尔电流信号采集/处理电路两部分构成;
所述霍尔位置信号采集/处理电路包括三个高频的电阻R22, R72和R73,三个低频的电阻R9, R10和R11,及匹配数量设置的0.001uf电容C5, C6和C7,电阻R22的一端接++5V,电阻R22的另一端接电阻R9,并接出信号线HALLla,电阻R9的另一端接电容C5,并接出信号先HALLlain,电容C5的另一端接地,电阻R72的一端接++5V,电阻R72的另一端接电阻R10,并接出信号线HALLlb,电阻R10的另一端接电容C6,并接出信号先HALLlbin,电容C6的另一端接地,电阻R73的一端接++5V,电阻R73的另一端接电阻R11,并接出信号线HALLlc,电阻R11的另一端接电容C7,并接出信号先HALLlcin,电容C7的另一端接地,其中,HALLain,HALLbin,HALLcin为电机的霍尔位置信号线,HALLa,HALLb,HALLc接DSP的捕捉引脚;霍尔电流信号采集/处理电路包括四个ACS712电流传感器U11, U12, U13和U14,四个100pf的电容C49, C50, C51和C52,四个5. 1K的电阻R32, R62, R65和R67,四个lnf的电容C53, C54, C55和C56,及四个高频的电阻R68, R69, R70和R71, U11的1和U11的2引脚短接接工RA+, U 11的
3和U11的4引脚短接接工RA-, U 11的5引脚接地,U11的6引脚接电容C53,电容C53的另一端接地,U11的7引脚接电阻R32,电阻R32的另一端接电阻R68,并接出工RAout,电阻R68的另一端接地,U11的8引脚接电容C49并接++5V,电容C49的另一端接地,U12的1和U12的2引脚短接接RB+, U 12的3和U12的4引脚短接接RB-, U 12的5引脚接地,U12的6引脚接电容C54,电容C54的另一端接地,U12的7引脚接电阻R62,电阻R62的另一端接电阻R69,并接出RBout,电阻R69的另一端接地,U12的8引脚接电容C50并接++5V,电容C50的另一端接地,U13的1和U13的
2引脚短接接工LA+, U 13的3和U13的4引脚短接接工LA-, U 13的5引脚接地,U13的6引脚接电容C55,电容C55的另一端接地,U13的7引脚接电阻R65,电阻R65的另一端接电阻R70,并接出工LAout,电阻R70的另一端接地,U13的8引脚接电容C51并接++5V,电容C51的另一端接地,U14的1和U14的2引脚短接接工LB+,U14的3和U14的4引脚短接接工LB-,U14的5引脚接地,U14的6引脚接电容C56,电容C56的另一端接地,U14的7引脚接电阻867,电阻867的另一端接电阻871,并接出工LBout,电阻871的另一端接地,U14的8引脚接电容C52并接++5V,电容C52的另一端接地;
所述控制器组的驱动电路为直流无刷电机的驱动电路,由MOSFET构成的三相全桥逆变电路组成,包括一片轮履高低探测器82136,一个0. luf的电容C22,二个高频电阻826,827,一个5. 1电阻835,三个FR107的二极管D2,D3,D4,三个luf的电解电容C28,C29,C30,二个
100uf的电解电容C34,C35,六个MOSFET管Q1,Q2,Q3,Q4,Q5,Q6,若干个220V电阻R37,R38,R39,R40,R42,R45,六个200K电阻850,851,852,853, 855, 857,一个三针的端口CON1,轮履高低探测器82136的1引脚接++12V,轮履高低探测器82136的9引脚接地,轮履高低探测器
82136的10引脚接电阻827,电阻827的另一端接电容C22并同时接++12V,轮履高低探测器
82136的11引脚接电阻826,电阻826的另一端接电容C22并同时接+12V,电容C22的另一端接地,轮履高低探测器82136的12和轮履高低探测器82136的13引脚短接接地,轮履高低探测器82136的14引脚接电阻845,电阻845的另一端接MOSFET管Q6的G极,并接电阻857,电阻857的另一端接MOSFET管Q6的S极,并接地,轮履高低探测器82136的15引脚接电阻842,电阻842的另一端接MOSFET管Q5的G极,并接电阻855,电阻855的另一端;
接MOSFET管Q5的S极,并接地,轮履高低探测器82136的16引脚接电阻840,电阻840的另一端接MOSFET管Q4的G极,并接电阻853,电阻853的另一端接MOSFET管Q4的S极,并接地,轮履高低探测器82136的18引脚接电解电容C30的一极,并与MOSFET管Q6的D极相接,接端口CON1的3号位置,电解电容C30的+极接二极管D4,二极管D4的另一端接电阻835,轮履高低探测器82136的19引脚接电阻839,电阻839的另一端接MOSFET管Q3的G极,并接电阻852,电阻
852的另一端接MOSFET管Q5的S极,并接端口CON1的3号位置,轮履高低探测器82136的22引脚接电解电容C29的一极,并与MOSFET管Q5的D极接,接出RB+,RB一接端口CON1的2号位置,电解电容C29的+极接二极管D3,二极管D3的另一端接电阻835,23引脚接
电阻838,电阻838的另一端接MOSFET管Q2的G极,并接电阻851,电阻851的另一端接MOSFET管Q2的S极,并接RB+,26引脚接电解电容C28的一极,并与MOSFET管Q4的D极接,接出工RA+,工RA一接端口CON1的1号位置,电解电容C28的+极接二极管D2,二极管D2的另一端接电阻835,27引脚接电阻837,电阻837的另一端接MOSFET管Q1的G极,并接电阻850,电阻850的另一端接MOSFET管Q1的S极,并接工 RA+,28引脚接电解电容C28+极,
电阻835的另一端接++12V,MOSFET管Q1,Q2,Q3的D极接B+,并接电解电容C34的+极,电解电容C34的一极接电解电容C35的+极,电解电容C35的一极接地;
控制器组的的驱动控制程序的流程是:电池信号采集-电池完好-电池供电-电机获得电供应-电机前端的驱动轴工作开始,驱动轮上的轮履高低探测器启动-启动前驱动A轮或前驱动B轮,或前驱动A轮和前驱动B轮-机器人前进开始;
步骤3:前进过程处理,遇到右坑,前驱动B轮停止运行,后轮组全部停止运行,万向轮调节为3点和7点位置,启动前驱动A轮,整车会随前驱动A轮向左转向,将机器人从右坑中拉出;遇到左坑,前驱动B轮停止运行,后轮组全部停止运行,万向轮调节为3点和7点位置,启动前驱动A轮,整车会随前驱动A轮向右转向,将机器人从右坑中拉出;中间高两边底地形处理,支链水平关节轮上的扩展口中插入扳动扩展轴开始运行,前驱动A轮和前驱动B轮停止运行,万向转轮开始运行,万向转轮的,两个轮体转动道12点和6点位置,活动窄轨轮开始运行,驱动电机带动张紧皮带上的垂直同步轮的内扳动杆,将张紧皮带的长度放开,张紧皮带的长度边长,在变长的同时,垂直同步轮、立式轮开始呈八字形张开,原本活动窄轨轮的大小小于或等于驱动轮的大小变得扩大,这时候再启动固定轮组,带动活动窄轨轮进行转动,活动窄轨轮会利用自身的轮道和轮道边沿的拨桨拨动砂石进入坑道内,同时中间的万向轮也会进行前进移动,一旦拨动的砂石能够进行垫住住驱动轮的移动了,机器人就会从两个同时坑道的路中移动出来了;
步骤4,信息采集摄像头启动,进行录像,录像经过自身插取得CDMS卡进行网络传输给控制中心,机器人的装置仓盒后尾还设置有弹簧测量轮,绕弹簧测量轮设置感应器,弹簧测量轮拖安装在机器人的车尾,在启动中先由检测人员手动卡扣入铁轨,随机器人前进,在铁轨的工字结构中进行滚动前进;弹簧测量轮上设置有永磁铁,永磁铁片的间隔道中设置有弹性传感器,弹性传感器记录震动数据,将震动数据传递给数据中间,传递的震动幅度数据波动越小,说明铁轨越正常,没有变形,如果震动幅度数据波动越大,说明铁轨已经变形,需要进行维护。
[0007] 作为优选所述弹簧测量轮感应器的信号采集/处理程序的流程是:弹性感应器定制的标准数据溢出触发A/D电信号转换一》A/D中断标志位发出1个Adflag = 1信号一》电流值信号发出,控制器记录一个波动信号,A/D转换操作一》将A/D转换结果存入变量中一送发给电流调节器一》霍尔位置信号检测一》换相程序一》记录周期计数器time_ cnt+1一Time_ cnt}200,一》(记录完成)否一》速度更新标志=1;一》(记录完成)是一》慢周期标志位flag_san = 1一》里程更新标志=1,一》(记录里程距离)是一》结束;一》否一》进度更新程序一》退回一》倒车复检。
[0008] 本发明的有益效果是:本发明通过控制无刷直流电机来代替现有技术的有刷直流电机,具有换向速度快、损耗低、无噪声和振动危害、启动性能好、节能和经济的优点,并且结构相对简单,功能强大,尤其能降低成本;本发明的动力控制由硬连接改为软连接型式,通过电子线控技术,实现各电动轮从零到最大速度的无级变速和各电动轮间的差速要求,省略了传统汽车所需的机械式操纵换档装置、离合器变速器传动轴和机械差速器等,使得驱动系统和整车结构简洁、有效利用空间大、传动效率提高;拥有抗震的轮式活动底盘,同时还有适应轨道高速运动的活动窄轨轮,同时活动窄轨轮上设计有拨桨,主要用于铁路路基砂石过多的情况,能利用拨桨扒砂石进行有效的前进,还能利其使本机器人拥有一定的水坑活动能力,特别适应铁路轨道的探测和利用,帮助人们检修铁路,减轻铁路工人的负担。附图说明
[0009] 图1整体结构视图;图2仰视结构图;
图3正面解剖图;
图4固定轮结构图;
图5固定轮爆炸图;
图6活动窄轨轮驱动结构图;
图7活动窄轨轮驱动结构图2;
图8活动窄轨轮安装结构图;
图9活动窄轨轮结构图;
图10控制电路图。

具体实施方式

[0010] 下面通过实施例,结合附图,对本发明的技术方案作作为优选具体的说明:如图1-9所示,一种多环境适应探测机器人,包括底盘(1)、装置仓盒(2)、固定轮组(3)、万向轮组(4)、同步轨轮组(5),底盘上设置装置仓盒,装置仓盒内设置锂电池组(6)和控制器组(7),底盘两侧,装置仓盒底部设置固定轮组和万向轮组,同步轨轮组设置在装置仓盒的内传动仓(8)内或夹在固定轮组和万向轮组之间;
所述仓盒顶端设置有支撑柱(9),支撑柱头端设置摇摆头(10),摇摆头的两端设置摄像传感头(11),所述摇摆头外套还合有L形加具板(12);
所述摇摆头包括外壳(13),外壳底部设置平面转动轴(14),转动轴内套设平面转动轴承(15),平面转动轴承套合在平面转动电机的机轴(16)上,平面转动轴由平面转动电机驱动;所述摇摆头横向设置上下扳动轴(17),上下扳动轴左右各设置1只摄像传感头,所述上下扳动轴包括横联杆(18);
四个固定轮组分别安置在底盘前驱动处(19)和后驱动处(20),包括四只驱动轮(201),驱动轮左右两侧的同轴处个设置一只共两对;
底盘还设置有万向轮(21)分别安置在底盘的前驱动处的中间,所述万向轮包括转动片(22),转动节(23)、万向转动轮(24),转动片中心设置转动节,绕转动节上下设置万向转动轮,转动节包括转向轴承(25)和转向轴杆(26),转向轴杆固定在转向齿轮盘(27)上;
所述驱动轮包括独立驱动组(28)、驱动轴组(29),轮连接轴接(30)、主动轮(31),所述主动轮中轴处的主动轮圆轴(32)处设置螺丝套接轴承(33),套接轴承内插接锁扣连接轮(34)连接轮连接轴,轮连接轴接内套合锁接驱动轴组,驱动轴组齿合设置在独立驱动组的动力输出轴上;驱动轮上还设置活动窄轨轮套(35),活动窄轨轮套和活动窄轨轮相互铰接,所述活动窄轨轮包括运动支链水平关节轮(36)、垂直同步轮(37)、立式轮(38)、三种各轮各自独立,组成圆形,其中垂直同步轮上设置有风车桨(39),立式轮和运动支链水平关节轮之间连接有铰接杆(101);
三者相交的轴心点处设置有转动驱动装置(40)、执行器电机托架(41)、执行器电机(42),所述旋转杆组(43)固定在执行器电机上,旋转杆组上连接电机托架,执行器电机安装在执行器电机托架上,所述垂直同步轮包括与执行器电机外壳固定连接的同步轮支架(44)所述同步轮支架上固定连接有推扩连轴件(45),所述旋转杆组被活动窄轨轮(46)套合顺同步轮支架的移槽(47)移动,所述同步轮通过同步带与执行器电机连接。
[0011] 作为优选所述运动支链水平关节轮、垂直同步轮、立式轮三个轮子的安装中心在水平平面上位于同一圆周,所述的两个驱动轮均是独立的采用带有霍尔效应传感器的轮毅式直流无刷电机作为驱动电机的驱动轮;控制器是采用工作于双极模式下的全桥PWMDC/DC变换器来驱动直流无刷电机的控制器;作为优选所述装置仓盒尾端设置扩展线口(48),扩展线口设置扩展连线(49),扩展连线牵引连接弹簧测量轮(50)。
[0012] 一种利用多环境适应探测机器人进行铁路环境检修的方法:实施方法:步骤1:在驱动轮外套合螺接上活动窄轨轮套,利用活动窄轨轮套和活动窄轨轮进行连接,将支链水平关节轮上的扩展口中插入扳动扩展轴,扳动扩展轴的末端和同齿离合轮相套合连接,同齿离合轮上设置皮带,皮带连接到垂直同步轮的内扳动杆上(结构与张紧轮类似),利用张紧轮结构,活动窄轨轮的大小会进行扩大和缩小;
步骤2:将本机器人放置在铁轨的旁侧的砂石道床上,启动机器人,驱动轮开始运作,固定轮组的控制器组包括硬件部分和软件部分,其中硬件部分由信号采集/处理电路和驱动电路两部分构成,软件部分包括信号采集与处理程序、驱动控制程序、过流保护程序、CAN通信程序和差速控制程序;
所述控制器组的控制器的硬件部分中的信号采集/处理电路由霍尔位置信号采集/处理电路和霍尔电流信号采集/处理电路两部分构成;
控制器组的的驱动控制程序的流程是:电池信号采集-电池完好-电池供电-电机获得电供应-电机前端的驱动轴工作开始,驱动轮上的轮履高低探测器启动-启动前驱动A轮或前驱动B轮,或前驱动A轮和前驱动B轮-机器人前进开始;
步骤2:将本机器人放置在铁轨的旁侧的砂石道床上,启动机器人,驱动轮开始运作,固定轮组的控制器组包括硬件部分和软件部分,其中硬件部分由信号采集/处理电路和驱动电路两部分构成,软件部分包括信号采集与处理程序、驱动控制程序、过流保护程序、CAN通信程序和差速控制程序;
所述控制器组的控制器的硬件部分中的信号采集/处理电路由霍尔位置信号采集/处理电路和霍尔电流信号采集/处理电路两部分构成;
所述霍尔位置信号采集/处理电路包括三个高频的电阻R22, R72和R73,三个低频的电阻R9, R10和R11,及匹配数量设置的0.001uf电容C5, C6和C7,电阻R22的一端接++5V,电阻R22的另一端接电阻R9,并接出信号线HALLla,电阻R9的另一端接电容C5,并接出信号先HALLlain,电容C5的另一端接地,电阻R72的一端接++5V,电阻R72的另一端接电阻R10,并接出信号线HALLlb,电阻R10的另一端接电容C6,并接出信号先HALLlbin,电容C6的另一端接地,电阻R73的一端接++5V,电阻R73的另一端接电阻R11,并接出信号线HALLlc,电阻R11的另一端接电容C7,并接出信号先HALLlcin,电容C7的另一端接地,其中,HALLain,HALLbin,HALLcin为电机的霍尔位置信号线,HALLa,HALLb,HALLc接DSP的捕捉引脚;霍尔电流信号采集/处理电路包括四个ACS712电流传感器U11, U12, U13和U14,四个100pf的电容C49, C50, C51和C52,四个5. 1K的电阻R32, R62, R65和R67,四个lnf的电容C53, C54, C55和C56,及四个高频的电阻R68, R69, R70和R71, U11的1和U11的2引脚短接接工RA+, U 11的
3和U11的4引脚短接接工RA-, U 11的5引脚接地,U11的6引脚接电容C53,电容C53的另一端接地,U11的7引脚接电阻R32,电阻R32的另一端接电阻R68,并接出工RAout,电阻R68的另一端接地,U11的8引脚接电容C49并接++5V,电容C49的另一端接地,U12的1和U12的2引脚短接接RB+, U 12的3和U12的4引脚短接接RB-, U 12的5引脚接地,U12的6引脚接电容C54,电容C54的另一端接地,U12的7引脚接电阻R62,电阻R62的另一端接电阻R69,并接出RBout,电阻R69的另一端接地,U12的8引脚接电容C50并接++5V,电容C50的另一端接地,U13的1和U13的
2引脚短接接工LA+, U 13的3和U13的4引脚短接接工LA-, U 13的5引脚接地,U13的6引脚接电容C55,电容C55的另一端接地,U13的7引脚接电阻R65,电阻R65的另一端接电阻R70,并接出工LAout,电阻R70的另一端接地,U13的8引脚接电容C51并接++5V,电容C51的另一端接地,U14的1和U14的2引脚短接接工LB+,U14的3和U14的4引脚短接接工LB-,U14的5引脚接地,U14的6引脚接电容C56,电容C56的另一端接地,U14的7引脚接电阻867,电阻867的另一端接电阻871,并接出工LBout,电阻871的另一端接地,U14的8引脚接电容C52并接++5V,电容C52的另一端接地;
所述控制器组的驱动电路为直流无刷电机的驱动电路,由MOSFET构成的三相全桥逆变电路组成,包括一片轮履高低探测器82136,一个0. luf的电容C22,二个高频电阻826,827,一个5. 1电阻835,三个FR107的二极管D2,D3,D4,三个luf的电解电容C28,C29,C30,二个
100uf的电解电容C34,C35,六个MOSFET管Q1,Q2,Q3,Q4,Q5,Q6,若干个220V电阻R37,R38,R39,R40,R42,R45,六个200K电阻850,851,852,853, 855, 857,一个三针的端口CON1,轮履高低探测器82136的1引脚接++12V,轮履高低探测器82136的9引脚接地,轮履高低探测器
82136的10引脚接电阻827,电阻827的另一端接电容C22并同时接++12V,轮履高低探测器
82136的11引脚接电阻826,电阻826的另一端接电容C22并同时接+12V,电容C22的另一端接地,轮履高低探测器82136的12和轮履高低探测器82136的13引脚短接接地,轮履高低探测器82136的14引脚接电阻845,电阻845的另一端接MOSFET管Q6的G极,并接电阻857,电阻857的另一端接MOSFET管Q6的S极,并接地,轮履高低探测器82136的15引脚接电阻842,电阻842的另一端接MOSFET管Q5的G极,并接电阻855,电阻855的另一端;
接MOSFET管Q5的S极,并接地,轮履高低探测器82136的16引脚接电阻840,电阻840的另一端接MOSFET管Q4的G极,并接电阻853,电阻853的另一端接MOSFET管Q4的S极,并接地,轮履高低探测器82136的18引脚接电解电容C30的一极,并与MOSFET管Q6的D极相接,接端口CON1的3号位置,电解电容C30的+极接二极管D4,二极管D4的另一端接电阻835,轮履高低探测器82136的19引脚接电阻839,电阻839的另一端接MOSFET管Q3的G极,并接电阻852,电阻
852的另一端接MOSFET管Q5的S极,并接端口CON1的3号位置,轮履高低探测器82136的22引脚接电解电容C29的一极,并与MOSFET管Q5的D极接,接出RB+,RB一接端口CON1的2号位置,电解电容C29的+极接二极管D3,二极管D3的另一端接电阻835,23引脚接
电阻838,电阻838的另一端接MOSFET管Q2的G极,并接电阻851,电阻851的另一端接MOSFET管Q2的S极,并接RB+,26引脚接电解电容C28的一极,并与MOSFET管Q4的D极接,接出工RA+,工RA一接端口CON1的1号位置,电解电容C28的+极接二极管D2,二极管D2的另一端接电阻835,27引脚接电阻837,电阻837的另一端接MOSFET管Q1的G极,并接电阻850,电阻850的另一端接MOSFET管Q1的S极,并接工 RA+,28引脚接电解电容C28+极,
电阻835的另一端接++12V,MOSFET管Q1,Q2,Q3的D极接B+,并接电解电容C34的+极,电解电容C34的一极接电解电容C35的+极,电解电容C35的一极接地;
控制器组的的驱动控制程序的流程是:电池信号采集-电池完好-电池供电-电机获得电供应-电机前端的驱动轴工作开始,驱动轮上的轮履高低探测器启动-启动前驱动A轮或前驱动B轮,或前驱动A轮和前驱动B轮-机器人前进开始;
步骤3:前进过程处理,遇到右坑,前驱动B轮停止运行,后轮组全部停止运行,万向轮调节为3点和7点位置,启动前驱动A轮,整车会随前驱动A轮向左转向,将机器人从右坑中拉出;遇到左坑,前驱动B轮停止运行,后轮组全部停止运行,万向轮调节为3点和7点位置,启动前驱动A轮,整车会随前驱动A轮向右转向,将机器人从右坑中拉出;中间高两边底地形处理,支链水平关节轮上的扩展口中插入扳动扩展轴开始运行,前驱动A轮和前驱动B轮停止运行,万向转轮开始运行,万向转轮的,两个轮体转动道12点和6点位置,活动窄轨轮开始运行,驱动电机带动张紧皮带上的垂直同步轮的内扳动杆,将张紧皮带的长度放开,张紧皮带的长度边长,在变长的同时,垂直同步轮、立式轮开始呈八字形张开,原本活动窄轨轮的大小小于或等于驱动轮的大小变得扩大,这时候再启动固定轮组,带动活动窄轨轮进行转动,活动窄轨轮会利用自身的轮道和轮道边沿的拨桨拨动砂石进入坑道内,同时中间的万向轮也会进行前进移动,一旦拨动的砂石能够进行垫住住驱动轮的移动了,机器人就会从两个同时坑道的路中移动出来了;
步骤4,信息采集摄像头启动,进行录像,录像经过自身插取得CDMS卡进行网络传输给控制中心,机器人的装置仓盒后尾还设置有弹簧测量轮,绕弹簧测量轮设置感应器,弹簧测量轮拖安装在机器人的车尾,在启动中先由检测人员手动卡扣入铁轨,随机器人前进,在铁轨的工字结构中进行滚动前进;弹簧测量轮上设置有永磁铁,永磁铁片的间隔道中设置有弹性传感器,弹性传感器记录震动数据,将震动数据传递给数据中间,传递的震动幅度数据波动越小,说明铁轨越正常,没有变形,如果震动幅度数据波动越大,说明铁轨已经变形,需要进行维护。
[0013] 作为优选所述弹簧测量轮感应器的信号采集/处理程序的流程是:弹性感应器定制的标准数据溢出触发A/D电信号转换一》A/D中断标志位发出1个Adflag = 1信号一》电流值信号发出,控制器记录一个波动信号,A/D转换操作一》将A/D转换结果存入变量中一送发给电流调节器一》霍尔位置信号检测一》换相程序一》记录周期计数器time_ cnt+1一Time_ cnt}200,一》(记录完成)否一》速度更新标志=1;一》(记录完成)是一》慢周期标志位flag_san = 1一》里程更新标志=1,一》(记录里程距离)是一》结束;一》否一》进度更新程序一》退回一》倒车复检。
[0014] 本文中所描述的具体实施例仅仅是对本发明内容精神作举例说明。本发明所属技术领域的技术人员可以对所描述的具体实施例做各种各样的修改或补充或采用类似的方式替代,但并不会偏离本发明的精神或者超越所附权利要求书所定义的范围。
QQ群二维码
意见反馈