CN109521775A - 一种无人艇自动返航控制系统及方法 - Google Patents

一种无人艇自动返航控制系统及方法 Download PDF

Info

Publication number
CN109521775A
CN109521775A CN201811622464.0A CN201811622464A CN109521775A CN 109521775 A CN109521775 A CN 109521775A CN 201811622464 A CN201811622464 A CN 201811622464A CN 109521775 A CN109521775 A CN 109521775A
Authority
CN
China
Prior art keywords
unmanned boat
rudder angle
return voyage
scm managing
managing system
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.)
Pending
Application number
CN201811622464.0A
Other languages
English (en)
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.)
Zhuhai Hantuda Technology Co Ltd
Original Assignee
Zhuhai Hantuda Technology Co Ltd
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 Zhuhai Hantuda Technology Co Ltd filed Critical Zhuhai Hantuda Technology Co Ltd
Priority to CN201811622464.0A priority Critical patent/CN109521775A/zh
Publication of CN109521775A publication Critical patent/CN109521775A/zh
Pending legal-status Critical Current

Links

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/0206Control of position or course in two dimensions specially adapted to water vehicles
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S19/00Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/01Satellite radio beacon positioning systems transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/13Receivers
    • G01S19/33Multimode operation in different systems which transmit time stamped messages, e.g. GPS/GLONASS
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S19/00Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/38Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
    • G01S19/39Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/42Determining position
    • G01S19/45Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Automation & Control Theory (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

本发明涉及一种无人艇自动返航控制系统及方法,所述方法包括:遥控器发出自动返航指令、单片机处理系统进行数据解析、PLC系统数据运算并驱动转舵机构,使无人艇返回停靠点的步骤。无人艇自动返航控制系统包括:遥控器与所述单片机处理系统连接,遥控器将自动返航指令经无线网络发送给所述单片机处理系统,单片机处理系统用于对无人艇方位数据以及遥控器所在坐标数据进行解析以及修正,单片机处理系统与定位系统连接,PLC系统分别与单片机处理系统、舵角反馈器以及转舵机构连接,PLC系统控制所述转舵机构转舵。本发明提供的自动返航系统及方法,全程无需人工干预,提高了转舵精度,实现快速自动返航,减少了操舵者的工作量。

Description

一种无人艇自动返航控制系统及方法
技术领域
本发明涉及无人艇自动控制领域,尤其涉及一种新型的无人艇自动返航控制系统及方法。
背景技术
无人艇的兴起对传统的转舵方式提出了新的要求,新型的智能化操舵取代常规的液压舵机在我国的应用越来越多。无人艇自动返航控制系统及方法优异的操舵性能,便于操作、维修、节能,良好的稳定性和安全性等优点受到了广大船东的欢迎。
无人艇没有自动返航控制系统时存在的问题在于:
1)无人艇在手动控制返航时需要反复操舵:由于受到船体本身的缺陷,或者无人艇内部配重不平衡,水流和风力等因素的影响,无人艇在输出0度舵角时并不能沿直线行驶,而是会受到外力因素,逐渐偏离原来的航向,无人艇的操控者需要根据目测来不断修正航向,而且目测容易出现各种误差,此项工作非常繁琐,需要长时间保持专注操舵,容易造成身心疲劳,出现各种误操作。
2)无人艇在复杂的水域尤其是出现视觉障碍时操舵返航困难,来自人工干预的航向操作存在一定的延迟,再加上无人艇本身的惯性,导致实际航线与理想中的航线存在偏差,尤其是当无人艇的视频出现故障或者遇到雨雾天气时,能见度极低,无法判断无人艇所在的位置和船头方位,这对人工操控无人艇返航会造成极大的困扰。
发明内容
为了解决上述问题,本发明提供了一种无人艇自动返航控制系统及方法,所述方法包括以下步骤:
1)由遥控器发出自动返航指令,通过无线通讯发送给无人艇单片机处理系统;
2)所述单片机处理系统接收上述自动返航指令后,所述单片机处理系统对所述遥控器实时坐标进行解析;
3)此时,GPS定位系统将此时的无人艇定位坐标传递至所述单片机处理系统,并结合三维电子罗盘反馈的实际方位角信息,所述单片机处理系统进行数据分析处理,并得出一个舵角值;
4)所述单片机处理系统将得到的舵角值传递给PLC系统,PLC系统将接收到的舵角值与舵角反馈器反馈的实际舵角值进行比较运算;
5)驱动转舵机构,使无人艇返回停靠点。
进一步地,所述步骤4)中计算得到的舵角值与所述舵角反馈器反馈的实际舵角值比较,当舵角值大于实际舵角值时,驱动所述转舵机构右转舵;当舵角值小于实际舵角值时,驱动所述转舵机构左转舵。
一种无人艇自动返航控制系统,所述系统包括:遥控器、单片机处理系统、PLC系统、定位系统、舵角反馈器以及转舵机构,所述遥控器与所述单片机处理系统连接,所述遥控器将自动返航指令经无线网络发送给所述单片机处理系统,所述单片机处理系统用于对无人艇方位数据以及遥控器所在坐标数据进行解析以及修正,所述单片机处理系统与所述定位系统连接,所述PLC系统分别与所述单片机处理系统、舵角反馈器以及转舵机构连接,所述PLC系统控制所述转舵机构转舵。
进一步地,所述定位系统包括北斗加GPS定位和三维电子罗盘,所述北斗加GPS定位与所述三维电子罗盘分别设置于所述单机片处理系统的两端。
本发明的一种无人艇自动返航控制系统及方法的优点在于:无人艇自动返航控制系统采用单片机处理系统和PLC系统来控制转舵机构,并由GPS定位、三维电子罗盘和舵角反馈器一起组成一个闭环控制网络,再加上单片机处理系统上运行的高效算法。无人艇自动返航系统是一个全自动、智能化控制系统,包含了转舵控制,全程无需人工干预,一键自动执行,自行修正偏差。并且本发明的无人艇自动返航控制方法,提高了转舵精度,实现快速自动返航,同时大大的减少了操舵者的工作量。
附图说明
图1是本发明的无人艇自动返航控制系统的结构示意图。
图2是本发明无人艇自动返航控制的实例示意图。
具体实施方式
以下将结合附图及具体实施例,对本发明的一种无人艇自动返航控制系统及方法进行进一步地详细说明。
如图1所示的本发明的无人艇自动返航控制系统的结构示意图,所述系统包括:遥控器、单片机处理系统、PLC系统、定位系统、舵角反馈器以及转舵机构,所述遥控器与所述单片机处理系统连接,所述遥控器将自动返航指令经无线网络发送给所述单片机处理系统,所述单片机处理系统用于对无人艇方位数据以及遥控器所在坐标数据进行解析以及修正,所述单片机处理系统与所述定位系统连接,所述PLC系统分别与所述单片机处理系统、舵角反馈器以及转舵机构连接,所述PLC系统控制所述转舵机构转舵。
根据本发明的实施例,所述定位系统包括北斗加GPS定位和三维电子罗盘,所述北斗加GPS定位与所述三维电子罗盘分别设置于所述单机片处理系统的两端。
一种无人艇自动返航控制方法,所述方法包括以下步骤:
1)由遥控器发出自动返航指令,通过无线通讯发送给无人艇单片机处理系统;
2)所述单片机处理系统接收上述自动返航指令后,所述单片机处理系统对所述遥控器实时坐标进行解析;
3)此时,GPS定位系统将此时的无人艇定位坐标传递至所述单片机处理系统,并结合三维电子罗盘反馈的实际方位角信息,所述单片机处理系统进行数据分析处理,并得出一个舵角值;
4)所述单片机处理系统将得到的舵角值传递给PLC系统,PLC系统将接收到的舵角值与舵角反馈器反馈的实际舵角值进行比较运算;
5)驱动转舵机构,使无人艇返回停靠点。
根据本发明的实施例,所述步骤4)中计算得到的舵角值与所述舵角反馈器反馈的实际舵角值比较,当舵角值大于实际舵角值时,驱动所述转舵机构右转舵;当舵角值小于实际舵角值时,驱动所述转舵机构左转舵。
实施例一
如图2所示的本发明无人艇自动返航控制的实例示意图,图中的无人艇操控者在遥控上发出自动返航指令和遥控器的实时坐标a。
无人艇接收到该信号以后,先由单片机处理系统先对遥控器坐标进行解析,得到其坐标是a(a1,a2),综合无人艇上GPS定位系统传过来的无人艇定位数据b(b1,b2),进行反三角函数运算,
计算出a、b两者之间的相对方位角:c=arctan[ (b1-a1)/(b2-a2)],
然后结合三维电子罗盘传过来的无人艇实时方位角d,无人艇单片机处理系统进行偏差运算,计算出一个舵角值:
e(t)= arctan[ (b1-a1)/(b2-a2)]-d;
u(t)=kp(e(t)+1/TI∫e(t)dt+TD*de(t)/dt) ;
其中kp为比例系数, TI为积分时间常数, TD为微分时间常数,这三个系数跟无人艇本身的属性有关,需要根据船体特性修改相关系数, dt为时间变量,根据定为时间的变化而改变。
单片机处理系统计算出舵角数据以后通过RS485通讯传给给PLC系统,所述PLC系统收到这个舵角信号以后,与当前舵角反馈器反馈的实际舵角u1(t)进行对比,当u(t)>u1(t)时,驱动所述转舵机构右转舵;当u(t)<u1(t)时, 驱动所述转舵机构左转舵。努力使实际方位角d不断向相对方位角c靠拢。
在无人艇移动过程中,无人艇本身的坐标和方位都是不断变化的,当无人艇航行到图2中的f(f1,f2)点位置时,加入遥控器的位置不发生变化,那么此时无人艇和遥控之间的相对方位角变为h,那么单片机处理系统按照上述计算方式运算之后会输出一个舵角为u2(t),PLC系统将通过舵角反馈器反馈回来的实际舵角为u3(t),将两个舵角值进行比较后,PLC系统将根据对比结果不断调整转舵机构,使实际方位角g不断向相对方位角h靠拢。
这此时遥控器和无人艇之间的距离会原来越近,最终实现无人艇的自动返航。全程的计算也操控全部由单片机、传感器和PLC等系统合作完成,无须人工干预,安全、高效、快捷,使用者只需在开始的时候点下自动返航的按键发出自动返航指令即可。
经过厂内的多次试验以及运用到内河船上,证实了这种新型的无人艇自动返航控制系统可以完美的实现无人艇的自动返航功能,并同时消除了因为频繁的人工操作带来的不稳定,减少了恶劣环境下操控的种种不便利,已经在国内市场上得到了多次应用验证并取得良好的效果。
在本说明书的描述中,参考术语“一个实施例”、“一些实施例”、“示例”、“具体示例”、 或“一些示例”等的描述意指结合该实施例或示例描述的具体特征、结构、材料或者特点包含于本发明的至少一个实施例或示例中。在本说明书中,对上述术语的示意性表述不必针对的是相同的实施例或示例。而且,描述的具体特征、结构、材料或者特点可以在任一个 或多个实施例或示例中以合适的方式结合。此外,在不相互矛盾的情况下,本领域的技术人员可以将本说明书中描述的不同实施例或示例以及不同实施例或示例的特征进行结合和组合。

