您的位置:
首页
>
农业专利
>
详情页
一种水产养殖作业船自动导航路径跟踪方法
- 专利权人:
- 江苏大学
- 发明人:
- 赵德安,罗吉,孙月平,洪剑青
- 申请号:
- CN201610095261.5
- 公开号:
- CN105629976A
- 申请日:
- 2016.02.22
- 申请国别(地区):
- 中国
- 年份:
- 2016
- 代理人:
- 摘要:
- 本发明公开了一种水产养殖作业船自动导航路径跟踪方法。该方法包括以下步骤:第一步:采集反映作业区轮廓的角点的位置信息,经轨迹规划,得到作业船的目标航线和航速;第二步:采集作业船实时的位置、航向和航速等数据,设定作业船的航行速度并判断是否需要切换目标路径;第三步:采用实时插点的方法计算出作业船的跟踪目标点;第四步:将作业船的位姿和运动状态数据与跟踪目标点及目标路径进行对比分析,得到航向与航速偏差,通过PD、PI算法得出航向与航速控制量,最终得到左右明轮控制量;第五步:根据最终的控制量对作业船进行实时导航控制。本发明能显著提高自动导航路径跟踪的效果,为水草清理和均匀投饵作业的高效完成提供了保障。
- 来源网站:
- 中国工程科技知识中心
- 来源网址:
- http://www.ckcest.cn/home/