【技术实现步骤摘要】
一种水面机器人的卡位检测和脱困方法及其装置
[0001]本专利技术涉及水面机器人的卡位
，尤其是指一种水面机器人的卡位 检测和脱困方法及其装置。
技术介绍
[0002]近年来，随着无人驾驶技术的迅猛发展，无人驾驶市场不断增长，以无人 船为例，各种水面机器人逐渐被推广至水质检测、水面维护、桥梁检测、水体 测绘、海事搜救等多种作业场景下，用于辅助人们工作。无人船进行有效作业 的前提是要保证稳定的工作，一般无人驾驶传感器往往能有效探测到水面上的 环境信息进行有效避障，对于水下障碍无法实现有效探测与规避。大型船舶往 往会装备声呐进行水下探测，但此类传感器专业性强，价格昂贵，不利于小型 水面船舶使用。
技术实现思路
[0003]本专利技术的目的在于克服现有技术的不足，提供一种水面机器人的卡位检测 和脱困方法及其装置。
[0004]为了解决上述技术问题，本专利技术采用如下技术方案：
[0005]一种水面机器人的卡位检测和脱困方法，包括以下步骤：
[0006]获取水面机器人航行过程中的航行数据...
【技术保护点】
【技术特征摘要】
1.一种水面机器人的卡位检测和脱困方法，其特征在于，包括以下步骤：获取水面机器人航行过程中的航行数据；对航行数据进行滤波处理，以得到处理数据；判断处理数据中的加速度数据是否超过该运动状态下的对应值；若超过，则判断速度数据是否低于当前油门的对应值；若低于，则水面机器人出现卡位，触发脱困指令；根据脱困指令，检测得到水面机器人的卡位方向；根据水面机器人的尺寸和卡位方向建立虚拟障碍坐标系，然后将虚拟障碍从虚拟障碍坐标系变换到绝对坐标系下，以得到虚拟障碍的绝对坐标，并在卡位时刻通过定位系统测量得到卡位位置的绝对坐标；根据虚拟障碍的绝对坐标和卡位位置的绝对坐标，按照预定动作库水面机器人执行预定动作，以得到当前位置坐标；判断当前位置坐标与卡位位置的绝对坐标之间的距离值是否大于设定距离值；若是，则水面机器人脱困成功。2.根据权利要求1所述的一种水面机器人的卡位检测和脱困方法，其特征在于，所述获取水面机器人航行过程中的航行数据步骤之前，还包括：完成水面机器人的动力标定。3.根据权利要求2所述的一种水面机器人的卡位检测和脱困方法，其特征在于，所述完成水面机器人的动力标定包括：设定特定的航路段，使得船只完成设定动作，通过遥控或自主的方式使得船只依次完成所述设定动作，同时利用船载惯导记录船只运行数据，对所述船只运行数据进行数据清洗和低通滤波，以得到数据清洗结果，根据所述数据清洗结果得到船只运动过程的稳态数据，然后更改控制油门输入若干次，以得到最终标定表，即船只动力标定。4.根据权利要求1所述的一种水面机器人的卡位检测和脱困方法，其特征在于，所述对航行数据进行滤波处理，以得到处理数据步骤中，对航行数据进行重力抵消和高频噪声滤波处理，以得到处理数据。5.根据权利要求1所述的一种水面机器人的卡位检测和脱困方法，其特征在于，所述若是，则水面机器人脱困成功步骤之后，还包括：当水面机器人后续航行时，实时检测当前位置与虚拟障碍的绝对坐标的距离，若距离小于水面机器人长度的2
‑
3倍，且船艏正对虚拟障碍时则进行避障操作。6.一种水面机器人的卡位检测和脱困装置，其特征在于，包括：获取单元，...
【专利技术属性】
技术研发人员：程宇威，朱健楠，王培栋，池雨豪，虞梦苓，
申请(专利权)人：陕西欧卡电子智能科技有限公司，
类型：发明
国别省市：
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。