1.一种变高度可重构石窟寺病害智能探测机器人的控制方法,其特征在于,所述的变高度可重构石窟寺病害智能探测机器人包括履带小车行走系统(1)、机械臂探测系统(2)、用于调节机械臂探测系统(2)高度的高度调节系统(3)、工作状态感知系统(4)和自主规划系统(5);
所述高度调节系统(3)、工作状态感知系统(4)和自主规划系统(5)均设置在履带小车行走系统(1)上,所述机械臂探测系统(2)设置在高度调节系统(3)上;
所述机械臂探测系统(2)包括六自由度回转关节模块和三自由度腕关节模块,所述六自由度回转关节模块包括六个串联的回转关节,其中第一个回转关节的旋转输出端连接在高度调节系统(3)上;
所述三自由度腕关节模块(210)包括静平台(21001)、立柱(21002)、可伸缩的电动推杆(21003)、动平台(21004)、用于搭载各种岩壁病害探测仪器的载物架(21005)和腕关节控制模块(21006),所述静平台(21001)一端与六自由度回转关节模块中的第六个回转关节的旋转输出端连接,静平台的另一端通过立柱(21002)及电动推杆(21003)与动平台(21004)连接,所述立柱(21002)与动平台(21004)可活动连接,且动平台(21004)能够绕立柱(21002)旋转或者相对立柱(21002)倾斜,所述电动推杆(21003)与静平台(21001)、动平台(21004)之间均可活动连接,围绕立柱(21002)设置有多个电动推杆(21003),通过所述腕关节控制模块(21006)控制电动推杆(21003)的伸缩长度使得动平台(21004)绕立柱(21002)旋转或者倾斜;所述载物架(21005)连接在动平台(21004)上;
所述工作状态感知系统(4)包括二维雷达(401)、三维雷达(402)和双目相机(403),所述二维雷达(401)和三维雷达(402)均设置在履带小车行走系统(1)上表面,所述二维雷达(401)用于对环境二维地形建模;所述三维雷达(402)用于探测石窟寺空间信息以及感知机械臂整体的实时位姿;所述双目相机(403)设置在所述载物架(21005)上,用于采集石窟寺局部位置的三维点云图并定位探测机器人在二维地面和三维空间实时位置;
所述自主规划系统(5)包括上位机(501)和下位机,所述下位机包括用于控制履带小车行走系统(1)中履带轮速度的电控模块(106)、用于控制高度调节系统(3)举升高度的高度控制模块(303)、六个回转关节各自用于驱动关节电机的关节控制模块(20106)、用于控制电动推杆(21003)伸缩长度的腕关节控制模块(21006);
所述上位机(501)用于接收二维雷达(401)、三维雷达(402)、双目相机(403)采集的空间图像信息,并基于总体任务规划各下位机的实时运行路径,向各下位机下发指令;
方法包括以下步骤:
步骤1,工作人员通过操作手柄远程控制探测机器人的履带小车行走系统(1)在待检测石窟洞窟内行走,完成待检测石窟洞窟二维平面的建模,获得初始导航地图;
步骤2,探测机器人开启自主导航和自动控制模式,基于三维雷达所建立的空间地图和双目相机所构建的局部特征模型,控制机械臂探测系统(2)对石窟寺岩壁进行损伤探测;具体包括:步骤2.1,切换所有控制模块为自主控制模式,三维雷达(402)开始对整体空间信息进行初步建模,上位机根据探测任务确定探测机器人初始点,自主规划履带小车行走系统(1)路线,并给所述电控模块(106)发送控制指令,电控模块(106)驱动履带小车行走系统(1)行驶到探测初始位置;
步骤2.2,上位机(501)分析三维雷达(402)采集的空间信息,结合初始机械臂探测系统(2)探测范围限制,确定定点范围内机械臂末端探测仪器的探测范围,并确定探测初始点和探测顺序;之后基于初始机械臂末端位置和空间障碍物反推各机械臂中各连杆在空间中所处的位置,从而反推在某一末端位置时各回转关节旋转输出轴相对于初始位置旋转的角度,接着上位机向第一个回转关节的关节控制模块(20106)发送其目标转角;第一个回转关节的关节控制模块(20106)在接收指令后,在不对周边环境造成影响的范围内规划转矩、转速和电机转动角度,驱动第二驱动电机(20102)运转;第二个回转关节和第三个回转关节的关节控制模块接收控制指令后进行与第一个回转关节相同的步骤,依次提升机械臂末端的探测高度;第四个回转关节至第六个回转关节用于调节末端的位姿和精准位置,根据实际空间环境决定依次作用顺序;
步骤2.3,双目相机(403)对被探测的局部区域进行建模后将数据传入上位机(501),上位机(501)通过分析病害延伸的方向和角度,确定针对不同病害的实际探测入射角度并发送到腕关节控制模块(21006),腕关节控制模块(21006)根据数据建模确定各电动推杆(21003)所需伸缩的长度;
步骤2.4,对初始位置点病害探测结束后,上位机(501)规划机械臂末端搭载的探测设备在矩形区域内上下或左右顺次检测,并基于检测顺序控制机械臂向下一检测点移动,同时基于上述步骤2.2和步骤2.3再次规划各回转关节和腕关节的运动过程,并再次发送给下位机进行执行,如此往复,直至完成对所规划矩形面的全覆盖;
步骤2.5,完成定点矩形区域探测后,上位机(501)下发指令控制履带小车行走系统(1)移动到下一定点位置,并再次选定初始检测点和依次检测顺序,接着控制回转关节和腕关节,完成新一轮区域的探测,如此往复,直至探测机器人回到初始运动点,完成洞窟一周的病害探测;
步骤3,根据洞窟内实际高度,不断调整高度调节系统(3)的举升高度,每调整一次高度,根据步骤2进行探测,直至完成对整体石窟岩壁的病害探测;
步骤4,更换探测仪器重复上述操作,实现对石窟岩壁不同病害的全面探测,全部探测工作结束后控制探测机器人回收。
2.如权利要求1所述的变高度可重构石窟寺病害智能探测机器人的控制方法,其特征在于,所述履带小车行走系统(1)包括壳体(101)、履带轮(102)、第一驱动电机(103)、减速器(104)、蓄电池(105)和电控模块(106),所述第一驱动电机(103)、减速器(104)、蓄电池(105)和电控模块(106)布置在壳体(101)内,第一驱动电机(103)与减速器(104)连接,减速器(104)的输出轴连接履带轮(102)的主动轮。
3.如权利要求1所述的变高度可重构石窟寺病害智能探测机器人的控制方法,其特征在于,所述六自由度回转关节模块包括依次串接的第一回转关节(201)、第二回转关节(202)、第一连杆(203)、第三回转关节(204)、空关节(205)、第二连杆(206)、第四回转关节(207)、第五回转关节(208)和第六回转关节(209),所述第一回转关节(201)的固定输入端与第二回转关节(202)的旋转输出端连接,第二回转关节(202)的固定输入端通过第一连杆(203)与第三回转关节(204)的固定输入端连接,第三回转关节(204)的旋转输出端与空关节(205)连接,空关节(205)另一端通过第二连杆(206)与第四回转关节(207)的固定输入端连接,第四回转关节(207)的旋转输出端通过L型连接件与第五回转关节(208)连接,第五回转关节(208)通过L型连接件与第六回转关节(209)连接,第六回转关节(209)的旋转输出端用于连接所述静平台(21001);
所述第一回转关节(201)的输出轴轴线、第五回转关节(208)的输出轴轴线与地面垂直,所述第二回转关节(202)的输出轴轴线、第三回转关节(204)的输出轴轴线、第四回转关节(207)的输出轴轴线、第六回转关节(209)的输出轴轴线与地面平行。
4.如权利要求3所述的变高度可重构石窟寺病害智能探测机器人的控制方法,其特征在于,所述第一回转关节(201)包括主轴(20101)、第二驱动电机(20102)、编码器(20103)、制动器(20104)、谐波减速器(20105)、关节控制模块(20106)和外壳(20107),所述外壳(20107)整体为L型,外壳(20107)内部从上到下依次布置有所述谐波减速器(20105)、第二驱动电机(20102)、编码器(20103)、制动器(20104)和关节控制模块(20106),所述第二驱动电机(20102)、编码器(20103)、制动器(20104)、谐波减速器(20105)均为中空结构,套设在所述主轴(20101)上;所述主轴(20101)为中空轴,内部用于走线;所述关节控制模块(20106)连接在外壳(20107)底部;
其余五个回转关节的构型与第一回转关节(201)构型相同。
5.如权利要求1或4所述的变高度可重构石窟寺病害智能探测机器人的控制方法,其特征在于,所述关节控制模块(20106)包括控制板、驱动板和检测板,所述控制板用于接收上位机发送的指令并进行分析处理,所述驱动板用于驱动第二驱动电机运转,所述检测板用于采集所述编码器测量的速度位置信息并反馈给控制板。
6.如权利要求3所述的变高度可重构石窟寺病害智能探测机器人的控制方法,其特征在于,所述第一连杆(203)和第二连杆(206)均包括中空连接管和设置在中空连接管两端的连接法兰。
7.如权利要求1所述的变高度可重构石窟寺病害智能探测机器人的控制方法,其特征在于,所述高度调节系统(3)包括第三驱动电机(301)、举升电缸缸体(302)、设置在举升电缸缸体(302)两端的连接部、高度控制模块(303),所述两个连接部分别与履带小车行走系统(1)的上盖板、第一个回转关节的旋转输出端连接;所述第三驱动电机(301)驱动举升电缸缸体(302)提升或者下降。
8.如权利要求1所述的变高度可重构石窟寺病害智能探测机器人的控制方法,其特征在于,所述三维雷达(402)通过举升支架(404)支撑在履带小车行走系统(1)上。