CN109029473A - 一种智能石油勘探机器人系统及其石油勘探方法 - Google Patents

一种智能石油勘探机器人系统及其石油勘探方法 Download PDF

Info

Publication number
CN109029473A
CN109029473A CN201810913307.9A CN201810913307A CN109029473A CN 109029473 A CN109029473 A CN 109029473A CN 201810913307 A CN201810913307 A CN 201810913307A CN 109029473 A CN109029473 A CN 109029473A
Authority
CN
China
Prior art keywords
robot
exploration
module
driving
mechanical arm
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
Application number
CN201810913307.9A
Other languages
English (en)
Other versions
CN109029473B (zh
Inventor
陈梁
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Qingdao Future Education Technology Co ltd
Original Assignee
China University of Petroleum East China
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by China University of Petroleum East China filed Critical China University of Petroleum East China
Priority to CN201810913307.9A priority Critical patent/CN109029473B/zh
Publication of CN109029473A publication Critical patent/CN109029473A/zh
Application granted granted Critical
Publication of CN109029473B publication Critical patent/CN109029473B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/26Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
    • G01C21/28Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network with correlation of data from several navigational instruments
    • G01C21/30Map- or contour-matching
    • G01C21/32Structuring or formatting of map data
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J11/00Manipulators not otherwise provided for
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/005Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 with correlation of navigation data from several sources, e.g. map or contour matching
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01VGEOPHYSICS; GRAVITATIONAL MEASUREMENTS; DETECTING MASSES OR OBJECTS; TAGS
    • G01V9/00Prospecting or detecting by methods not provided for in groups G01V1/00 - G01V8/00
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D27/00Simultaneous control of variables covered by two or more of main groups G05D1/00 - G05D25/00
    • G05D27/02Simultaneous control of variables covered by two or more of main groups G05D1/00 - G05D25/00 characterised by the use of electric means
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05FSYSTEMS FOR REGULATING ELECTRIC OR MAGNETIC VARIABLES
    • G05F1/00Automatic systems in which deviations of an electric quantity from one or more predetermined values are detected at the output of the system and fed back to a device within the system to restore the detected quantity to its predetermined value or values, i.e. retroactive systems
    • G05F1/66Regulating electric power

Abstract

本发明公开了一种智能石油勘探机器人系统及其石油勘探方法,属于石油智能勘探领域,包括勘探机器人和遥控监测中心,所述勘探机器人包括自主导航模组、机械臂、信息传输模块和能源驱动模块;能实现恶劣环境下的自主侦查与智能勘探采样,智能采集及分配机器人能源,提高续航范围和勘探效率,并能够在勘探过程中自主巡逻安防,节省安防成本。

Description

一种智能石油勘探机器人系统及其石油勘探方法
技术领域
本发明属于石油智能勘探领域,尤其涉及的是一种智能石油勘探机器人系统及其石油勘探方法。
背景技术
油气等矿物能源是国家发展的基石,因此石油相关技术产业具有很大的发展空间。石油产业作为我国经济增长的一大动力,发挥着不可替代的作用。同时,我国经济总体规模较大,机器人拥有量和技术水平低。随着人工智能时代及工业4.0的来临,各行业对机器人的需求数量也逐步增长。但现有石油机器人行业存在勘探设备资源浪费,功能单一,场地安防监控投入成本高等问题,难以满足体制改革中日益增长的勘探自动化需求。
而现阶段对石油行业机器人的研究多局限于钻杆连接、导管架安装、水下开阀关阀、钻井等,针对石油勘探开发领域的研究内容较为匮乏。①在进行正式石油开采任务之前,石油勘探人员需要亲身在野外进行实践,这就产生了很高的人力成本,且石油地质行业危险程度高、意外发生几率大,对油气的勘探业发展造成了很大阻力。②在勘探采样设备方面,由于设备集成度低且操作复杂,据统计只有13%的勘探人员可以借助勘探设备进行准确作业,且具备丰富勘探经验的专家资源有限,难于对多处资源进行人工勘探,常常导致获得样品不理想或勘探设备的损坏。③由于利益驱使,石油盗窃日益猖獗,但油气自动化安保的研发空白,使得油田安保需要投入大量的人力物力成本,造成严重的资源浪费。
尤其是,石油地质行业的工作环境通常较为恶劣,常位于戈壁滩或沙漠中,当今市场上却缺乏可以在资源欠缺区域仍能够正常使用的石油勘探装置,难于解决设备能源不足,采样勘探效率低下的问题。
发明内容
本发明为了解决现有石油机器人无法实现恶劣环境下的地质勘探问题,本发明提供一种智能石油勘探机器人系统及其石油勘探方法,能实现恶劣环境下的自主侦查与智能勘探采样,智能采集及分配机器人能源,提高续航范围和勘探效率,并能够在勘探过程中自主巡逻安防,节省安防成本。
本发明提供的技术方案如下:
一种智能石油勘探机器人系统,其中,包括勘探机器人和遥控监测中心,所述勘探机器人包括自主导航模组、机械臂、信息传输模块和能源驱动模块;
所述自主导航控制模块包括采集环境信息的环境传感器和即时定位与地图构建(简称SLAM)组件,所述自主导航控制模块能够控制勘探机器人自主进行石油勘探的先遣侦查与返程导航;所述机械臂包括采样机构、采样控制模块和关节驱动电机,所述机械臂能够通过采样控制模块控制关节驱动电机的输出功率,驱动采样机构的夹持关节转动来抓取样本;所述能源驱动模块包括太阳能电池模组和驱动底盘,太阳能电池模组与驱动底盘供电连接,所述驱动底盘通过驱动控制模块控制行进驱动电机输出功率驱动勘探机器人运动;所述遥控监测中心设置有遥感机械手套,所述遥感机械手套通过信息传输模块与机械臂通讯连接,所述遥感机械手套内设置有体感传感器,能够采集人体手臂动作信息并传输至勘探机器人。
优选的,所述自主导航模组通过环境传感器获取并跟踪勘探机器人位姿,通过SLAM组件处理获得勘探机器人预走路线角度,SLAM 组件利用路径跟踪算法对机器人预走路线进行跟踪。所述位姿优选包括勘探机器人的当前位置、转弯姿态以及运动速度。
所述SLAM组件优选利用GPS定位勘探机器人路径航向,并依据实时动态差分定位(简称RTK)获得厘米级定位精度,用于勘探机器人自主导航。
更优选的,SLAM组件包括树莓派嵌入式模块、Ubuntu模块和机器人操作系统(简称ROS),ROS安装移植于Ubuntu模块中并嵌入树莓派嵌入式模块。
优选的,在所述机械臂中,所述采样机构包括具有若干机械指的机械手,机械指和机械手的手掌内设置有超声传感器和压力传感器。
进一步,在所述能源驱动模块中,所述驱动底盘包括框架式车架、双排履带和行进驱动电机。
进一步,所述勘探机器人的太阳能电池模组包括太阳能电池板、多向光敏电阻和旋转云台,多向光敏电阻安装于太阳能电池板的不同朝向位置,所述太阳能电池板通过旋转云台与驱动底座转动连接。优选的,在所述太阳能电池模组中,所述太阳能电池板的最大方位角为 360°,最大俯仰角为110°。
本发明还提供一种采用上述智能勘探机器人系统进行石油勘探的方法,所述自主导航控制模块的SLAM组件通过点到直线间的距离公式获得机器人的横向偏差大小,进而控制勘探机器人进行导航,具体步骤包括:
①以勘探机器人的运动坐标系为xoy,由预定义路径中的直线和目标点在勘探机器人中的横纵坐标几何环境中形成直角三角形:
其中,XP为横坐标,YP为纵坐标,γ为转弯曲率,逆时针转弯γ>0,顺时针转弯γ<0,R为瞬时转弯的半径,d为横向位置误差,d L为纯路径跟踪的前视距离,ψ为航向偏差,为航向角变化大小;
②通过勘探机器人运动学模型获得勘探机器人的目标转角:
为机器人航向的变化率,L为机器人前后轴距,o为机器人前进速度,δ为机器人目标转角。
更优选的,所述自主导航控制模块还包括校验模块,通过路径跟踪效率η和相对偏差对勘探机器人路径跟踪曲线进行验证和校准,具体地
通过本发明的校验模块可知,上述方法所得勘探机器人路径跟踪曲线波动较缓,而且跟踪效率高,能够有效保证勘探机器人在侦查勘探及自主返程过程中按照路径行进,提高勘探效率并节省能源,保证了恶劣环境下的正常作业。
进一步,所述机械臂采样机构中,所述关节驱动电机采用直线驱动机构进行驱动,所述采样控制模块通过滑块-曲柄机构模型,将机械指两端设AB两点进行分析,对机械臂采样过程中的单指关节驱动和受力进行处理,从而得到机械臂全手力学性能,以对关节驱动电机进行反馈调节,具体地
∑FX=0,∑FY=0,∑M=0,即
MA+FLcosθ=0,
其中,F=m2为外力大小,θ为指节转过角度,L为连杆长度,MA为指节转动力矩;m为单指关节提升驱动量;
通过单指关节受力获得机械臂的全手驱动力,即Fmax=Fn=5F。
优选的,所述机械臂通过手掌内的压力传感器获取样品上顶量 m0,当m0>0,通过各指关节的压力传感器获取采样过程中受到样品的压力量m’,通过滑块-曲柄机构模型处理得到样品作用力F’n,与机械臂全手力驱动力Fn比较,进而对关节驱动电机进行输出功率调节。
本发明通过机械臂采样机构的智能控制,在保证完成遥控监测中心指令,将勘探采样样品抓取的前提下,合理调节输出功率,节省勘探机器人能源。
进一步,所述驱动控制模块根据行进驱动电机输出功率,通过对驱动底盘的驱动力分析,结合目标转角处理获得勘探机器人行进的校正速度,与自主导航控制模块获得的实际速度进行对比,当理论速度与实际速度的速度差值大于换挡阈值,则控制行进驱动电机进行换挡操作;所述驱动控制模块的行进理论速度处理流程包括:
v=vl(1-δ),
其中,pq为驱动底盘履带驱动力;vl为理论速度;v为校正速度; Me为发动机转矩;I为各档传动比;ηe为机械效率;ne为发动机转速;rdq为驱动轮动力半径;I′为驱动轮滑转率(履带式为0.07)。
优选的,换挡阈值为速度差值占实际速度比值的30%。
进一步,所述太阳能电池模组通过多向光敏电阻进行各方向的光强度实时监测,当一侧光强高于另一侧光强时,控制旋转云台旋转太阳能电池板改变朝向,直至两侧方向的光敏电阻接收光强相同。
本发明通过太阳能电池模组在勘探机器人行进及采样过程中实时调整,实现了对太阳等光源的全方位跟踪,保证了机器人能源采集效率。
该机构输出位姿数值解与实测值平均误差分别为1.8%、2.6%、 0.84%,表明该机构跟踪太阳的精度较高。此外,该机构电机驱动能耗约为传统二轴跟踪机构的25%。
进一步,所述勘探机器人还包括所述巡逻安防模块;所述遥控监测中心还包括安保监控模块,巡逻安防流程包括:
①所述巡逻安防模块控制勘探机器人按照勘探路线巡逻,对人员异常情况进行检测处理并发送至安保监控模块,②所述巡逻安防模块通过激光雷达和深度摄像头对人体和面貌进行人员信息采集,通过安保监控模块定位分析,③检测到人员异常情况,发送报警信息到遥控监测中心,勘探机器人发出现场声音灯光警告,④根据人员异常情况开启防御设施,并通过安保监控模块监测并远程遥控勘探机器人根据情况监控或撤离。
本发明综合技术方案及综合效果包括:
本发明通过勘探机器与遥控监测中心实时处理控制,实现自主环境信息采集及地图构建、自主侦查与勘探、远程遥控地质样本智能采集、自主追踪能源采集、巡逻安防等功能。充分利用了SLAM组件、驱动力依存控制和能源智能采集,来保证勘探机器人的智能勘探与有效采样,显著提高了勘探机器人的能源利用和采集效率,确保本发明系统在野外尤其是恶劣环境下的油气勘探及安保作业,节省勘探人力物力资源。
附图说明
图1为本发明实施例智能勘探机器人系统及其检测方法中自主导航控制模块地图构建流程框图。
图2为本发明实施例智能勘探机器人系统及其检测方法中勘探机器人即时定位与地图构建状态(上)及其所构建地图(下)示意图,其中左上插图为构建状态时刻初步构建的地图示意图。
图3为本发明实施例智能勘探机器人系统机械臂与遥感机械手套控制流程框图。
图4为本发明实施例智能勘探机器人系统及其检测方法中勘探机器人行驶路径跟踪效率示意图。
图5为本发明实施例智能勘探机器人系统及其检测方法中勘探机器人运动相对偏差示意图。
图6为本发明实施例智能勘探机器人系统机械臂的机械指运动模型示意图。
图7为本发明实施例智能勘探机器人系统机械臂的机械指信息处理受力分析示意图。
图8本发明实施例智能勘探机器人系统及其检测方法中太阳能电池模组通过追日跟踪a相对于现有技术固定安装b输出功率对比曲线图。
图9本发明实施例智能勘探机器人系统及其检测方法中太阳能电池模组通过追日跟踪A相对于现有技术固定安装B的光伏电池输出功率与发电效率对比曲线图。
具体实施方式
以下结合附图和具体实施例,对本发明进行详细说明。
实施例
本实施例主要针对石油机器人存在的问题现状,设计发明了本智能石油勘探机器人系统及其勘探方法,其具有高集成度,能够自主完成勘探和安防任务,节约能源,对石油行业的节能减排具有显著的意义,
一种智能石油勘探机器人系统,其中,包括勘探机器人和遥控监测中心,所述勘探机器人包括自主导航模组、机械臂、信息传输模块和能源驱动模块;
所述自主导航控制模块包括采集环境信息的环境传感器和即时定位与地图构建(简称SLAM)组件,所述自主导航控制模块能够控制勘探机器人自主进行石油勘探的先遣侦查与返程导航;所述机械臂包括采样机构、采样控制模块和关节驱动电机,所述机械臂能够通过采样控制模块控制关节驱动电机的输出功率,驱动采样机构的夹持关节转动来抓取样本;所述能源驱动模块包括太阳能电池模组和驱动底盘,太阳能电池模组与驱动底盘供电连接,所述驱动底盘通过驱动控制模块控制行进驱动电机输出功率驱动勘探机器人运动;所述遥控监测中心设置有遥感机械手套,所述遥感机械手套通过信息传输模块与机械臂通讯连接,所述遥感机械手套内设置有体感传感器,能够采集人体手臂动作信息并传输至勘探机器人。
如图1-2所示,所述自主导航模组通过环境传感器获取并跟踪勘探机器人位姿,通过SLAM组件处理获得勘探机器人预走路线角度, SLAM组件利用路径跟踪算法对机器人预走路线进行跟踪。所述位姿优选包括勘探机器人的当前位置、转弯姿态以及运动速度。
所述SLAM组件优选利用GPS定位勘探机器人路径航向,并依据实时动态差分定位(简称RTK)获得厘米级定位精度,用于勘探机器人自主导航。
SLAM组件包括树莓派嵌入式模块、Ubuntu模块和机器人操作系统(简称ROS),ROS安装移植于Ubuntu模块中并嵌入树莓派嵌入式模块。
如图3所示,在所述机械臂中,所述采样机构包括具有若干机械指的机械手,机械指和机械手的手掌内设置有压力传感器和超声传感器。
进一步,在所述能源驱动模块中,所述驱动底盘包括框架式车架、双排履带和行进驱动电机。
进一步,所述勘探机器人的太阳能电池模组包括太阳能电池板、多向光敏电阻和旋转云台,多向光敏电阻安装于太阳能电池板的不同朝向位置,所述太阳能电池板通过旋转云台与驱动底座转动连接。优选的,在所述太阳能电池模组中,所述太阳能电池板的最大方位角为 360°,最大俯仰角为110°。
本发明还提供一种采用上述智能勘探机器人的石油勘探方法,所述自主导航控制模块的SLAM组件通过点到直线间的距离公式获得机器人的横向偏差大小,进而控制勘探机器人进行导航,具体地
①以勘探机器人的运动坐标系为xoy,由预定义路径中的直线和目标点在勘探机器人中的横纵坐标几何环境中形成直角三角形:
其中,XP为横坐标,YP为纵坐标,γ为转弯曲率,逆时针转弯γ>0,顺时针转弯γ<0,R为瞬时转弯的半径,d为横向位置误差,d L为纯路径跟踪的前视距离,ψ为航向偏差,为航向角变化大小;
②通过勘探机器人运动学模型获得勘探机器人的目标转角:
为机器人航向的变化率,L为机器人前后轴距,o为机器人前进速度,δ为机器人目标转角。
更优选的,所述自主导航控制模块还包括校验模块,通过路径跟踪效率η和相对偏差对勘探机器人路径跟踪曲线进行验证和校准,具体地
对比例
采用三种现有跟踪运动方法对本发明勘探机器人路径进行跟踪校正,如参考文献1-3中所述,其余部分与本实施例相同。其跟踪运动方法具体分别参考[1]《应用灰度直方图特征识别木材表面节子缺陷》、[2]《脉冲电容试验装置控制系统电磁兼容设计》和[3]《基于STM32的温室CO2浓度自动调控系统设计》。
如图4-5所示,通过本发明的校验模块可知,与参考文献1-3的对比例相比,本实施例方法所得勘探机器人路径跟踪曲线波动较缓,而且跟踪效率高,能够有效保证勘探机器人在侦查勘探及自主返程过程中按照路径行进,提高勘探效率并节省能源,保证了恶劣环境下的正常作业。
如图6-7所示,所述机械臂采样机构中,所述关节驱动电机采用直线驱动机构进行驱动,所述采样控制模块通过滑块-曲柄机构模型,将机械指两端设AB两点进行分析,对机械臂采样过程中的单指关节驱动和受力进行处理,从而得到机械臂全手力学性能,以对关节驱动电机进行反馈调节,具体地
MA+FLcosθ=0,
其中,F=m2为外力大小,θ为指节转过角度,L为连杆长度, MA为指节转动力矩;m为单指关节提升驱动量;
通过单指关节受力获得机械臂的全手驱动力,即Fmax=Fn=5F。
优选的,所述机械臂通过手掌内的压力传感器获取样品上顶量 m0,当m0>0,通过各指关节的压力传感器获取采样过程中受到样品的压力量m’,通过滑块-曲柄机构模型处理得到样品作用力F’n,与机械臂全手力驱动力Fn比较,进而对关节驱动电机进行输出功率调节。
本发明通过机械臂采样机构的智能控制,在保证完成遥控监测中心指令,将勘探采样样品抓取的前提下,合理调节输出功率,节省勘探机器人能源。
进一步,所述驱动控制模块根据行进驱动电机输出功率,通过对驱动底盘的驱动力分析,结合目标转角处理获得勘探机器人行进的校正速度,与自主导航控制模块获得的实际速度进行对比,当理论速度与实际速度的速度差值大于换挡阈值,则控制行进驱动电机进行换挡操作;所述驱动控制模块的行进理论速度处理流程包括:
v=vl(1-δ) (10),
其中,pq为驱动底盘履带驱动力;vl为理论速度;v为校正速度; Me为发动机转矩;I为各档传动比;ηe为机械效率;ne为发动机转速;rdq为驱动轮动力半径;I′为驱动轮滑转率(履带式为0.07)。
优选的,换挡阈值为速度差值占实际速度比值的30%。
进一步,所述太阳能电池模组通过多向光敏电阻进行各方向的光强度实时监测,当一侧光强高于另一侧光强时,控制旋转云台旋转太阳能电池板改变朝向,直至两侧方向的光敏电阻接收光强相同。
本发明通过太阳能电池模组在勘探机器人行进及采样过程中实时调整,实现了对太阳等光源的全方位跟踪,保证了机器人能源采集效率。
该实施例输出位姿数值解与实测值平均误差分别为1.8%、2.6%、0.84%,表明该机构跟踪太阳的精度较高。此外,该机构电机驱动能耗约为传统二轴跟踪机构的25%。
由图8-9可知,在11:00~14:00时间段里,太阳能电池模组追日自动跟踪的效率相比固定式提高不多,而在其他时刻电池板的发电效率平均提高28%~35%。
本实施例装置所载太阳能电池板功率为12w(约0.1m2),重量约为5斤,选用直流减速电机37GB520,额定功率10W;光敏传感器模块设有4个,工作电压3.3v,15mA。电机工作累计时间:设从早晨8时到下午6时,每30min调整一次,每次调整用时5s,则工作时间为100s,合计0.027h。则直流电机、光敏传感器日耗电量估算如下:
W1=10w×0.027h=0.27w·h;W2=3.3v×0.015A×10h×4=1.98wh
W=W1+W2=0.27w·h+1.98w·h=2.25w·h;
自动跟踪日增电量:W=12w×30%×10h=36w·h
由上述计算可得,日耗电量仅为日增电量的6.25%,显著节省能源,并进一步确保勘探的有序进行。
进一步,所述勘探机器人还包括所述巡逻安防模块;所述遥控监测中心还包括安保监控模块,巡逻安防流程包括:
①所述巡逻安防模块控制勘探机器人按照勘探路线巡逻,对人员异常情况进行检测处理并发送至安保监控模块,②所述巡逻安防模块通过激光雷达和深度摄像头对人体和面貌进行人员信息采集,通过安保监控模块定位分析,③检测到人员异常情况,发送报警信息到遥控监测中心,勘探机器人发出现场声音灯光警告,④根据人员异常情况开启防御设施,并通过安保监控模块监测并远程遥控勘探机器人根据情况监控或撤离。
应当理解的是,对本领域普通技术人员来说,可以根据上述说明加以改进或变换,而所有这些改进和变换都应属于本发明所附权利要求的保护范围。

Claims (10)

1.一种智能石油勘探机器人系统,其特征在于,包括勘探机器人和遥控监测中心,所述勘探机器人包括自主导航模组、机械臂、信息传输模块和能源驱动模块;
所述自主导航控制模块包括采集环境信息的环境传感器和即时定位与地图构建组件,所述自主导航控制模块能够控制勘探机器人自主进行石油勘探的先遣侦查与返程导航;
所述机械臂包括采样机构、采样控制模块和关节驱动电机,所述机械臂能够通过采样控制模块控制关节驱动电机的输出功率,驱动采样机构的夹持关节转动来抓取样本;
所述能源驱动模块包括太阳能电池模组和驱动底盘,太阳能电池模组与驱动底盘供电连接,所述驱动底盘通过驱动控制模块控制行进驱动电机输出功率驱动勘探机器人运动;
所述遥控监测中心设置有遥感机械手套,所述遥感机械手套通过信息传输模块与机械臂通讯连接,所述遥感机械手套内设置有体感传感器,能够采集人体手臂动作信息并传输至勘探机器人。
2.根据权利要求1所述的智能石油勘探机器人系统,其特征在于,所述自主导航模组通过环境传感器获取并跟踪勘探机器人位姿,通过SLAM组件处理获得勘探机器人预走路线角度,SLAM组件利用路径跟踪算法对机器人预走路线进行跟踪,所述位姿优选包括勘探机器人的当前位置、转弯姿态以及运动速度。
3.根据权利要求2所述的智能石油勘探机器人系统,其特征在于,所述SLAM组件利用GPS定位勘探机器人路径航向,并依据实时动态差分定位获得厘米级定位精度,用于勘探机器人自主导航,SLAM组件优选包括树莓派嵌入式模块、Ubuntu模块和机器人操作系统,ROS安装移植于Ubuntu模块中并嵌入树莓派嵌入式模块。
4.根据权利要求1所述的智能石油勘探机器人系统,其特征在于,在所述机械臂中,所述采样机构包括具有若干机械指的机械手,机械指和机械手的手掌内设置有超声传感器和压力传感器;
在所述能源驱动模块中所述驱动底盘优选包括框架式车架、双排履带和行进驱动电机。
5.根据权利要求1所述的智能石油勘探机器人系统,其特征在于,所述勘探机器人的太阳能电池模组包括太阳能电池板、多向光敏电阻和旋转云台,多向光敏电阻安装于太阳能电池板的不同朝向位置,所述太阳能电池板通过旋转云台与驱动底座转动连接,在所述太阳能电池模组中优选所述太阳能电池板的最大方位角为360°,最大俯仰角为110°。
6.一种采用如权利要求1-5中任一项所述智能勘探机器人系统进行石油勘探方法,其特征在于,所述自主导航控制模块的SLAM组件通过点到直线间的距离公式获得机器人的横向偏差大小,进而控制勘探机器人进行导航,具体处理步骤包括:
①以勘探机器人的运动坐标系为xoy,由预定义路径中的直线和目标点在勘探机器人中的横纵坐标几何环境中形成直角三角形:
其中,XP为横坐标,YP为纵坐标,γ为转弯曲率,逆时针转弯γ>0,顺时针转弯γ<0,R为瞬时转弯的半径,d为横向位置误差,dL为纯路径跟踪的前视距离,ψ为航向偏差,为航向角变化大小;
②通过勘探机器人运动学模型获得勘探机器人的目标转角:
为机器人航向的变化率,L为机器人前后轴距,o为机器人前进速度,δ为机器人目标转角;
所述自主导航控制模块优选还包括校验模块,通过路径跟踪效率η和相对偏差对勘探机器人路径跟踪曲线进行验证和校准,具体处理算法包括:
7.根据权利要求6所述的石油勘探方法,其特征在于,所述机械臂采样机构中,所述关节驱动电机采用直线驱动机构进行驱动,所述采样控制模块通过滑块-曲柄机构模型,将机械指两端设AB两点进行分析,对机械臂采样过程中的单指关节驱动和受力进行处理,从而得到机械臂全手力学性能,以对关节驱动电机进行反馈调节,具体处理算法包括:
∑FX=0,∑FY=0,∑M=0,即
MA+FLcosθ=0,
其中,F=m2为外力大小,θ为指节转过角度,L为连杆长度,MA为指节转动力矩;m为单指关节提升驱动量;
通过单指关节受力获得机械臂的全手驱动力,即Fmax=Fn=5F;
优选的,所述机械臂通过手掌内的压力传感器获取样品上顶量m0,当m0>0,通过各指关节的压力传感器获取采样过程中受到样品的压力量m’,通过滑块-曲柄机构模型处理得到样品作用力F’n,与机械臂全手力驱动力Fn比较,进而对关节驱动电机进行输出功率调节。
8.根据权利要求7所述的石油勘探方法,其特征在于,所述驱动控制模块根据行进驱动电机输出功率,通过对驱动底盘的驱动力分析,结合目标转角处理获得勘探机器人行进的校正速度,与自主导航控制模块获得的实际速度进行对比,当理论速度与实际速度的速度差值大于换挡阈值,则控制行进驱动电机进行换挡操作;所述驱动控制模块的行进理论速度处理流程包括:
v=vl(1-δ) (10),
其中,pq为驱动底盘履带驱动力;vl为理论速度;v为校正速度;Me为发动机转矩;I为各档传动比;ηe为机械效率;ne为发动机转速;rdq为驱动轮动力半径;I′为驱动轮滑转率;
换挡阈值优选为速度差值占实际速度比值的30%。
9.根据权利要求6所述的石油勘探方法,其特征在于,所述太阳能电池模组通过多向光敏电阻进行各方向的光强度实时监测,当一侧光强高于另一侧光强时,控制旋转云台旋转太阳能电池板改变朝向,直至两侧方向的光敏电阻接收光强相同。
10.根据权利要求6所述的石油勘探方法,其特征在于,所述勘探机器人还包括所述巡逻安防模块;所述遥控监测中心还包括安保监控模块,巡逻安防流程包括:
①所述巡逻安防模块控制勘探机器人按照勘探路线巡逻,对人员异常情况进行检测处理并发送至安保监控模块,②所述巡逻安防模块通过激光雷达和深度摄像头对人体和面貌进行人员信息采集,通过安保监控模块定位分析,③检测到人员异常情况,发送报警信息到遥控监测中心,勘探机器人发出现场声音灯光警告,④根据人员异常情况开启防御设施,并通过安保监控模块监测并远程遥控勘探机器人根据情况监控或撤离。
CN201810913307.9A 2018-08-13 2018-08-13 一种采用智能石油勘探机器人系统的石油勘探方法 Active CN109029473B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201810913307.9A CN109029473B (zh) 2018-08-13 2018-08-13 一种采用智能石油勘探机器人系统的石油勘探方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201810913307.9A CN109029473B (zh) 2018-08-13 2018-08-13 一种采用智能石油勘探机器人系统的石油勘探方法

Publications (2)

Publication Number Publication Date
CN109029473A true CN109029473A (zh) 2018-12-18
CN109029473B CN109029473B (zh) 2019-08-23

Family

ID=64632857

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201810913307.9A Active CN109029473B (zh) 2018-08-13 2018-08-13 一种采用智能石油勘探机器人系统的石油勘探方法

Country Status (1)

Country Link
CN (1) CN109029473B (zh)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109490986A (zh) * 2018-12-28 2019-03-19 西安长庆科技工程有限责任公司 一种远程控制式勘察装置及方法
CN112817061A (zh) * 2021-01-13 2021-05-18 陕西奇力达电子科技有限公司 一种地埋电缆路径探测装置
CN115903621A (zh) * 2022-12-21 2023-04-04 青岛杰瑞自动化有限公司 石油勘探机器人智能安保控制方法及其系统、电子设备

Citations (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102039589A (zh) * 2009-10-16 2011-05-04 李路 模块化的灾害救援机器人
CN103895022A (zh) * 2014-03-17 2014-07-02 东南大学 穿戴式体感控制机械手
CN104216406A (zh) * 2013-06-05 2014-12-17 中国石油天然气集团公司 一种四轮驱动全向底盘的控制装置及控制方法
US20160184990A1 (en) * 2014-12-26 2016-06-30 National Chiao Tung University Robot and control method thereof
CN106249742A (zh) * 2016-09-28 2016-12-21 济南大学 基于激光雷达检测实现机器人垄行识别引导的方法及系统
CN205942328U (zh) * 2016-07-30 2017-02-08 重庆峰创科技有限公司 基于物联网的石油勘探智能机器人监控系统
CN106393088A (zh) * 2016-09-27 2017-02-15 成都普诺思博科技有限公司 一种机械手
CN106584451A (zh) * 2015-10-14 2017-04-26 山东鲁能智能技术有限公司 一种基于视觉导航的变电站自动构图机器人及方法
CN107463173A (zh) * 2017-07-31 2017-12-12 广州维绅科技有限公司 仓储agv导航方法及装置、计算机设备及存储介质
CN107521577A (zh) * 2017-07-03 2017-12-29 昆明理工大学 一种紧急救援物资运输机器人
CN108177149A (zh) * 2018-02-08 2018-06-19 苏州融萃特种机器人有限公司 基于mr和运动规划技术的可移动机械臂控制系统及方法
CN108222093A (zh) * 2018-01-02 2018-06-29 清华大学 一种自主推土机器人

Patent Citations (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102039589A (zh) * 2009-10-16 2011-05-04 李路 模块化的灾害救援机器人
CN104216406A (zh) * 2013-06-05 2014-12-17 中国石油天然气集团公司 一种四轮驱动全向底盘的控制装置及控制方法
CN103895022A (zh) * 2014-03-17 2014-07-02 东南大学 穿戴式体感控制机械手
US20160184990A1 (en) * 2014-12-26 2016-06-30 National Chiao Tung University Robot and control method thereof
CN106584451A (zh) * 2015-10-14 2017-04-26 山东鲁能智能技术有限公司 一种基于视觉导航的变电站自动构图机器人及方法
CN205942328U (zh) * 2016-07-30 2017-02-08 重庆峰创科技有限公司 基于物联网的石油勘探智能机器人监控系统
CN106393088A (zh) * 2016-09-27 2017-02-15 成都普诺思博科技有限公司 一种机械手
CN106249742A (zh) * 2016-09-28 2016-12-21 济南大学 基于激光雷达检测实现机器人垄行识别引导的方法及系统
CN107521577A (zh) * 2017-07-03 2017-12-29 昆明理工大学 一种紧急救援物资运输机器人
CN107463173A (zh) * 2017-07-31 2017-12-12 广州维绅科技有限公司 仓储agv导航方法及装置、计算机设备及存储介质
CN108222093A (zh) * 2018-01-02 2018-06-29 清华大学 一种自主推土机器人
CN108177149A (zh) * 2018-02-08 2018-06-19 苏州融萃特种机器人有限公司 基于mr和运动规划技术的可移动机械臂控制系统及方法

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109490986A (zh) * 2018-12-28 2019-03-19 西安长庆科技工程有限责任公司 一种远程控制式勘察装置及方法
CN109490986B (zh) * 2018-12-28 2024-03-01 西安长庆科技工程有限责任公司 一种远程控制式勘察装置及方法
CN112817061A (zh) * 2021-01-13 2021-05-18 陕西奇力达电子科技有限公司 一种地埋电缆路径探测装置
CN112817061B (zh) * 2021-01-13 2022-06-14 陕西奇力达电子科技有限公司 一种地埋电缆路径探测装置
CN115903621A (zh) * 2022-12-21 2023-04-04 青岛杰瑞自动化有限公司 石油勘探机器人智能安保控制方法及其系统、电子设备
CN115903621B (zh) * 2022-12-21 2023-12-12 青岛杰瑞自动化有限公司 石油勘探机器人智能安保控制方法及其系统、电子设备

Also Published As

Publication number Publication date
CN109029473B (zh) 2019-08-23

Similar Documents

Publication Publication Date Title
CN109029473B (zh) 一种采用智能石油勘探机器人系统的石油勘探方法
CN105487545A (zh) 基于高强度弹簧压壁装置的螺旋轮式驱动管道机器人系统
CN105856234B (zh) 一种三核两轴履带式高速天然气管道机器人控制系统
CN105881537A (zh) 一种三核四轴履带式高速天然气管道机器人控制系统
CN105856237B (zh) 无线传输三核四轴履带式高速天然气管道机器人控制系统
CN110757466B (zh) 基于stm32的矿井勘测机器人控制系统
CN106094617A (zh) 无线传输三核八轴履带式高速天然气管道机器人控制系统
CN105856236B (zh) 无线传输四核四轴履带式快速天然气管道机器人控制系统
CN105856239B (zh) 一种三核八轴履带式高速天然气管道机器人控制系统
CN109426253A (zh) 一种远距离定区域风帆无人船的控制方法及系统
CN105856238B (zh) 四核六轴无线传输履带式快速天然气管道机器人控制系统
CN105922260B (zh) 一种两核两轴履带式天然气管道机器人控制系统
CN109752957A (zh) 一种无人艇的制导指令调节器结构及设计方法
CN106078735A (zh) 一种三核六轴履带式高速天然气管道机器人控制系统
CN106368699A (zh) 一种以自动割煤为主远程干预为辅的采煤机采煤控制方法
CN103399327A (zh) 一种基于北斗系统的卫星信号寻优系统及方法
CN105922263A (zh) 一种两核六轴履带式天然气管道机器人控制系统
CN105953026B (zh) 一种三核两轴履带式快速天然气管道机器人控制系统
CN105945951A (zh) 一种三核八轴履带式快速天然气管道机器人控制系统
CN106078737A (zh) 无线传输四核十轴履带式快速天然气管道机器人控制系统
CN105881538B (zh) 一种三核六轴履带式快速天然气管道机器人控制系统
CN105922259B (zh) 一种三核四轴履带式快速天然气管道机器人控制系统
CN109853662A (zh) 一种挖掘机械的多功能控制系统
Yongcan et al. Key technology of underwater inspection robot system for large diameter and long headrace tunnel
CN105922264B (zh) 无线传输四核八轴履带式快速天然气管道机器人控制系统

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant
CB03 Change of inventor or designer information
CB03 Change of inventor or designer information

Inventor after: Chen Liang

Inventor after: Fan Xiaoxi

Inventor before: Chen Liang

TR01 Transfer of patent right
TR01 Transfer of patent right

Effective date of registration: 20230328

Address after: 266000 No. 2902, floor 29, unit 1, building 2, No. 666, Jiangshan South Road, Huangdao District, Qingdao, Shandong Province

Patentee after: Qingdao Future Education Technology Co.,Ltd.

Address before: 266000 No. 66 Changjiang West Road, Huangdao District, Qingdao City, Shandong Province

Patentee before: CHINA University OF PETROLEUM (EAST CHINA)