CN114995418A - 一种水上机器人路线规划方法 - Google Patents
一种水上机器人路线规划方法 Download PDFInfo
- Publication number
- CN114995418A CN114995418A CN202210607159.4A CN202210607159A CN114995418A CN 114995418 A CN114995418 A CN 114995418A CN 202210607159 A CN202210607159 A CN 202210607159A CN 114995418 A CN114995418 A CN 114995418A
- Authority
- CN
- China
- Prior art keywords
- water
- robot
- route
- falling
- coordinate
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 15
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 claims abstract description 101
- 238000012216 screening Methods 0.000 claims abstract description 4
- 206010013647 Drowning Diseases 0.000 claims description 12
- 238000001514 detection method Methods 0.000 claims description 9
- 238000004891 communication Methods 0.000 claims description 6
- 238000012790 confirmation Methods 0.000 claims description 3
- 238000012545 processing Methods 0.000 claims description 3
- 230000004888 barrier function Effects 0.000 description 6
- 230000000903 blocking effect Effects 0.000 description 2
- 238000004140 cleaning Methods 0.000 description 2
- 230000003111 delayed effect Effects 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 239000002699 waste material Substances 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/0206—Control of position or course in two dimensions specially adapted to water vehicles
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Manipulator (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明涉及一种水上机器人路线规划方法,S1,在水域的一周采集路线并在路线上每间隔一段标记转弯点;S2,获取水上机器人当前位置坐标信息记为位置1;计算并确定距离当前位置最近的转弯点的位置记为位置2;识别落水人员,确定落水人员的坐标记为位置3;计算落水人员坐标点与转弯点之间的距离,筛选出距离落水人员坐标点最近的转弯点记为位置4;S3,形成路线,水上机器人从位置1到位置2,从位置2沿采集的路线到位置4,从位置4到位置3。当有人员落水时,通过规划的路径能够更快速的到达人员落水位置,同时能够减少工作人员的参与,节省人力,而且水上机器人能够不间断的对水面上的落水目标进行救援,节省人力。
Description
技术领域
本发明涉及水上救援领域,具体涉及一种水上机器人路线规划方法。
背景技术
目前的水面救援的方式都比较传统,一般是救援人员接到求救去营救或者是溺水者主动去求救,这些都是基于被动的求救,往往会耽误救援时间,延误救援时间。水上机器人能够停留在水上随时待命,当出现落水人员是能够及时的展开救援,但是现有的水上机器人通常是由人控制对落水人员进行救援,需要对设备的操作人员进行培训,并且浪费人力,即使是自动救援的水上救援机器人一般是采用直线运行的方式对落水人员进行救援,在水面中间有障碍物的情况下,采用机器人频繁的转弯会浪费时间。
发明内容
本发明的目的是提供一种水上机器人路线规划方法,以解决在水面中间有障碍物的情况下,采用机器人频繁的转弯会浪费时间的的问题。
为实现上述目的,本发明采用如下技术方案:
一种水上机器人路线规划方法,S1,在水域的一周采集路线并在路线上每间隔一段标记转弯点;S2,获取水上机器人当前位置坐标信息记为位置1;计算并确定距离当前位置最近的转弯点的位置记为位置2;识别落水人员,确定落水人员的坐标记为位置3;计算落水人员坐标点与转弯点之间的距离,筛选出距离落水人员坐标点最近的转弯点记为位置4;S3,形成路线,水上机器人从位置1到位置2,从位置2沿采集的路线到位置4,从位置4到位置3。
进一步地,确定位置2到位置4的具体线路;
S4,对比位置2到位置4顺时针运动和逆时针运动时的走过的路程;
S5,选择较近的路线,定为行驶路线。
进一步地,当筛选出距离落水人员坐标点最近的转弯点的数量至少为两个时,选择距离位置1最近的转弯点。
进一步地,当筛选出距离水上机器人坐标点最近的转弯点的数量至少为两个时,选择距离位置4最近的转弯点。
进一步地,包括水上机器人、落水检测模组和数据中心;
所述水上机器人上设有定位模块和通讯模块,所述定位模块实时获取坐标信息,所述通讯模块用于将所述坐标信息发送到数据中心;
所述落水检测模组用于识别落水人员,并确定落水人员的坐标;
所述数据中心用于处理所述水上机器人和落水检测模组发送过来的信息。
进一步地,当判断需要水上机器人救援时,发送确认信息由所述数据中心确认。
进一步地,还包括蜂鸣器,蜂鸣器用于提示落水人员水上机器人的位置。
进一步地,水上机器人上固定有距离传感器,距离传感器用于检测障碍物。
本发明的有益效果:
通过本发明中的方法,当有人员落水时,落水位置距离岸边一般比较近,通过规划的路径能够更快速的到达人员落水位置,避免了水中间的障碍物对水上机器人的阻碍,对路径的进行合理的规划,最大限度地节约了救援的时间。同时能够减少工作人员的参与,而且水上机器人能够在水面上的障碍物发生变化的情况下(垃圾清理船等移动障碍物),及时的救援。
附图说明
图1是一种水上机器人路线规划方法的流程图。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述。
本发明的实施例:
一种水上机器人路线规划***,包括水上机器人、落水检测模组和数据中心;水上机器人上设有定位模块和通讯模块,定位模块实时获取坐标信息,通讯模块用于将坐标信息发送到数据中心;
落水检测模组用于识别落水人员,并确定落水人员的坐标,具体的识别落水人员的方法是现有技术,在这里不再赘述,确定落水人员坐标的方法在申请公布号为CN113903163A的专利中公布,在这里不再赘述;
数据中心用于处理水上机器人和落水检测模组发送过来的信息。
一种水上机器人路线规划方法,S1,在水域的一周采集路线并在路线上每间隔一段标记转弯点;S2,获取水上机器人当前位置坐标信息记为位置1;计算并确定距离当前位置最近的转弯点的位置记为位置2;识别落水人员,确定落水人员的坐标记为位置3;计算落水人员坐标点与转弯点之间的距离,筛选出距离落水人员坐标点最近的转弯点记为位置4;S3,形成路线,水上机器人从位置1到位置2,从位置2到位置4,从位置4到位置3。
位置2到位置4时沿S1中采集的线路进行运动,确定位置2到位置4的具体线路;S4,对比位置2到位置4顺时针运动和逆时针运动时的走过的路程;S5,选择较近的路线,定为行驶路线。
当有人员失足落水时,落水位置距离岸边一般比较近,通过规划的路径能够更快速的到达人员落水位置,避免了水中间的障碍物对水上机器人的阻碍,对路径的进行合理的规划,最大限度地节约了救援的时间。同时能够减少工作人员的参与,而且水上机器人能够在水面上的障碍物发生变化的情况下(垃圾清理船等移动障碍物),及时的救援。
当筛选出距离落水人员坐标点最近的转弯点的数量至少为两个时,选择距离位置1最近的转弯点。
当筛选出距离水上机器人坐标点最近的转弯点的数量至少为两个时,选择距离位置4最近的转弯点。
当判断需要水上机器人救援时,发送确认信息由数据中心确认。确实是否确实是人员落水,并观察落水的情况,当观察到落水人员的情况复杂时,能够采取报警等措施。
还包括蜂鸣器,蜂鸣器用于提示落水人员水上机器人的位置。当水上机器人靠近落水人员时,落水人员能够通过蜂鸣器确定水上机器人的位置,从而抓住水上机器人。
水上机器人上固定有距离传感器,距离传感器用于检测障碍物,当距离传感器检测到在运行路线上有障碍时,水上机器人采用后退和转弯的方式避开障碍物。
本发明不局限于上述最佳实施方式,任何人在本发明的启示下都可得出其他各种形式的产品,但不论在其形状或结构上作任何变化,凡是具有与本申请相同或相近似的技术方案,均落在本发明的保护范围之内。
Claims (8)
1.一种水上机器人路线规划方法,其特征在于,
S1,在水域的一周采集路线并在路线上每间隔一段标记转弯点;
S2,获取水上机器人当前位置坐标信息记为位置1;计算并确定距离当前位置最近的转弯点的位置记为位置2;识别落水人员,确定落水人员的坐标记为位置3;计算落水人员坐标点与转弯点之间的距离,筛选出距离落水人员坐标点最近的转弯点记为位置4;
S3,形成路线,水上机器人从位置1到位置2,从位置2沿采集的路线到位置4,从位置4到位置3。
2.根据权利要求2所述的一种水上机器人路线规划方法,其特征在于,确定位置2到位置4的具体线路;
S4,对比位置2到位置4顺时针运动和逆时针运动时走过的路程;
S5,选择较近的路线,定为行驶路线。
3.根据权利要求1所述的一种水上机器人路线规划方法,其特征在于,当筛选出距离落水人员坐标点最近的转弯点的数量至少为两个时,选择距离位置1最近的转弯点。
4.根据权利要求1所述的一种水上机器人路线规划方法,其特征在于,当筛选出距离水上机器人坐标点最近的转弯点的数量至少为两个时,选择距离位置4最近的转弯点。
5.一种水上机器人路线规划***,其特征在于,包括水上机器人、落水检测模组和数据中心;
所述水上机器人上设有定位模块和通讯模块,所述定位模块实时获取坐标信息,所述通讯模块用于将所述坐标信息发送到数据中心;
所述落水检测模组用于识别落水人员,并确定落水人员的坐标;
所述数据中心用于处理所述水上机器人和落水检测模组发送过来的信息。
6.根据权利要求6所述的一种水上机器人路线规划***,其特征在于,当判断需要水上机器人救援时,发送确认信息由所述数据中心确认。
7.根据权利要求6所述的一种水上机器人路线规划***,其特征在于,还包括蜂鸣器,蜂鸣器用于提示落水人员水上机器人的位置。
8.根据权利要求6所述的一种水上机器人路线规划***,其特征在于,水上机器人上固定有距离传感器,距离传感器用于检测障碍物。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210607159.4A CN114995418B (zh) | 2022-05-31 | 2022-05-31 | 一种水上机器人路线规划方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210607159.4A CN114995418B (zh) | 2022-05-31 | 2022-05-31 | 一种水上机器人路线规划方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114995418A true CN114995418A (zh) | 2022-09-02 |
CN114995418B CN114995418B (zh) | 2023-10-20 |
Family
ID=83031230
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210607159.4A Active CN114995418B (zh) | 2022-05-31 | 2022-05-31 | 一种水上机器人路线规划方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114995418B (zh) |
Citations (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20130048990A (ko) * | 2011-11-03 | 2013-05-13 | 경희대학교 산학협력단 | 인명 구조 로봇 |
CN103455811A (zh) * | 2013-09-04 | 2013-12-18 | 百度在线网络技术(北京)有限公司 | 室内无线定位指纹采集方法及*** |
CN105717929A (zh) * | 2016-04-29 | 2016-06-29 | 中国人民解放军国防科学技术大学 | 一种多分辨率障碍物环境下移动机器人混合路径规划方法 |
CN107340774A (zh) * | 2017-07-25 | 2017-11-10 | 大连海事大学 | 一种基于船上人员落水的应急操纵辅助*** |
CN108287544A (zh) * | 2018-01-16 | 2018-07-17 | 中国科学院福建物质结构研究所 | 一种智能机器人路线规划及沿原路径返回的方法及*** |
GB201905236D0 (en) * | 2019-04-12 | 2019-05-29 | Thales Holdings Uk Plc | A system and method of planning a path for an autonomous vessel |
CN110579768A (zh) * | 2019-08-30 | 2019-12-17 | 中国南方电网有限责任公司超高压输电公司贵阳局 | 一种固定翼无人机载激光雷达电力巡线航线设计方法 |
CN111522353A (zh) * | 2020-06-05 | 2020-08-11 | 深圳市道通智能航空技术有限公司 | 一种无人机制导方法、无人机及存储介质 |
CN111653128A (zh) * | 2020-06-02 | 2020-09-11 | 中国电子科技集团公司第三十六研究所 | 一种基于北斗高精度定位的运河航道智能导航*** |
CN113192293A (zh) * | 2021-06-01 | 2021-07-30 | 福建省新能海上风电研发中心有限公司 | 一种海上风电作业人员落水警报方法及终端 |
CN113867337A (zh) * | 2021-09-14 | 2021-12-31 | 武汉理工大学 | 一种用于海事搜救的编队路径规划方法及*** |
CN113903163A (zh) * | 2021-10-09 | 2022-01-07 | 郑州北斗七星通讯科技有限公司 | 一种水域安全***及水域救生方法 |
-
2022
- 2022-05-31 CN CN202210607159.4A patent/CN114995418B/zh active Active
Patent Citations (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20130048990A (ko) * | 2011-11-03 | 2013-05-13 | 경희대학교 산학협력단 | 인명 구조 로봇 |
CN103455811A (zh) * | 2013-09-04 | 2013-12-18 | 百度在线网络技术(北京)有限公司 | 室内无线定位指纹采集方法及*** |
CN105717929A (zh) * | 2016-04-29 | 2016-06-29 | 中国人民解放军国防科学技术大学 | 一种多分辨率障碍物环境下移动机器人混合路径规划方法 |
CN107340774A (zh) * | 2017-07-25 | 2017-11-10 | 大连海事大学 | 一种基于船上人员落水的应急操纵辅助*** |
CN108287544A (zh) * | 2018-01-16 | 2018-07-17 | 中国科学院福建物质结构研究所 | 一种智能机器人路线规划及沿原路径返回的方法及*** |
GB201905236D0 (en) * | 2019-04-12 | 2019-05-29 | Thales Holdings Uk Plc | A system and method of planning a path for an autonomous vessel |
CN110579768A (zh) * | 2019-08-30 | 2019-12-17 | 中国南方电网有限责任公司超高压输电公司贵阳局 | 一种固定翼无人机载激光雷达电力巡线航线设计方法 |
CN111653128A (zh) * | 2020-06-02 | 2020-09-11 | 中国电子科技集团公司第三十六研究所 | 一种基于北斗高精度定位的运河航道智能导航*** |
CN111522353A (zh) * | 2020-06-05 | 2020-08-11 | 深圳市道通智能航空技术有限公司 | 一种无人机制导方法、无人机及存储介质 |
CN113192293A (zh) * | 2021-06-01 | 2021-07-30 | 福建省新能海上风电研发中心有限公司 | 一种海上风电作业人员落水警报方法及终端 |
CN113867337A (zh) * | 2021-09-14 | 2021-12-31 | 武汉理工大学 | 一种用于海事搜救的编队路径规划方法及*** |
CN113903163A (zh) * | 2021-10-09 | 2022-01-07 | 郑州北斗七星通讯科技有限公司 | 一种水域安全***及水域救生方法 |
Non-Patent Citations (1)
Title |
---|
何燕;: "基于动态加权A~*算法的无人机航迹规划", 河北科技大学学报, no. 04 * |
Also Published As
Publication number | Publication date |
---|---|
CN114995418B (zh) | 2023-10-20 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US8674854B2 (en) | Traffic control apparatus and method using navigation route information of vehicle for each navigational situation | |
US20040193367A1 (en) | Method and system for marine vessel tracking system | |
CN100576284C (zh) | 航道运输调度方法 | |
CN104916166A (zh) | 一种桥梁防撞预警***及实现方法 | |
WO2012136672A1 (en) | A collision avoiding method and associated system | |
CN109144060A (zh) | 一种船舶航线的危险识别方法及*** | |
CN103985255B (zh) | 利用雷达跟踪技术精准判断行车道异常停车的***及方法 | |
CN107798914A (zh) | 自动车辆交叉车流检测*** | |
CN110045669A (zh) | 一种船舶航行状态监控及报警*** | |
CN110060281B (zh) | 一种船舶及水上漂浮物轨迹追踪*** | |
KR20170033174A (ko) | 선박 안전 관리 방법, 이를 수행하는 선박 안전 관리 장치 및 선박 안전 관리 시스템 | |
JP2023506870A (ja) | 軌道車両のポジションを求める方法および監視システム | |
CN115855065B (zh) | 航路动态规划方法及***、可读存储介质 | |
CN109703456A (zh) | 一种防止汽车碰撞的警示方法、装置及汽车控制器 | |
CN109099934A (zh) | 一种基于标识的天气预报导航*** | |
CN106980317A (zh) | 一种水下路障躲避方法和*** | |
CN109445445A (zh) | 一种多艇协同控制*** | |
AU2022252739A1 (en) | Obstruction detection system | |
US9164514B1 (en) | Cooperative perimeter patrol system and method | |
CN209087160U (zh) | 基于激光扫描的桥梁防撞监测装置 | |
JP2006039698A (ja) | 車両用物体検知装置 | |
CN114995418A (zh) | 一种水上机器人路线规划方法 | |
CN109461328A (zh) | 基于激光扫描的桥梁防撞监测装置 | |
CN113077659B (zh) | 一种基于多源数据融合的桥梁防船撞智能预警方法及*** | |
WO2021187244A1 (ja) | 移動体監視システム、異常検知方法およびプログラム |
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 |