[发明专利]一种采用智能石油勘探机器人系统的石油勘探方法

摘要

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

主权项

1.一种采用智能石油勘探机器人系统的石油勘探方法，其特征在于，智能石油勘探机器人系统包括勘探机器人和遥控监测中心，所述勘探机器人包括自主导航控制模块、机械臂、信息传输模块和能源驱动模块；所述自主导航控制模块包括采集环境信息的环境传感器和SLAM组件，所述自主导航控制模块能够控制勘探机器人自主进行石油勘探的先遣侦查与返程导航；所述机械臂包括采样机构、采样控制模块和关节驱动电机，所述机械臂能够通过采样控制模块控制关节驱动电机的输出功率，驱动采样机构的夹持关节转动来抓取样本；所述能源驱动模块包括太阳能电池模组和驱动底盘，太阳能电池模组与驱动底盘供电连接，所述驱动底盘通过驱动控制模块控制行进驱动电机输出功率驱动勘探机器人运动；所述遥控监测中心设置有遥感机械手套，所述遥感机械手套通过信息传输模块与机械臂通讯连接，所述遥感机械手套内设置有体感传感器，能够采集人体手臂动作信息并传输至勘探机器人；所述自主导航控制模块的SLAM组件通过点到直线间的距离公式获得机器人的横向偏差大小，进而控制勘探机器人进行导航，具体处理步骤包括：①以勘探机器人的运动坐标系为xoy，由预走路线中的直线和目标点在勘探机器人所处的横纵坐标几何环境中形成直角三角形：其中，X_P为横坐标，Y_P为纵坐标，γ为转弯曲率，逆时针转弯γ＞0，顺时针转弯γ＜0，d为横向位置误差，L_d为纯路径跟踪的前视距离，ψ为机器人航向偏差；②通过勘探机器人运动学模型获得勘探机器人的目标转角：为机器人航向的变化率，L为机器人前后轴距，o为机器人前进速度，δ为机器人目标转角。