Claims (4)

1.一种无人艇自动返航控制方法,其特征在于,所述方法包括以下步骤:
1)由遥控器发出自动返航指令,通过无线通讯发送给无人艇单片机处理系统;
2)所述单片机处理系统接收上述自动返航指令后,所述单片机处理系统对所述遥控器实时坐标进行解析;
3)此时,GPS定位系统将此时的无人艇定位坐标传递至所述单片机处理系统,并结合三维电子罗盘反馈的实际方位角信息,所述单片机处理系统进行数据分析处理,并得出一个舵角值;
4)所述单片机处理系统将得到的舵角值传递给PLC系统,PLC系统将接收到的舵角值与舵角反馈器反馈的实际舵角值进行比较运算;
5)驱动转舵机构,使无人艇返回停靠点。
2.根据权利要求1所述的无人艇自动返航控制方法,其特征在于,所述步骤4)中计算得到的舵角值与所述舵角反馈器反馈的实际舵角值比较,
当舵角值大于实际舵角值时,驱动所述转舵机构右转舵;
当舵角值小于实际舵角值时,驱动所述转舵机构左转舵。
3.一种无人艇自动返航控制系统,其特征在于,所述系统包括:遥控器、单片机处理系统、PLC系统、定位系统、舵角反馈器以及转舵机构,
所述遥控器与所述单片机处理系统连接,所述遥控器将自动返航指令经无线网络发送给所述单片机处理系统,
所述单片机处理系统用于对无人艇方位数据以及遥控器所在坐标数据进行解析以及修正,所述单片机处理系统与所述定位系统连接,
所述PLC系统分别与所述单片机处理系统、舵角反馈器以及转舵机构连接,
所述PLC系统控制所述转舵机构转舵。
4.根据权利要求3所述的无人艇动力定位控制系统,其特征在于:所述定位系统包括北斗加GPS定位和三维电子罗盘,所述北斗加GPS定位与所述三维电子罗盘分别设置于所述单机片处理系统的两端。
CN201811622464.0A 2018-12-28 2018-12-28 一种无人艇自动返航控制系统及方法 Pending CN109521775A (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201811622464.0A CN109521775A (zh) 2018-12-28 2018-12-28 一种无人艇自动返航控制系统及方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201811622464.0A CN109521775A (zh) 2018-12-28 2018-12-28 一种无人艇自动返航控制系统及方法

Publications (1)

Publication Number Publication Date
CN109521775A true CN109521775A (zh) 2019-03-26

Family

ID=65797770

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201811622464.0A Pending CN109521775A (zh) 2018-12-28 2018-12-28 一种无人艇自动返航控制系统及方法

Country Status (1)

Country Link
CN (1) CN109521775A (zh)

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2000284042A (ja) * 1999-01-29 2000-10-13 Denkoosha:Kk 遠隔操縦釣り用無人ボートおよびその遠隔操縦装置
CN205920408U (zh) * 2016-08-01 2017-02-01 深圳市嘉宝渔具科技有限公司 一种自动返航遥控船系统
US20170291670A1 (en) * 2016-04-08 2017-10-12 Texas Marine & Offshore Projects LLC Autonomous workboats and methods of using same
CN107436600A (zh) * 2017-01-24 2017-12-05 安徽科微智能科技有限公司 一种无人船多航点返航控制系统
CN109002036A (zh) * 2018-04-25 2018-12-14 深圳臻迪信息技术有限公司 一种无人船一键返航控制系统及方法

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2000284042A (ja) * 1999-01-29 2000-10-13 Denkoosha:Kk 遠隔操縦釣り用無人ボートおよびその遠隔操縦装置
US20170291670A1 (en) * 2016-04-08 2017-10-12 Texas Marine & Offshore Projects LLC Autonomous workboats and methods of using same
CN205920408U (zh) * 2016-08-01 2017-02-01 深圳市嘉宝渔具科技有限公司 一种自动返航遥控船系统
CN107436600A (zh) * 2017-01-24 2017-12-05 安徽科微智能科技有限公司 一种无人船多航点返航控制系统
CN109002036A (zh) * 2018-04-25 2018-12-14 深圳臻迪信息技术有限公司 一种无人船一键返航控制系统及方法

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
熊远生等: "数字式航向航迹自动操舵仪的设计与实现", 《中国惯性技术学报》 *

Similar Documents

Publication Publication Date Title
CN110673598B (zh) 一种水面无人艇智能路径跟踪控制方法
CN106990787B (zh) 一种上下体艏向信息融合的波浪滑翔器航点跟踪方法
CN109460043A (zh) 一种基于多模态非奇异终端滑模船舶航迹自抗扰控制方法
CN109283842A (zh) 一种无人艇航迹跟踪智能学习控制方法
CN108594846A (zh) 一种障碍环境下多auv编队队形优化控制方法
EP3287862A1 (en) Method for steering an underactuated ship
CN110609556A (zh) 一种基于los导航法的多无人艇协同控制方法
CN108153311A (zh) 面向无人艇编队的智能控制系统及控制方法
CN108549396B (zh) 一种基于stm32f429的双电机驱动无人船控制系统
CN110006419A (zh) 一种基于预瞄的车辆轨迹跟踪点确定方法
CN110377036A (zh) 一种基于指令约束的无人水面艇航迹跟踪固定时间控制方法
CN102102522A (zh) 盾构掘进过程中的轨迹姿态复合控制方法
CN104932531B (zh) 一种基于滑模控制的四旋翼飞行器的最优抗输入饱和控制方法
CN101881970A (zh) 船舶双舵同步控制方法
CN106444359A (zh) 一种喷水推进无人艇自主区域保持的仿人智能控制方法
CN111930132A (zh) 一种用于水下自主航行器的航迹控制方法
CN114779791A (zh) 一种波浪滑翔器位置保持方法及系统
CN109814583B (zh) 基于自主水下机器人航向运动的动态状态反馈控制方法
CN104459636A (zh) 多雷达天线协同控制方法
CN111650943A (zh) 一种速度受限的静水下动力定位船轨迹跟踪预设性能控制方法
CN205801488U (zh) 船舶操舵随动控制装置
CN109521775A (zh) 一种无人艇自动返航控制系统及方法
CN116520834B (zh) 一种低能耗的无人船巡航方法
CN111176292B (zh) 一种基于侧边距的波浪滑翔器路径跟踪控制方法
CN112180915A (zh) 基于ros的双推力无人船运动控制系统及控制方法

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
RJ01 Rejection of invention patent application after publication
RJ01 Rejection of invention patent application after publication

Application publication date: 20190326