CN105629976B - 一种水产养殖作业船自动导航路径跟踪方法 - Google Patents

一种水产养殖作业船自动导航路径跟踪方法 Download PDF

Info

Publication number
CN105629976B
CN105629976B CN201610095261.5A CN201610095261A CN105629976B CN 105629976 B CN105629976 B CN 105629976B CN 201610095261 A CN201610095261 A CN 201610095261A CN 105629976 B CN105629976 B CN 105629976B
Authority
CN
China
Prior art keywords
mrow
msub
ship
operation ship
speed
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.)
Active
Application number
CN201610095261.5A
Other languages
English (en)
Other versions
CN105629976A (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.)
Changzhou huierda Intelligent Equipment Co.,Ltd.
Original Assignee
Jiangsu University
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 Jiangsu University filed Critical Jiangsu University
Priority to CN201610095261.5A priority Critical patent/CN105629976B/zh
Priority to PCT/CN2016/075946 priority patent/WO2017143631A1/zh
Publication of CN105629976A publication Critical patent/CN105629976A/zh
Application granted granted Critical
Publication of CN105629976B publication Critical patent/CN105629976B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

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
    • 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

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)
  • Navigation (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

本发明公开了一种水产养殖作业船自动导航路径跟踪方法。该方法包括以下步骤：第一步：采集反映作业区轮廓的角点的位置信息，经轨迹规划，得到作业船的目标航线和航速；第二步：采集作业船实时的位置、航向和航速等数据，设定作业船的航行速度并判断是否需要切换目标路径；第三步：采用实时插点的方法计算出作业船的跟踪目标点；第四步：将作业船的位姿和运动状态数据与跟踪目标点及目标路径进行对比分析，得到航向与航速偏差，通过PD、PI算法得出航向与航速控制量，最终得到左右明轮控制量；第五步：根据最终的控制量对作业船进行实时导航控制。本发明能显著提高自动导航路径跟踪的效果，为水草清理和均匀投饵作业的高效完成提供了保障。

Description

一种水产养殖作业船自动导航路径跟踪方法
技术领域
本发明涉及自动导航路径跟踪领域，特别是河蟹养殖用水产养殖作业船的自动导航路径跟踪。
背景技术
我国是河蟹养殖大国，而河蟹养殖过程中主要存在着水草清理和均匀投饵两大难题。水草是河蟹喜食的饵料，同时也是河蟹的栖身场所，水草可以通过光合作用增氧，还可以吸收水中的营养盐，改善水体质量，防止水体富营养化。然而，若不及时对水草进行清理，露出水面的水草会阻碍空气中的氧气进入水体，腐烂的水草会过多地消耗水中的溶氧，导致池塘底质、水质的恶化；同时，由于河蟹的活动范围有限，只能在自身附近区域觅食，饵料的投放不均会导致局部饵料过多或过少，饵料过多时会导致浪费、增加养殖的成本，饵料过少时又容易引起河蟹因抢食而相互残杀。因此，用于水草清理或均匀投饵作业的水产养殖自动作业船具有重要的实用价值。水产养殖作业船导航控制系统中，船体的路径跟踪控制方法是其中的关键环节，能否控制船体严格按照设定路径航行会直接地影响到水草清理的效率和饵料投放的均匀度，一种简单、高效的路径跟踪方法可以增强导航控制系统的实时性，提高水产养殖作业船的工作效率。
目前已有一些自动导航路径跟踪方法，但都存在着一些不足，如申请号为200910082462.1的专利“农业机械的导航方法、导航装置和农业机械”根据农业机械的两轮运动学模型以及最优控制理论中的最小时间问题计算获得农业机械的预期路径信息，其计算量大、实时性不高；申请号为200710029018.4的专利“一种农业机械的导航控制方法”需要通过测量多个等间距的目标点来确定行进路线并通过查表的方法进行导航跟踪，实际操作过程复杂，灵活性差，很难达到较高的精度。
发明内容
本发明的目的是为了解决现有的农业机械导航控制方法复杂、路径跟踪效果不理想的问题，使作业船能精确按照设定路径航行，提高水草清理的效率以及投饵的均匀度。本发明所涉及的水产养殖适用于各种鱼、虾、蟹等水产品。
本发明为解决上述问题，采用的技术方案包含以下步骤：
第一步：使用基于RTK模式的高精度GPS系统采集能反映目标作业区轮廓的各个角点的经纬度坐标，经轨迹规划，得到作业船的目标航线和航速，并确定起始目标路径；
第二步：通过基于RTK模式的高精度GPS系统以及惯导模块采集得到作业船当前的位置、航向和航速等位姿和运动状态数据，设定作业船的航行速度并判断是否需要进行目标路径切换；
第三步：采用实时插点的方法计算得到作业船的跟踪目标点P：根据点到直线的垂直交点的计算公式，得到作业船的当前位置在当前目标路径上的投影点；然后以上述得到的投影点为起点，沿着目标路径前进方向前伸一定距离得到作业船的跟踪目标点P，其中前伸的距离值由作业船的船体尺寸、航行速度等因素确定；
第四步：将作业船的位姿和运动状态数据与作业船的跟踪目标点及目标路径进行对比分析，得到作业船的航向偏差与速度偏差，分别通过PD、PI控制算法推算出作业船的航向控制量和航速控制量，并将两者融合得到作业船的左右明轮控制量；
第五步：根据得到的控制量对作业船进行实时导航控制，实现路径的跟踪。
进一步，所述第一步中经轨迹规划，得到作业船的目标航线和航速，并确定起始目标路径，具体步骤如下：
步骤1.1，计算作业船与能反映目标作业区轮廓的各个角点{J0，J1，...，Jn}的距离{L0，L1，...，Ln}，并将距离最近的点作为目标航线的起点T0；
步骤1.2，以各个角点的经纬度坐标为基准，按照路径最短原则推算出作业船的目标航线：
T0→T1→...→Tk-1→TK→TK+1→...→TN
对应的目标点集合为：
{T0，T1，...，Tk-1，TK，TK+1，...，TN}
其经纬度坐标为：
{(xT0，yT0)，(xT1，yT1)，...，(xTk-1，yTk-1)，(xTk，yTk，(xTk+1，yTk+1)，...，(xTn，yTn)}
其中x坐标表示经度，y坐标表示纬度，TN为作业船目标航线的终点；
步骤1.3，结合目标航线设定作业船的目标巡航速度VL和目标转弯速度VS。
步骤1.4，确定路径T0→T1为作业船起始的目标路径。
进一步，所述第二步中设定作业船的航行速度并判断是否需要进行目标路径切换，具体步骤如下：
步骤2.1，根据作业船当前位置Q及目标路径终点Tk+1的经纬度坐标计算出作业船与目标路径终点Tk+1的距离D1；
步骤2.2，若步骤2.1中计算得到的距离D1大于减速半径R1，则认为作业船还未逼近目标路径终点，设定作业船的航行速度V1为较大的巡航速度VL；若D1小于或等于减速半径R1，则认为作业船已逼近目标路径终点，设定作业船的航行速度V1为较小的转弯速度VS；
步骤2.3，若步骤2.1中计算得到的距离D1大于目标半径R2，则认为作业船还未到达目标路径终点，不需要进行目标路径的切换；若D1小于或等于目标半径R2，则认为作业船已到达目标路径终点，需要将当前的目标路径由Tk→Tk+1切换成Tk+1→Tk+2；
其中，R1、R2的值由作业船的船体尺寸等因素确定。
进一步，所述第三步的具体过程如下：
步骤3.1，计算作业船的当前位置Q(x1，y1)在当前目标路径TK(xTK，yTK)→TK+1(xTK+1，yTK+1)上的投影点M(x2，y2)，计算的公式为：
其中，横坐标x表示经度，纵坐标y表示纬度。
步骤3.2，由两点经纬度坐标计算两点距离的公式得到投影点M点到目标路径终点Tk+1点的距离d，计算的公式为：
其中，6378137为地球半径，单位为m。
步骤3.3，以投影点M点作为起始点沿着Tk→Tk+1方向前伸距离D2至P(x3，y3)点，P(x3，y3)点坐标的计算公式为：
式中D2的值由作业船的船体尺寸、航行速度等因素确定。
进一步，所述第四步中，将作业船的位姿和运动状态数据与作业船的跟踪目标点及目标路径进行对比分析，计算得到作业船的航向偏差与速度偏差，具体步骤如下：
步骤4.1，航向偏差ΔΨ的确定：作业船的航向偏差ΔΨ为作业船的目标航向Ψ1与当前航向Ψ2的差值，计算的公式为：
ΔΨ＝Ψ1-Ψ2
其中，当前航向Ψ2由惯导模块采集得到，目标航向Ψ1根据作业船当前的经纬度坐标Q(x，y)与跟踪目标点的经纬度坐标P(x，y)计算得到；
步骤4.2，航速偏差ΔV的确定：作业船的航速偏差ΔV为作业船目标速度V1与当前速度V2的差值，计算的公式为：
ΔV(k)＝V1-V2
目标速度V1由第二步得到，当前速度V2由惯导模块采集得到。
进一步，所述第四步中，分别通过PD、PI控制算法推算出作业船的航向控制量和航速控制量，并将两者融合得到作业船最终的控制量即左右明轮速度，具体步骤如下：
步骤4.a，通过PD控制算法推算出航向控制量Ψ*：第i时刻的航向控制量Ψ*(i)由以下公式推算得出：
Ψ*(i)＝Kp×ΔΨ(i)+Kd×(ΔΨ(i)-ΔΨ(i-1))
其中，ΔΨ(i)与ΔΨ(i-1)分别为第i、i-1时刻的航向偏差，Kp为比例参数，Kd为微分参数，Kp和Kd参数均根据实验效果现场整定；
步骤4.b，通过PI控制算法推算出航速控制量V*：第i时刻的航速控制量V*(i)由以下公式推算得出：
其中，ΔV(i)为第i的航速偏差，Kp为比例参数，Ki为积分参数，Kp和Ki参数均根据实验效果现场整定；
步骤4.c，融合航向控制量Ψ*与航速控制量V*得到作业船左右明轮控制量：本发明以速度控制量V*为基准，左右明轮控制量分别加上和减去来进行解耦，得到左右明轮的控制量分别为：
左明轮为：
右明轮为：
本发明采用上述技术后，具有以下技术效果：本发明首先通过基于RTK模式的高精度GPS系统采集能反映作业区轮廓的各个角点的经纬度坐标，经轨迹规划得到作业船的目标航线和航速，将不规则的作业区域规划为多个首尾相连的直线路径，降低了作业船目标航线获取的难度；然后通过基于RTK模式的高精度GPS系统以及惯导模块实时地采集得到作业船当前的位置、航向和航速等位姿和运动状态数据，根据作业船与当前目标路径终点的距离设置作业船的航行速度并判断是否需要进行目标路径切换，可以在保证作业船路径跟踪精度的前提下提高作业船的工作效率；接着采用实时插点的方式计算得到作业船的跟踪目标点，可提高作业船对于航向偏差的敏感度，使作业船的跟踪轨迹更加地逼近目标路径；接着将作业船的位姿和运动状态数据与作业船的跟踪目标点及目标路径进行对比分析，得到作业船的航向偏差与速度偏差，分别通过PD、PI控制算法推算出作业船的航向控制量及航速控制量，并将两者融合得到作业船的左右明轮控制量，其中，由于航速控制的输出量直接作用于明轮转速而不是船速，航速控制采用PI控制，通过积分环节以消除航速的稳态误差，航向控制采用PD控制，通过微分环节以增大阻尼系数、保持船舶的稳定；最后，根据得到的控制量对作业船进行实时导航控制，实现路径的跟踪。与现有方法相比，本发明可以实时地反映出航向的误差，实现方法简单、有效，通过实时插点的方式在线计算出作业船的跟踪目标点，将有限个角点细化成无数个跟踪目标点，能显著提高自动导航路径跟踪的效果，为水草清理和均匀投饵作业的高效完成提供保障。
附图说明
图1为水产养殖作业船结构图；
图2为作业船自动导航控制系统的原理结构框图；
图3为作业区轮廓示意图；
图4为使用多个角点描述作业区轮廓示意图；
图5为计算作业船与各个角点距离示意图；
图6为设定作业船目标航线示意图；
图7为作业船设定航行速度及目标路径切换示意图；
图8为基于实时插点方法计算作业船跟踪目标点示意图；
图9为作业船自动导航路径跟踪轨迹图；
图10为作业船自动导航路径跟踪误差曲线图。
具体实施方式
下面将结合实施例对本发明做进一步的详细描述，但本发明的实施方式不限于此。
本实施例采用的水产养殖作业船的结构如图1所示，船上包括船体1，船体1前端的水草切割装置2和水草收集装置3，船体1中部的集草仓4、水草铺平装置5，船体1中部两侧的明轮6，以及船体1后端的操作台7和投饵机8。船体1上装载了Trimble公司的高精度GPS系统、SBG IG-500A MEMS高精度惯导模块、ARM9的主控制板和明轮电机控制器等设备，构成作业船自动导航控制系统，其中，GPS系统与惯导模块采用串口连接，GPS系统、惯导模块均通过串口与ARM9主控制器连接。其原理结构框图如图2所示。
高精度GPS系统由基站和移动站两个部分组成RTK测量模式，基站和移动站通过无线电台进行数据传输，其定位精度可达厘米级；ARM9主控制板完成数据采集、数据处理、路径跟踪算法及控制指令输出等功能，其程序是采用ADS1.2开发平台在Windows 7环境下编写完成的。
具体实施步骤如下：
第1步.设定作业船的目标航线和航速，并确定起始目标路径
本发明使用基于RTK模式的高精度GPS系统采集能反映目标作业区轮廓的各个角点的经纬度坐标，经轨迹规划，得到作业船的目标航线和航速，并确定起始目标路径。由于水产养殖作业船的目标作业区域多为不规则的形状，本发明首先使用多个能反映目标作业区域轮廓的角点{J0，J1，...，Jn}来描述目标作业区域；然后根据已知两点的经纬度计算两点间距离的公式：
分别计算出作业船的当前位置Q(x，y)同各个角点{J0，J1，...，Jn}的距离{L0，L1，...，Ln}，并将距离最近的点作为行进路线的起点T0。其中，Lat表示经度，Lng表示纬度，L的单位为m。
接着，以各个角点的经纬度坐标为基准，按照路径最短原则推算出作业船的行进路线：
T0→T1→...→Tk-1→TK→TK+1→...→TN
对应的目标点集合为：
{T0，T1，...，Tk-1，TK，TK+1，...，TN}
其经纬度坐标为：
{(xT0，yT0)，(xT1，yT1)，...，(xTk-1，yTk-1)，(xTk，yTk)，(xTk+1，yTk+1)，...，(xTn，yTn)}
其中x坐标表示经度，y坐标表示纬度，TN为作业船目标航线的终点。
接着，结合目标航线设定作业船的目标巡航速度VL和目标转弯速度VS，其中，VL值过大时会导致水草清理不彻底以及投饵量不足等问题，其值过小时又会降低作业船的作业效率。VS值过大时会增加作业船转弯的难度，过小时又会增加转弯时间，降低作业船的工作效率，设置合适的巡航速度VL和转弯速度VS可以在保证作业船路径跟踪精度的前提下提高作业船的工作效率。
最终，确定路径T0→T1为作业船起始的目标路径。
这种方式将不规则的作业区域规划为多个首尾相连的直线路径，与现有的技术相比，降低了作业船目标航线获取的难度。
第2步.设定作业船航行速度并判断是否需要进行目标路径切换
本发明通过基于RTK模式的高精度GPS系统以及惯导模块采集得到作业船当前的位置、航向和航速等位姿和运动状态数据，设定作业船的航行速度并判断是否需要进行目标路径切换。本发明中作业船的目标航线由多条首尾相连的直线目标路径组成，目标路径的终点即为路线的转弯点。为了保证作业船自动导航的精度，需要实时地设定作业船的航行速度并更新作业船当前的目标路径，其示意图如图7所示。
Q(x，y)点为作业船的当前位置，Tk→Tk+1为当前的目标路径，Tk+1→Tk+2为下一条目标路径。由于作业船在水中航行时具有很大的惯性，为防止作业船冲出设定的目标航线，必须降低船速并提前进行目标路径的切换。主控制器在作业船逼近目标路径终点的过程中不断地计算作业船当前位置与目标路径终点的距离D1，当D1大于减速半径R1时，则认为作业船还未逼近目标路径终点，设定作业船的航行速度V1为较大的巡航速度VL；若D1小于或等于减速半径R1，则认为作业船已逼近目标路径终点，设定作业船的航行速度V1为较小的转弯速度VS；若D1大于目标半径R2，则认为作业船还未到达目标路径终点，不需要进行目标路径的切换；若D1小于或等于目标半径R2，则认为作业船已到达目标路径终点，需要将当前的目标路径由Tk→Tk+1切换成Tk+1→Tk+2。
其中，R1、R2的值由作业船的船体尺寸等因素确定。R1值过大时会导致作业船过早减速，降低作业船的工作效率；R1值过小时又会导致作业船减速太晚，使得作业船冲出目标路径。R2值过大或过小时会导致作业船过早或过晚地切换目标路径，增大作业船的转弯半径。设置合适的R1、R2可以在保证作业船路径跟踪精度的前提下提高作业船的工作效率。
第3步.采用实时插点的方式得到作业船的跟踪目标点
本发明采用实时插点的方法实时地计算出作业船的跟踪目标点，其计算示意图如图8所示。
Q(x1，y1)为船体的当前位置坐标，TK(xTK，yTK)、TK+1(xTK+1，yTK+1)为当前目标路径的起止点。其中，横坐标x表示经度，纵坐标y表示纬度，目标路径方向为Tk→Tk+1。若此时作业船直接将Tk+1点作为跟踪目标点，其行走路线Q→Tk+1将会较大地偏离目标路径Tk→Tk+1。作Q点到路径Tk→Tk+1的垂线相交于M(x2，y2)点，根据点到直线的垂直交点计算公式可得M点的坐标为：
其中QM为作业船偏离目标路径的距离，由经纬度坐标计算两点距离的公式可得M点到点Tk+1的距离d为：
式中，6378137m为地球半径，d的单位为m。
以M点作为起始点沿着Tk→Tk+1方向前伸距离D2至P点，可求得P(x3，y3)点的坐标为：
其中，D2的值由作业船的船体尺寸、航行速度等因素确定，D2的值过大时会导致计算得出的跟踪目标点距离作业船较远，当作业船偏离目标路径时很难回调；D2的值过小时又会导致作业船对于航向的变化过于敏感，造成系统的震荡。
接着，主控制器将会以点P作为跟踪目标点对作业船进行自动导航控制。当船体由Q运动至Q′时，跟踪目标点也同时向前运动至P′，直至到达TK+1点为止。
这种方法能够实时地反映出航向的误差，将有限个角点细化成无数个跟踪目标点，可以使作业船的航行轨迹更加地逼近设定路径，能显著提高作业船自动导航路径跟踪的效果。
第4步.航向、航速双闭环控制
本发明将作业船的位姿和运动状态数据与作业船的跟踪目标点及目标路径进行对比分析，得到作业船的航向偏差与速度偏差；分别通过PD、PI控制算法推算出作业船的航向控制量和航速控制量，并将两者融合得到作业船的左右明轮控制量。
为了减小水产养殖作业船的转弯半径，本发明采用两侧均可正反转的明轮作为驱动装置，并设计了相应的航向闭环、航速闭环解耦方法，保证两者能够互不干扰，实现解耦控制。当前航向Ψ2由惯导模块采集得到，目标航向Ψ1根据作业船当前的经纬度坐标Q(x，y)与跟踪目标点的经纬度坐标P(x，y)计算得到；目标速度V1由第2步得到，当前速度V2由惯导模块采集得到。
首先，根据公式：
Ψ*(k)＝Kp×ΔΨ(k)+Kd×(ΔΨ(k)-ΔΨ(k-1))
得到航向闭环的调整量Ψ*。式中，Kp、Kd为PD控制器的比例、微分系数，ΔΨ为目标航向Ψ1与当前航向Ψ2的差值，即
ΔΨ(k)＝Ψ1(k)-Ψ2(k)
接着，根据公式：
得到航速闭环的调整量V*。式中，Kp、Ki为航速PI控制器的比例、积分参数，ΔV为目标航速V1和当前航速V2的差值，即
ΔV(k)＝V1(k)-V2(k)
本实施例将GPS设备的主天线放置在左右明轮连线的中点处以实现航向闭环和航速闭环的解耦控制。当左右明轮速度分别为和时，作业船将会以主天线为中心点原地转向，此时由于主天线没有发生位移，GPS设备输出的速度值为0，即航向调整不会影响到航速；当左右明轮的速度同时为V*时，作业船将保持当前航向前进或者后退，此时作业船的航向变化量为0，即航速调整不会影响到航向。本实施例以速度调整量V*为基准，左右明轮速度分别加上和减去来进行解耦，得到左右明轮的速度分别为：
左明轮：
右明轮：
ARM9主控制器根据U1及U2的值设定左右明轮的转速，灵活控制船体进行加速、减速、左转或右转等动作，控制船体按照设定航线航行。
第5步.根据得到的控制量对作业船进行实时导航控制，实现路径的跟踪。
具体实施例
上述第1步规划作业船的目标航线和航速中，设定水产养殖作业船的目标作业区域为图3所示的不规则的形状，根据目标作业区域的形状特征设置4个能反映目标作业区域轮廓的角点{J0，J1，J2，J3}，将原始的曲线路径分解为图4所示的多个首尾相连的直线路径，使用高精度GPS系统采集这些角点的经纬度坐标分别为(119.51700896，32.19759716)、(119.51744361，32.19757820)、(119.51740220，32.19784642)、(119.51698746，32.19785174)，并将其以二维数组的形式储存在主控制器之中。接着，由已知两点的经纬度计算两点间距离的公式：
分别计算出作业船的当前位置Q(x，y)同各个角点的距离{L0，L1，L2，L3}，其中，Lat表示经度，Lng表示纬度，L的单位为m。接着将距离作业船最近的角点作为行进路线的起点T0，其示意图如图5所示。按照路径最短的原则对作业船的行进路线进行规划，得到作业船的行进路线为：
T0→T1→T2→T3
作业船相应的行进路线数据为：
{(xT0，yT0)，(xT1，yT1)，(xT2，yT2)，(xT3，yT3)}
最后，结合目标路径设定目标巡航速度为：VL＝0.8m.s-1，目标转弯速度为：VS＝0.35m.s-1。
其示意图如图6所示。
这种方式将不规则的作业区域规划为多个首尾相连的直线路径，与现有的技术相比，降低了作业船行进路线数据获取的难度。
上述第2步中设定作业船航行速度并判断是否需要路径切换中，R1、R2的值应由作业船的船体尺寸等因素确定。在本实施例中，考虑到水产养殖作业船的船体尺寸(长×宽×高)分别为4.0m×1.6m×1.2m，设置R1＝3m、R2＝1.5m，可以在保证作业船路径跟踪精度的前提下提高作业船的工作效率。
上述第3步采用实时插点的方式得到作业船的跟踪目标点中，设定前伸距离D2的值为2.5m，在作业船偏离目标路径时可以很快地回调且不会造成系统的震荡。
本实施例中作业船的自动导航路径跟踪轨迹图如图9所示，运行过程中的误差曲线如图10所示。由实验结果可以看到：作业船在转弯点处不易偏离目标路径，并且当船体出现偏差时会很快地进行回调，其在转弯与直行时偏离目标路径的最大误差分别为0.36m和0.09m，能很好地满足蟹塘内水草清理及均匀投饵的要求。
在本说明书的描述中，参考术语“一个实施例”、“一些实施例”、“示意性实施例”、“示例”、“具体示例”、或“一些示例”等的描述意指结合该实施例或示例描述的具体特征、结构、材料或者特点包含于本发明的至少一个实施例或示例中。在本说明书中，对上述术语的示意性表述不一定指的是相同的实施例或示例。而且，描述的具体特征、结构、材料或者特点可以在任何的一个或多个实施例或示例中以合适的方式结合。
尽管已经示出和描述了本发明的实施例，本领域的普通技术人员可以理解：在不脱离本发明的原理和宗旨的情况下可以对这些实施例进行多种变化、修改、替换和变型，本发明的范围由权利要求及其等同物限定。

Claims (6)

1.一种水产养殖作业船自动导航路径跟踪方法，其特征在于，包括以下步骤：
第一步：使用基于RTK模式的高精度GPS系统采集能反映目标作业区轮廓的各个角点的经纬度坐标，经轨迹规划，得到作业船的目标航线和航速，并确定起始目标路径；
第二步：通过基于RTK模式的高精度GPS系统以及惯导模块采集得到作业船当前的位置、航向和航速的位姿和运动状态数据，设定作业船的航行速度并判断是否需要进行目标路径切换；
第三步：采用实时插点的方法计算得到作业船的跟踪目标点P：根据点到直线的垂直交点的计算公式，得到作业船的当前位置在当前目标路径上的投影点；然后以上述得到的投影点为起点，沿着目标路径前进方向前伸一定距离得到作业船的跟踪目标点P，其中前伸的距离值由作业船的船体尺寸、航行速度因素确定；
第四步：将作业船的位姿和运动状态数据与作业船的跟踪目标点及目标路径进行对比分析，得到作业船的航向偏差与航速偏差，分别通过PD、PI控制算法推算出作业船的航向控制量和航速控制量，并将两者融合得到作业船的左右明轮控制量；
第五步：根据得到的控制量对作业船进行实时导航控制，实现路径的跟踪。
2.如权利要求1所述的水产养殖作业船自动导航路径跟踪方法，其特征在于：所述第一步中经轨迹规划，得到作业船的目标航线和航速，并确定起始目标路径，具体步骤如下：
步骤1.1，计算作业船与能反映目标作业区轮廓的各个角点{J0,J1,...,Jn}的距离{L0,L1,...,Ln}，并将距离最近的点作为目标航线的起点T0；
步骤1.2，以各个角点的经纬度坐标为基准，按照路径最短原则推算出作业船的目标航线：
T0→T1→...→Tk-1→TK→TK+1→...→TN
对应的目标点集合为：
{T0,T1,...,Tk-1,TK,TK+1,...,TN}
其经纬度坐标为：
{(xT0,yT0),(xT1,yT1),...,(xTk-1,yTk-1),(xTk,yTk),(xTk+1,yTk+1),...,(xTn,yTn)}
其中x坐标表示经度，y坐标表示纬度，TN为作业船目标航线的终点；
步骤1.3，结合目标航线设定作业船的目标巡航速度VL和目标转弯速度VS；
步骤1.4，确定路径T0→T1为作业船起始的目标路径。
3.如权利要求1所述的水产养殖作业船自动导航路径跟踪方法，其特征在于：所述第二步中设定作业船的航行速度并判断是否需要进行目标路径切换，具体步骤如下：
步骤2.1，根据作业船当前位置Q及目标路径终点Tk+1的经纬度坐标计算出作业船与目标路径终点Tk+1的距离D1；
步骤2.2，若步骤2.1中计算得到的距离D1大于减速半径R1，则认为作业船还未逼近目标路径终点，设定作业船的航行速度V1为较大的巡航速度VL；若D1小于或等于减速半径R1，则认为作业船已逼近目标路径终点，设定作业船的航行速度V1为较小的转弯速度VS；
步骤2.3，若步骤2.1中计算得到的距离D1大于目标半径R2，则认为作业船还未到达目标路径终点，不需要进行目标路径的切换；若D1小于或等于目标半径R2，则认为作业船已到达目标路径终点，需要将当前的目标路径由Tk→Tk+1切换成Tk+1→Tk+2；
其中，R1、R2的值由作业船的船体尺寸因素确定。
4.如权利要求1所述的水产养殖作业船自动导航路径跟踪方法，其特征在于：所述第三步的具体过程如下：
步骤3.1，计算作业船的当前位置Q(x1,y1)在当前目标路径TK(xTK,yTK)→TK+1(xTK+1,yTK+1)上的投影点M(x2,y2)，计算的公式为：
<mrow> <msub> <mi>x</mi> <mn>2</mn> </msub> <mo>=</mo> <mfrac> <mrow> <mo>(</mo> <msub> <mi>y</mi> <mn>1</mn> </msub> <mo>-</mo> <msub> <mi>y</mi> <mrow> <mi>T</mi> <mi>K</mi> </mrow> </msub> <mo>)</mo> <mo>&amp;times;</mo> <mo>(</mo> <msub> <mi>x</mi> <mn>1</mn> </msub> <mo>&amp;times;</mo> <mo>(</mo> <mrow> <msub> <mi>y</mi> <mrow> <mi>T</mi> <mi>K</mi> <mo>+</mo> <mn>1</mn> </mrow> </msub> <mo>-</mo> <msub> <mi>y</mi> <mrow> <mi>T</mi> <mi>K</mi> </mrow> </msub> </mrow> <mo>)</mo> <mo>+</mo> <msub> <mi>x</mi> <mrow> <mi>T</mi> <mi>K</mi> </mrow> </msub> <mo>&amp;times;</mo> <mo>(</mo> <mrow> <msub> <mi>y</mi> <mn>1</mn> </msub> <mo>-</mo> <msub> <mi>y</mi> <mrow> <mi>T</mi> <mi>K</mi> <mo>+</mo> <mn>1</mn> </mrow> </msub> </mrow> <mo>)</mo> <mo>)</mo> <mo>+</mo> <msub> <mi>y</mi> <mrow> <mi>T</mi> <mi>K</mi> <mo>+</mo> <mn>1</mn> </mrow> </msub> <mo>&amp;times;</mo> <msup> <mrow> <mo>(</mo> <msub> <mi>x</mi> <mn>1</mn> </msub> <mo>-</mo> <msub> <mi>x</mi> <mrow> <mi>T</mi> <mi>K</mi> </mrow> </msub> <mo>)</mo> </mrow> <mn>2</mn> </msup> </mrow> <mrow> <msup> <mrow> <mo>(</mo> <msub> <mi>x</mi> <mn>1</mn> </msub> <mo>-</mo> <msub> <mi>x</mi> <mrow> <mi>T</mi> <mi>K</mi> </mrow> </msub> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>+</mo> <msup> <mrow> <mo>(</mo> <msub> <mi>y</mi> <mn>1</mn> </msub> <mo>-</mo> <msub> <mi>y</mi> <mrow> <mi>T</mi> <mi>K</mi> </mrow> </msub> <mo>)</mo> </mrow> <mn>2</mn> </msup> </mrow> </mfrac> </mrow>
<mrow> <msub> <mi>y</mi> <mn>2</mn> </msub> <mo>=</mo> <mfrac> <mrow> <mo>(</mo> <msub> <mi>x</mi> <mn>1</mn> </msub> <mo>-</mo> <msub> <mi>x</mi> <mrow> <mi>T</mi> <mi>K</mi> </mrow> </msub> <mo>)</mo> <mo>&amp;times;</mo> <mo>(</mo> <msub> <mi>y</mi> <mrow> <mi>T</mi> <mi>K</mi> </mrow> </msub> <mo>&amp;times;</mo> <mo>(</mo> <mrow> <msub> <mi>x</mi> <mn>1</mn> </msub> <mo>-</mo> <msub> <mi>x</mi> <mrow> <mi>T</mi> <mi>K</mi> <mo>+</mo> <mn>1</mn> </mrow> </msub> </mrow> <mo>)</mo> <mo>-</mo> <msub> <mi>y</mi> <mn>1</mn> </msub> <mo>&amp;times;</mo> <mo>(</mo> <mrow> <msub> <mi>x</mi> <mrow> <mi>T</mi> <mi>K</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>x</mi> <mrow> <mi>T</mi> <mi>K</mi> <mo>+</mo> <mn>1</mn> </mrow> </msub> </mrow> <mo>)</mo> <mo>)</mo> <mo>+</mo> <msub> <mi>y</mi> <mrow> <mi>T</mi> <mi>K</mi> <mo>+</mo> <mn>1</mn> </mrow> </msub> <mo>&amp;times;</mo> <msup> <mrow> <mo>(</mo> <msub> <mi>y</mi> <mn>1</mn> </msub> <mo>-</mo> <msub> <mi>y</mi> <mrow> <mi>T</mi> <mi>K</mi> </mrow> </msub> <mo>)</mo> </mrow> <mn>2</mn> </msup> </mrow> <mrow> <msup> <mrow> <mo>(</mo> <msub> <mi>x</mi> <mn>1</mn> </msub> <mo>-</mo> <msub> <mi>x</mi> <mrow> <mi>T</mi> <mi>K</mi> </mrow> </msub> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>+</mo> <msup> <mrow> <mo>(</mo> <msub> <mi>y</mi> <mn>1</mn> </msub> <mo>-</mo> <msub> <mi>y</mi> <mrow> <mi>T</mi> <mi>K</mi> </mrow> </msub> <mo>)</mo> </mrow> <mn>2</mn> </msup> </mrow> </mfrac> </mrow>
其中，横坐标x表示经度，纵坐标y表示纬度；
步骤3.2，由两点经纬度坐标计算两点距离的公式得到投影点M点到目标路径终点Tk+1点的距离d，计算的公式为：
<mrow> <mi>d</mi> <mo>=</mo> <mn>2</mn> <mo>&amp;times;</mo> <mn>6378137</mn> <mo>&amp;times;</mo> <mi>arcsin</mi> <mrow> <mo>(</mo> <msqrt> <mrow> <msup> <mi>sin</mi> <mn>2</mn> </msup> <mrow> <mo>(</mo> <mfrac> <mrow> <msub> <mi>y</mi> <mrow> <mi>T</mi> <mi>K</mi> <mo>+</mo> <mn>1</mn> </mrow> </msub> <mo>-</mo> <msub> <mi>y</mi> <mn>2</mn> </msub> </mrow> <mn>2</mn> </mfrac> <mo>)</mo> </mrow> <mo>+</mo> <mi>c</mi> <mi>o</mi> <mi>s</mi> <mrow> <mo>(</mo> <msub> <mi>y</mi> <mrow> <mi>T</mi> <mi>K</mi> <mo>+</mo> <mn>1</mn> </mrow> </msub> <mo>)</mo> </mrow> <mo>&amp;times;</mo> <mi>c</mi> <mi>o</mi> <mi>s</mi> <mrow> <mo>(</mo> <msub> <mi>y</mi> <mn>2</mn> </msub> <mo>)</mo> </mrow> <mo>&amp;times;</mo> <msup> <mi>sin</mi> <mn>2</mn> </msup> <mrow> <mo>(</mo> <mfrac> <mrow> <msub> <mi>x</mi> <mrow> <mi>T</mi> <mi>K</mi> <mo>+</mo> <mn>1</mn> </mrow> </msub> <mo>-</mo> <msub> <mi>x</mi> <mn>2</mn> </msub> </mrow> <mn>2</mn> </mfrac> <mo>)</mo> </mrow> </mrow> </msqrt> <mo>)</mo> </mrow> </mrow>
其中，6378137为地球半径，单位为m；
步骤3.3，以投影点M点作为起始点沿着Tk→Tk+1方向前伸距离D2至P(x3,y3)点，P(x3,y3)点坐标的计算公式为：
<mrow> <msub> <mi>x</mi> <mn>3</mn> </msub> <mo>=</mo> <msub> <mi>x</mi> <mn>2</mn> </msub> <mo>&amp;PlusMinus;</mo> <mfrac> <mrow> <msub> <mi>L</mi> <mn>1</mn> </msub> <mo>&amp;times;</mo> <mrow> <mo>(</mo> <msub> <mi>x</mi> <mn>2</mn> </msub> <mo>-</mo> <msub> <mi>x</mi> <mrow> <mi>T</mi> <mi>K</mi> </mrow> </msub> <mo>)</mo> </mrow> </mrow> <mi>d</mi> </mfrac> </mrow>
<mrow> <msub> <mi>y</mi> <mn>3</mn> </msub> <mo>=</mo> <msub> <mi>y</mi> <mn>2</mn> </msub> <mo>&amp;PlusMinus;</mo> <mfrac> <mrow> <msub> <mi>D</mi> <mn>2</mn> </msub> <mo>&amp;times;</mo> <mrow> <mo>(</mo> <msub> <mi>y</mi> <mn>2</mn> </msub> <mo>-</mo> <msub> <mi>y</mi> <mrow> <mi>T</mi> <mi>K</mi> </mrow> </msub> <mo>)</mo> </mrow> </mrow> <mi>d</mi> </mfrac> </mrow>
式中D2的值由作业船的船体尺寸、航行速度因素确定。
5.如权利要求1所述的水产养殖作业船自动导航路径跟踪方法，其特征在于：所述第四步中，将作业船的位姿和运动状态数据与作业船的跟踪目标点及目标路径进行对比分析，计算得到作业船的航向偏差与航速偏差，具体步骤如下：
步骤4.1，航向偏差ΔΨ的确定：作业船的航向偏差ΔΨ为作业船的目标航向Ψ1与当前航向Ψ2的差值，计算的公式为：
ΔΨ＝Ψ1-Ψ2
其中，当前航向Ψ2由惯导模块采集得到，目标航向Ψ1根据作业船当前的经纬度坐标Q(x,y)与跟踪目标点的经纬度坐标P(x,y)计算得到；
步骤4.2，航速偏差ΔV的确定：作业船的航速偏差ΔV为作业船目标速度V1与当前速度V2的差值，计算的公式为：
ΔV(k)＝V1-V2
目标速度V1由第二步得到，当前速度V2由惯导模块采集得到。
6.如权利要求1所述的水产养殖作业船自动导航路径跟踪方法，其特征在于：所述第四步中，分别通过PD、PI控制算法推算出作业船的航向控制量和航速控制量，并将两者融合得到作业船最终的控制量，具体步骤如下：
步骤4.a，通过PD控制算法推算出航向控制量Ψ*：第i时刻的航向控制量Ψ*(i)由以下公式推算得出：
Ψ*(i)＝Kp×ΔΨ(i)+Kd×(ΔΨ(i)-ΔΨ(i-1))
其中，ΔΨ(i)与ΔΨ(i-1)分别为第i、i-1时刻的航向偏差，Kp为比例参数，Kd为微分参数，Kp和Kd参数均根据实验效果现场整定；
步骤4.b，通过PI控制算法推算出航速控制量V*：第i时刻的航速控制量V*(i)由以下公式推算得出：
<mrow> <msup> <mi>V</mi> <mo>*</mo> </msup> <mrow> <mo>(</mo> <mi>i</mi> <mo>)</mo> </mrow> <mo>=</mo> <msub> <mi>K</mi> <mi>p</mi> </msub> <mo>&amp;times;</mo> <mi>&amp;Delta;</mi> <mi>V</mi> <mrow> <mo>(</mo> <mi>i</mi> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>K</mi> <mi>i</mi> </msub> <mo>&amp;times;</mo> <munderover> <mo>&amp;Sigma;</mo> <mrow> <mi>j</mi> <mo>=</mo> <mn>1</mn> </mrow> <mi>i</mi> </munderover> <mi>&amp;Delta;</mi> <mi>V</mi> <mrow> <mo>(</mo> <mi>j</mi> <mo>)</mo> </mrow> </mrow>
其中，ΔV(i)为第i时刻的航速偏差，Kp为比例参数，Ki为积分参数，Kp和Ki参数均根据实验效果现场整定；
步骤4.c，融合航向控制量Ψ*与航速控制量V*得到作业船左右明轮控制量：以速度控制量V*为基准，左右明轮控制量分别加上和减去来进行解耦，得到左右明轮的控制量分别为：
左明轮为：
<mrow> <msub> <mi>U</mi> <mn>1</mn> </msub> <mo>=</mo> <msup> <mi>V</mi> <mo>*</mo> </msup> <mo>+</mo> <mfrac> <mn>1</mn> <mn>2</mn> </mfrac> <msup> <mi>&amp;Psi;</mi> <mo>*</mo> </msup> </mrow>
右明轮为：
<mrow> <msub> <mi>U</mi> <mn>2</mn> </msub> <mo>=</mo> <msup> <mi>V</mi> <mo>*</mo> </msup> <mo>-</mo> <mfrac> <mn>1</mn> <mn>2</mn> </mfrac> <msup> <mi>&amp;Psi;</mi> <mo>*</mo> </msup> <mo>.</mo> </mrow>
CN201610095261.5A 2016-02-22 2016-02-22 一种水产养殖作业船自动导航路径跟踪方法 Active CN105629976B (zh)

Priority Applications (2)

Application Number Priority Date Filing Date Title
CN201610095261.5A CN105629976B (zh) 2016-02-22 2016-02-22 一种水产养殖作业船自动导航路径跟踪方法
PCT/CN2016/075946 WO2017143631A1 (zh) 2016-02-22 2016-03-09 一种水产养殖作业船自动导航路径跟踪方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201610095261.5A CN105629976B (zh) 2016-02-22 2016-02-22 一种水产养殖作业船自动导航路径跟踪方法

Publications (2)

Publication Number Publication Date
CN105629976A CN105629976A (zh) 2016-06-01
CN105629976B true CN105629976B (zh) 2018-06-01

Family

ID=56045030

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201610095261.5A Active CN105629976B (zh) 2016-02-22 2016-02-22 一种水产养殖作业船自动导航路径跟踪方法

Country Status (2)

Country Link
CN (1) CN105629976B (zh)
WO (1) WO2017143631A1 (zh)

Families Citing this family (32)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107885196A (zh) * 2016-09-29 2018-04-06 上海华测导航技术股份有限公司 一种语音控制自动化水草清理船
CN106601030B (zh) * 2016-12-08 2019-03-26 中国交通通信信息中心 一种船舶智能过闸辅助航行系统
CN106708062B (zh) * 2017-03-10 2020-10-09 信阳农林学院 一种智能施药船的行驶控制方法
CN106950960B (zh) * 2017-04-12 2020-02-18 大连理工大学 一种湖库作业船对偶变向侧桨在线自动控制方法
CN108733057A (zh) * 2018-05-23 2018-11-02 江苏大学 一种基于自抗扰技术的水产养殖明轮船航向控制方法
CN109116856B (zh) * 2018-09-28 2021-04-20 上海海事大学 一种基于扰动观测器的欠驱动船舶路径跟踪控制方法
CN109840358B (zh) * 2019-01-09 2023-04-07 上海海洋大学 一种基于航迹时域差分的航迹分段方法
CN110610134B (zh) * 2019-08-13 2022-12-20 上海大学 一种无人艇自主对接方法
CN110673598B (zh) * 2019-09-29 2022-10-25 哈尔滨工程大学 一种水面无人艇智能路径跟踪控制方法
CN110986943B (zh) * 2019-11-01 2023-03-28 智慧航海（青岛）科技有限公司 一种船舶航行路径智能优化方法及装置
CN110908376B (zh) * 2019-11-26 2020-12-18 江苏大学 一种抗风力的自动投饵船精准投饵方法
CN110888447B (zh) * 2019-12-23 2021-09-03 西安电子科技大学 基于非线性pd双闭环控制的四旋翼3d路径跟踪方法
CN111176292B (zh) * 2020-01-13 2022-11-22 天津工业大学 一种基于侧边距的波浪滑翔器路径跟踪控制方法
CN111460623B (zh) * 2020-03-06 2023-07-14 浙江吉翱空间规划科技有限公司 一种测绘作业数据实时采集处理方法及系统
CN111522336B (zh) * 2020-03-26 2021-05-25 江苏大学 一种池塘水草自动清理船的作业路径规划及控制方法
CN111427350B (zh) * 2020-03-30 2022-11-18 江苏大学 一种基于麦克纳姆轮的自主移动式增氧机的控制方法
CN111309036A (zh) * 2020-05-14 2020-06-19 江苏博人文化科技有限公司 一种基于自动驾驶船的空间信息测量系统
CN111552309B (zh) * 2020-05-21 2021-04-20 上海海洋大学 船舶巡边控制方法
CN111766873B (zh) * 2020-06-12 2023-12-05 广州极飞科技股份有限公司 作业设备的引导方法及相关装置
CN111830968B (zh) * 2020-06-12 2024-02-06 江苏大学 一种多功能莼菜无人作业船及其导航控制方法
CN111949750B (zh) * 2020-07-30 2024-06-11 智慧航海（青岛）科技有限公司 一种船舶轨迹模型建立及异常轨迹检测方法
CN112068550A (zh) * 2020-08-11 2020-12-11 闽江学院 一种船舶航向跟踪控制的方法
CN112269376B (zh) * 2020-09-14 2022-11-18 江苏大学 一种移动式增氧机的作业路径规划及控制方法
CN112883308B (zh) * 2020-12-04 2024-09-13 中船鹏力(南京)大气海洋信息系统有限公司 基于WebGL的大批量目标加载与显示的方法
CN113110470A (zh) * 2021-04-23 2021-07-13 安徽工业大学 一种明轮无人增氧船的控制系统与航向控制算法
CN113762125B (zh) * 2021-08-31 2024-06-07 华中科技大学 一种基于高分四号影像分析的运动舰船航速航向获取方法
CN114217543B (zh) * 2021-10-11 2024-07-12 江苏大学 一种基于单抛盘模型的全自动投饵船均匀投饵的控制方法
CN114089758B (zh) * 2021-11-18 2022-11-04 上海联适导航技术股份有限公司 一种基于WebGIS的无人插秧作业路径规划方法
CN114495031A (zh) * 2022-03-31 2022-05-13 青岛海信网络科技股份有限公司 一种车牌信息校正方法、设备及装置
CN116520834B (zh) * 2023-04-24 2024-05-28 安徽建筑大学 一种低能耗的无人船巡航方法
CN116736864B (zh) * 2023-07-12 2024-05-31 北鲲睿航科技(上海)有限公司 一种自主航行控制方法及系统
CN118323395B (zh) * 2024-06-13 2024-08-30 中国科学院合肥物质科学研究院 一种防溺水智能监控与救援方法

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE102010028251A1 (de) * 2010-04-27 2011-10-27 Robert Bosch Gmbh Verfahren zum Erkennen eines Arbeitsbereichs sowie ein Gerät hierfür
CN103461257A (zh) * 2013-09-13 2013-12-25 中国水产科学研究院渔业机械仪器研究所 一种养殖池塘自动投饲系统
CN105204506A (zh) * 2015-09-24 2015-12-30 哈尔滨工程大学 一种动力定位船舶铺管循迹导引方法
CN205027907U (zh) * 2015-09-16 2016-02-10 佛山市中渔科技有限公司 一种基于雷达和gps定位的喂虾机

Family Cites Families (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP5419622B2 (ja) * 2009-10-01 2014-02-19 古野電気株式会社 船舶表示装置
WO2011055512A1 (ja) * 2009-11-04 2011-05-12 川崎重工業株式会社 操船制御方法及び操船制御システム
CN103576555B (zh) * 2013-11-14 2016-05-04 哈尔滨工程大学 一种动力定位船舶循迹导引控制方法
CN104950882B (zh) * 2014-09-24 2019-01-29 广东工业大学 全局一致渐进路径跟踪引导控制方法
CN104850122B (zh) * 2015-05-13 2017-08-25 上海海事大学 基于可变船长比的抵抗侧风无人水面艇直线路径跟踪方法

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE102010028251A1 (de) * 2010-04-27 2011-10-27 Robert Bosch Gmbh Verfahren zum Erkennen eines Arbeitsbereichs sowie ein Gerät hierfür
CN103461257A (zh) * 2013-09-13 2013-12-25 中国水产科学研究院渔业机械仪器研究所 一种养殖池塘自动投饲系统
CN205027907U (zh) * 2015-09-16 2016-02-10 佛山市中渔科技有限公司 一种基于雷达和gps定位的喂虾机
CN105204506A (zh) * 2015-09-24 2015-12-30 哈尔滨工程大学 一种动力定位船舶铺管循迹导引方法

Non-Patent Citations (3)

* Cited by examiner, † Cited by third party
Title
Diver towed GPS to estimate densities of a critically endangered fish;Tim Lynch等;《Biological Conservation》;20151231(第191期);第700-706页 *
基于蚁群算法的AUV全局路径规划方法;王宏健等;《中国造船》;20080630;第49卷(第2期);第88-93页 *
移动机器人全局路径规划分析;王荣彦;《中国高新技术企业》;20111231(第07期);第90-91页 *

Also Published As

Publication number Publication date
CN105629976A (zh) 2016-06-01
WO2017143631A1 (zh) 2017-08-31

Similar Documents

Publication Publication Date Title
CN105629976B (zh) 一种水产养殖作业船自动导航路径跟踪方法
USRE48509E1 (en) Raster-based contour swathing for guidance and variable-rate chemical application
CN111522336B (zh) 一种池塘水草自动清理船的作业路径规划及控制方法
WO2019114222A1 (zh) 一种植保无人机自主路径规划方法
CN108803612A (zh) 一种海流影响下的无人巡检船直线航迹跟踪实现方法
CN108594807B (zh) 一种无人水面艇折线路径跟踪控制系统及方法
CN104881045A (zh) 嵌入式视觉引导下仿生机器鱼三维追踪控制方法
CN109634276A (zh) 农用车辆无人驾驶控制方法、系统及该农用车辆
CN108664020A (zh) 一种基于速度障碍法和动态窗口法的无人艇动态避障算法
CN106774335A (zh) 基于多目视觉和惯导的导引装置、地标布局及导引方法
CN108609014A (zh) 智能车辆的横向控制方法及装置
CN105116885B (zh) 一种基于人工标识的自动投饵作业船视觉导航方法
CN112269376B (zh) 一种移动式增氧机的作业路径规划及控制方法
CN107544534A (zh) 一种基于bds、ins的植保无人机自动精细作业及避障方法
CN111506062B (zh) 一种全自动施药船及均匀洒药方法
CN114586722B (zh) 一种智能投料无人船及其投料方法
CN108045435A (zh) 一种路面自适应的智能车辆横向混合控制方法
CN108121338B (zh) 一种usv的航迹闭环控制方法
CN111348161A (zh) 一种应用于海洋牧场的资源环境监测系统及其操作方法
CN108919800A (zh) 一种船舶智能列队航行系统
CN110398249A (zh) 一种结合环境特征的用于自动巡航的路径规划方法
CN114281083A (zh) 一种基于混合路径规划自主导航的无人船水质监测物联网控制系统及方法
CN111176281A (zh) 基于象限法的多水面无人艇覆盖式协同搜索方法及系统
CN111830968B (zh) 一种多功能莼菜无人作业船及其导航控制方法
CN105164014B (zh) 本机姿态显示装置

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant
TR01 Transfer of patent right
TR01 Transfer of patent right

Effective date of registration: 20220222

Address after: 213161 Room 518, block C, Tianrun science and technology building, No. 18-3, Changwu Middle Road, Wujin District, Changzhou City, Jiangsu Province

Patentee after: Changzhou huierda Intelligent Equipment Co.,Ltd.

Address before: Zhenjiang City, Jiangsu Province, 212013 Jingkou District Road No. 301

Patentee before: JIANGSU University