CN107229276A - 基于ARM Cortex‑M7处理器的智能无人船平台及其控制方法 - Google Patents
基于ARM Cortex‑M7处理器的智能无人船平台及其控制方法 Download PDFInfo
- Publication number
- CN107229276A CN107229276A CN201710390327.8A CN201710390327A CN107229276A CN 107229276 A CN107229276 A CN 107229276A CN 201710390327 A CN201710390327 A CN 201710390327A CN 107229276 A CN107229276 A CN 107229276A
- Authority
- CN
- China
- Prior art keywords
- control
- ship
- module
- speed
- information
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 14
- 238000004891 communication Methods 0.000 claims abstract description 20
- 238000012545 processing Methods 0.000 claims abstract description 10
- 230000005540 biological transmission Effects 0.000 claims description 57
- 230000005611 electricity Effects 0.000 claims description 15
- 230000004888 barrier function Effects 0.000 claims description 10
- 238000001514 detection method Methods 0.000 claims description 10
- 238000005183 dynamical system Methods 0.000 claims description 9
- WHXSMMKQMYFTQS-UHFFFAOYSA-N Lithium Chemical compound [Li] WHXSMMKQMYFTQS-UHFFFAOYSA-N 0.000 claims description 6
- 229910052744 lithium Inorganic materials 0.000 claims description 6
- 230000000087 stabilizing effect Effects 0.000 claims description 5
- 238000012546 transfer Methods 0.000 claims description 5
- DMBHHRLKUKUOEG-UHFFFAOYSA-N diphenylamine Chemical compound C=1C=CC=CC=1NC1=CC=CC=C1 DMBHHRLKUKUOEG-UHFFFAOYSA-N 0.000 claims description 4
- 230000007306 turnover Effects 0.000 claims description 4
- 230000001133 acceleration Effects 0.000 claims description 2
- 230000015654 memory Effects 0.000 abstract description 5
- 238000007667 floating Methods 0.000 abstract description 4
- 230000004044 response Effects 0.000 abstract description 4
- 230000006870 function Effects 0.000 description 4
- 230000009467 reduction Effects 0.000 description 4
- 238000011161 development Methods 0.000 description 3
- 238000005516 engineering process Methods 0.000 description 3
- 238000012423 maintenance Methods 0.000 description 3
- 230000006399 behavior Effects 0.000 description 2
- 238000004364 calculation method Methods 0.000 description 2
- 238000005265 energy consumption Methods 0.000 description 2
- 239000000284 extract Substances 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 241000251468 Actinopterygii Species 0.000 description 1
- 230000008878 coupling Effects 0.000 description 1
- 238000010168 coupling process Methods 0.000 description 1
- 238000005859 coupling reaction Methods 0.000 description 1
- 238000007405 data analysis Methods 0.000 description 1
- 238000001914 filtration Methods 0.000 description 1
- 238000005065 mining Methods 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 description 1
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
- G01—MEASURING; TESTING
- G01S—RADIO 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/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/01—Satellite radio beacon positioning systems transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/13—Receivers
- G01S19/33—Multimode operation in different systems which transmit time stamped messages, e.g. GPS/GLONASS
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO 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/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
- G01S19/39—Determining 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/42—Determining position
- G01S19/45—Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement
- G01S19/47—Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement the supplementary measurement being an inertial measurement, e.g. tightly coupled inertial
-
- G—PHYSICS
- G08—SIGNALLING
- G08C—TRANSMISSION SYSTEMS FOR MEASURED VALUES, CONTROL OR SIMILAR SIGNALS
- G08C17/00—Arrangements for transmitting signals characterised by the use of a wireless electrical link
- G08C17/02—Arrangements for transmitting signals characterised by the use of a wireless electrical link using a radio link
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)
- Traffic Control Systems (AREA)
Abstract
本发明涉及一种基于ARM Cortex‑M7处理器的智能无人船平台及其控制方法,包括:岸端控制***、船载控制***及连接岸端控制***与船载控制***的通信***。ARM Cortex‑M7处理器工作频率高达800MHz,取代了绝大多数分立的DSP处理器,它采用分支预测的6级超标量流水线,这样可以同时支持单精度和双精度浮点单元,快速提供计算性能,适合大规模的数字信号处理,具有紧密耦合内存接口,提供快速实时响应。可以高效地利用CPU,既支持抢占式多任务,也支持协作式多任务。
Description
技术领域
本发明属于计算机通信及自动化领域,尤其涉及一种基于ARM Cortex-M7处理器的智能无人船平台及其控制方法。
背景技术
无人船平台在保护海洋环境和开发海洋资源方面有着广泛应用,搭载不同的传感器***可以完成各种各样的任务,是监测海洋环境、观测海洋水文数据、勘探海洋资源和海洋灾害预警的重要手段之一。在军事方面无人船也扮演着重要的角色,它能够完成的军事任务有:港口安全,扫雷和靶船等。在工业上可用于一些水中设备的远程维护,工业开采等方面。在民用方面,可作为娱乐用途,也可用于钓鱼,还可以用于探索鱼群等。无论在科研方面,还是军事方面,或者工业上以及民用方面,都有着广阔的应用前景。
随着无人船在各个领域应用的逐步扩展,对无人船的要求也越来越高,无论是在导航的精度及准确性,还是避障的及时性,还是无人船控制***所占体积,亦或是无人船的兼容性和可扩展性,都提出了很严苛的要求。无人船应用在不同的领域,需搭载不同的传感器,这对无人船控制***的兼容性和可扩展性提出了很高的要求。且随着无人船功能特性的增加,以及所应对的环境越来越复杂,需要处理的数据量也在极速增加,这就需要无人船处理器有更高的数据处理、数据分析以及数据传输能力。
发明内容
本发明所要解决的技术问题是,提供一种基于ARM Cortex-M7处理器的智能无人船平台及其控制方法,具有良好的兼容性和可扩展性,搭载不同的信息采集模块可以完成各种各样的任务,利用ARM Cortex-M7处理器强大的数字信号处理能力,提高处理能力,实现复杂的控制算法;利用GPS/北斗定位模块与捷联式惯性导航模块组合导航,提高了导航、定位的精度;提高控制***的兼容性和可扩展性、以及远程维护和升级能力,利用嵌入式操作***低能耗的特点,提高无人船的续航能力。
为达到上述目的,本发明采取的技术方案是构建一种基于ARM Cortex-M7处理器的智能无人船平台,实现了无人船的自主航行、自主避障、路径规划及视频传输功能,包括岸端控制***、船载控制***及连接岸端控制***与船载控制***的通信***;
岸端控制***用于自动或/和手动实时控制无人船,并实时显示无人船状态信息及周边环境信息,以及向船载控制***发送命令,包括岸端上位机、遥控器;
船载控制***主要用于实现无人船自主航行及自主避障,视频拍摄及传输,以及接收岸端上位机发来的命令并实时传送相关数据给上位机;通信***是整个平台沟通的桥梁。所述的船载控制***包括ARM Cortex-M7处理器、信息采集模块、视频传输模块、电池电压检测***、驱动模块及动力***;ARM Cortex-M7处理器分别与信息采集模块、视频传输模块、电池电压检测***、驱动模块相连,动力***为船载控制***提供电能;
所述的ARM Cortex-M7处理器包括自主航行单元、自主避障单元、方向及速度控制单元;自主航行单元、自主避障单元的输入与信息采集模块相连,自主航行单元、自主避障单元的输出与方向及速度控制单元相连,速度控制单元的输出与驱动模块相连。
所述通信***设有:两个无线数传电台,其中一个通过RS232转USB转接板与岸端上位机连接,另一个与ARM Cortex-M7处理器连接,两个无线数传电台采用MAVLink协议实现数据传输两个无线图传模块,其中一个与岸端上位机连接,另一个与视频传输模块连接,实现视频传输,以及配置在无线数传电台与无线图传模块上的若干增益天线。
具体地,所述岸端上位机以PC机为载体,无线数传电台有两个,采用全双工无线通信方式,一个通过RS232转USB转接板与PC机连接,一个通过RS232接口与ARM Cortex-M7处理器连接,采用MAVLink协议实现数据传输,最远传输距离可达64Km。无线图传模块有两个,采用半双工无线通信方式,一个与PC机连接,一个与摄像机连接,实现视频传输,最远传输距离可达23Km。无线数传电台与无线图传模块均配置高增益天线。所述无线数传电台为9XTend OEM RF低功耗模块,无线图传模块为AOMWAY5.8G无线图传模块。
所述岸端上位机包括通信设置模块、模式选择模块、***控制模块、PID控制模块、船状态信息显示模块和船控制信息设置模块;所述船控制信息设置模块包括经纬度控制单元、目标船速控制单元、目标航向控制单元、电机PWM控制单元、舵机PWM控制单元以及电机启动和停止控制单元;所述的船状态信息包括无人船平台的经度、纬度及所在半球信息,当前航速、当前航向、加速度、俯仰角、横滚角、航向角、电机PWM、舵机PWM及电池电压信息,当前无人船所行驶的轨迹。
所述信息采集模块包括:GPS/北斗定位模块,用于采集无人船的当前位置、当前航向、当前航速;捷联式惯性导航模块,用于采集当前航向、当前航速、姿态信息;激光雷达,用于采集周围环境中障碍物信息;接收机,用于接收岸端控制***的遥控器的遥控指令。
所述驱动模块包括电调、电机及舵机。
锂电池电压为12V,为ARM Cortex-M7处理器、电调、无线图传模块供电。通过稳压降压模块将12V电源电压降为5V电压输出,供电给舵机、GPS/北斗定位模块和激光雷达。
所述智能无人船平台的控制方法具体如下:
岸端控制***选择无人船平台的控制模式,所述的控制模式包括手动遥控、自主导航及手动遥控和自主导航同时运行三种模式;其中手动遥控是指用遥控器发送指令给船载控制***的接收机的方式对无人船平台发送控制指令,并用上位机显示无人船状态信息,所述的自主导航是指岸端控制***通过无线数传电台的方式对无人船平台发送规划航线的位置信息,由主航行单元自主导航,并由自主避障单元进行避障;
岸端控制***以被选择的控制模式向船载控制***发送指令实时控制无人船平台,船载控制***通过无线数传电台和无线图传模块分别向岸端控制***实时发送无人船状态信息及周边环境信息,
信息采集模块的GPS/北斗定位模块采集当前位置、当前航向、当前航速,捷联式惯性导航模块分别同时采集当前航向、当前航速、姿态信息;激光雷达采集周围环境中障碍物信息;
在自主导航模式下,ARM Cortex-M7处理器读取信息采集模块采集的信息,一方面将所述信息通过无线数传电台发送给岸端上位机,一方面根据采集的信息和岸端上位机发送过来的规划航线的位置信息由自主航行单元、自主避障单元输出信号给方向及速度控制单元,方向及速度控制单元再输出控制信号给驱动模块;岸端上位机可向船载控制***直接发送目标航向、目标航速指令,在该情况下,方向及速度控制单元根据岸端上位机的指令输出控制信号给驱动模块;
其中,自主航行单元根据无人船的当前位置、当前航向与当前航速,与岸端上位机规划好的航线比较,通过航向控制方法及PID控制实时输出给定航向偏差、给定航速给方向及速度控制单元;
自主避障单元根据激光雷达检测到的障碍物信息以及无人船的当前位置、当前航向与当前航速,给定航向差、给定速度给方向及速度控制单元来实时躲避障碍物;当有障碍物时,较自主航行单元,处理器优先响应自主避障单元,直到成功躲避障碍物,没有障碍物时,自主避障单元没有输出。
方向及速度控制单元根据岸端上位机的控制指令,或自主航行单元及自主避障单元输出的给定航向差、给定速度计算舵机PWM值、电机PWM值,并输出给驱动模块;
驱动模块通过电调、电机及舵机调整无人船的航向与航速;
视频传输模块包含摄像机,摄像机摄像获取无人船周边环境实时情况,通过无线图传模块、高增益天线将视频实时传输回岸端控制***。
优选的,通信设置模块选择串口号、波特率,打开或关闭串口,模式选择模块选择手动遥控、自主导航及手动遥控和自主导航同时运行三种模式,***控制模块用于开启***、关闭***或重启***;PID控制模块用于航速PID控制、航向PID控制,船状态信息显示模块显示船状态信息,并可以加载地图显示当前无人船所行驶的轨迹,且可在此地图上规划航迹以及设置回航点;
船控制信息设置模块用于设置有效工作参数,其中:
经纬度控制单元输入目标点的经纬度信息,岸端上位机根据目标点与当前无人船平台位置规划航线,并将所规划好的航线的位置信息发送给船载控制***,
目标航速控制单元用于设置目标船速,方向及速度控制单元根据当前航速与目标航速在来调节电机PWM输出值,以控制无人船达到目标航速;
目标航向控制单元设置有效目标航向,方向及速度控制单元根据当前航向与目标航向来调节舵机PWM输出值,以控制无人船达到目标航向;
电机PWM控制单元输入有效电机PWM值,以控制电机达到相应的转速,所述有效电机PWM值为能使电机正常转动的电机PWM值;
舵机PWM控制单元输入有效舵机PWM值,以控制舵机转过相应的角度,所述有效舵机PWM值为能使舵机正常转过一定角度的舵机PWM值;
电机启动和停止控制单元分别启动电机和使电机停止转动。
优选的,所述电池电压检测***检测无人船的电池状态,并将电池信息通过无线数传电台传回单端控制***,在低电量状态时,发出警报。
具体地,所述遥控器通过2.4G无线网络发送信号给接收机,ARM Cortex-M7处理器读取并根据接收机的信号来控制无人船的航向及航速。
具体地,所述ARM Cortex-M7处理器用于接收上位机发送的指令、向上位机发送指令及读取各式传感器的数据并进行处理,其工作频率高达800MHz,取代了绝大多数分立的DSP处理器,它采用分支预测的6级超标量流水线,这样可以同时支持单精度和双精度浮点单元,快速提供计算性能,适合大规模的数字信号处理,具有紧密耦合内存接口,提供快速实时响应。
进一步地,所述GPS/北斗定位模块通过串口与ARM Cortex-M7处理器连接,ARMCortex-M7处理器读取GPS的数据信息并提取其中的经度、纬度、所在经纬度半球、航向、航速信息。
进一步地,所述激光雷达内嵌信号处理模块实时解算,通过串口与ARM Cortex-M7处理器连接,直接输出障碍物的距离以及相对方位角度给ARM Cortex-M7处理器,减少了ARM Cortex-M7处理器的运算量。
进一步地,所述捷联式惯性导航模块通过IIC接口与ARM Cortex-M7处理器连接,通过航向、姿态解算及导航解算获得无人船的航向、姿态、位置及速度。
更进一步地,所述组合导航为以捷联式惯性导航模块为主,GPS/北斗定位模块对捷联式惯性导航模块进行修正。通过Kalman滤波技术对组合导航的误差状态进行估计,并采用反馈校正的方法修正捷联式惯性导航模块的导航误差,得到最终的当前位置、当前航速与当前航向。
具体地,动力***包括锂电池、稳压降压模块。
本发明利用GPS/北斗定位模块传与捷联式惯性导航模块组合导航,提高了导航、定位的精度;提高控制***的兼容性和可扩展性、以及远程维护和升级能力,利用嵌入式操作***低能耗的特点,提高无人船的续航能力;利用ARM Cortex-M7处理器取代了绝大多数分立的DSP处理器,大幅提升了运算能力,它采用分支预测的6级超标量流水线,这样可以同时支持单精度和双精度浮点单元,快速提供计算性能,适合大规模的数字信号处理,具有紧密耦合内存接口,提供快速实时响应,利用ARM Cortex-M7强大的数字信号处理能力,提高对于控制算法的处理能力,实现复杂的控制算法。极大的缩小了控制***所占体积,为搭载不同传感器实现无人船不同的使用功能,提供了一个良好的无人船平台。
附图说明
图1为智能无人船平台模型结构图。
图2为智能无人船平台实施例的结构图。
具体实施方式
随着无人机技术的兴起,各种无人设备得到广泛应用,无人船在科研方面,军事方面,工业上以及民用方面,得到越来越多的应用,因此本发明提供一种基于ARM Cortex-M7处理器的智能无人船平台,包括无人船岸端控制***、船载控制***以及连接岸端控制***与船载控制***的通信***,有无人船自动、手动或自动与手动同时控制三种模式,实现了无人船的自主航行、自主避障、路径规划及视频传输等基本功能。利用GPS/北斗定位模块传与捷联式惯性导航模块组合导航,提高了导航、定位的精度。
下面结合附图及具体实施方式对本发明再作进一步详细说明。
如图1和2所示,本发明采取的技术方案是构建一种基于ARM Cortex-M7处理器的智能无人船平台,实现了无人船的自主航行、自主避障、路径规划及视频传输功能,包括岸端控制***、船载控制***及连接岸端控制***与船载控制***的通信***;岸端控制***用于自动或/和手动实时控制无人船,并实时显示无人船状态信息及周边环境信息,以及向船载控制***发送命令,包括岸端上位机、遥控器;船载控制***主要用于实现无人船自主航行及自主避障,视频拍摄及传输,以及接收岸端上位机发来的命令并实时传送相关数据给上位机;通信***是整个平台沟通的桥梁。所述的船载控制***包括ARM Cortex-M7处理器、信息采集模块、视频传输模块、电池电压检测***、驱动模块及动力***;ARMCortex-M7处理器分别与信息采集模块、视频传输模块、电池电压检测***、驱动模块相连,动力***为船载控制***提供电能;所述的ARM Cortex-M7处理器包括自主航行单元、自主避障单元、方向及速度控制单元;自主航行单元、自主避障单元的输入与信息采集模块相连,自主航行单元、自主避障单元的输出与方向及速度控制单元相连,速度控制单元的输出与驱动模块相连。
所述通信***设有:两个无线数传电台,采用全双工无线通信方式,其中一个通过RS232转USB转接板与岸端上位机连接,另一个与ARM Cortex-M7处理器连接,两个无线数传电台采用MAVLink协议实现数据传输,最远传输距离可达64Km。两个无线图传模块,采用半双工无线通信方式,其中一个与岸端上位机连接,另一个与视频传输模块连接,实现视频传输最远传输距离可达23Km。所述无线数传电台为9XTend OEM RF低功耗模块,无线图传模块为AOMWAY 5.8G无线图传模块。
具体地,所述ARM Cortex-M7处理器用于接收上位机发送的指令、向上位机发送指令及读取各式传感器的数据并进行处理,其工作频率高达800MHz,取代了绝大多数分立的DSP处理器,它采用分支预测的6级超标量流水线,这样可以同时支持单精度和双精度浮点单元,快速提供计算性能,适合大规模的数字信号处理,具有紧密耦合内存接口,提供快速实时响应。拟采用基于ARM Cortex-M7处理器的开发板-STM32F7Discovery作为智能无人船的嵌入式开发平台,该开发板216MHz的CPU频率、1024KB闪存、320KB SRAM。
具体地,所述信息采集模块主要是各式传感器和接收机,包括GPS/北斗定位模块、捷联式惯性导航模块、激光雷达,用于采集无人船的当前位置、当前航向、当前航速、姿态信息及周围环境中障碍物信息,一方面将这些信息发送给自主航行***和自主避障***,另一方面,通过无线数传模块传回岸端控制***。利用GPS/北斗定位模块与捷联式惯性导航模块组合导航,通过卡尔曼滤波得到当前位置、当前航向及当前航速信息。
所述遥控器通过2.4G无线网络发送信号给接收机,接收机与STM32F7 Discovery的IO口相连,STM32F7 Discovery通过输入捕获方式读取接收机的占空比信号后来控制电机及舵机,进而实现用遥控器手动遥控操作无人船的航向及航速。
进一步地,所述GPS/北斗定位模块通过串口与STM32F7 Discovery连接,STM32F7Discovery读取GPS的数据信息并提取其中的经度、纬度、所在经纬度半球、航向、航速信息。GPS/北斗定位模块为正点原子GPS+北斗双定位模块S1216。
进一步地,所述激光雷达内嵌信号处理模块实时解算,通过串口与STM32F7Discovery连接,直接输出障碍物的距离以及相对方位角度给STM32F7 Discovery,减少了MCU的运算量。激光雷达为EAI Flash Lidar激光雷达F4,基于三角测距技术原理,可实时获取所在环境的高精度轮廓信息。
进一步地,所述捷联式惯性导航模块通过IIC接口与STM32F7 Discovery连接,通过航向、姿态解算及导航解算获得无人船的航向、姿态、位置及速度。捷联式惯性导航模块为MPU9250九轴传感器。
更进一步地,所述组合导航为以MPU9250九轴传感器为主,正点原子GPS+北斗双定位模块S1216对MPU9250九轴传感器进行修正。通过Kalman滤波技术对组合导航的误差状态进行估计,并采用反馈校正的方法修正捷联式惯性导航模块的导航误差,得到最终的当前位置、当前航速与当前航向。
具体地,所述自主航行单元根据无人船的当前位置、当前航向与当前航速,与岸端上位机规划好的航线比较,PID控制实时输出给定航向偏差、给定航速给方向及速度控制***。
具体地,所述自主避障单元根据EAI Flash Lidar激光雷达F4检测到的障碍物信息,输出给定航向差、给定速度给方向及速度控制***来实时躲避障碍物。
具体地,所述电池电压检测***通过电压检测模块来检测无人船的电池电压状态,并将电池电压信息通过无线数传电台传回单端控制***,在低电压状态时,发出警报便于采取应对措施。电压检测模块将电池电压缩小5倍后作为STM32F7 DiscoveryA/D采样IO口的输入,STM32F7 Discovery对此电压进行简单对比后算出实际电源电压,以此判断无人船的续航能力。
具体地,所述视频传输模块主要用于了解无人船周边环境实时情况,摄像机摄像后便通过无线图传模块以及高增益天线将视频实时传输回岸端控制***。
具体地,所述驱动模块包括电调、电机及舵机,根据方向及速度控制***给出的舵机PWM值、电机PWM值改变航向及航速。电调为320A有刷电调,电机为550电机,舵机为55g数字舵机。
具体地,动力***包括锂电池、稳压降压模块。锂电池电压为12V,为STM32F7Discovery、电调、无线图传模块供电。通过稳压降压模块将12V电源电压降为5V电压输出,供电给舵机、GPS/北斗定位模块和激光雷达。
具体地,所述岸端上位机以Lenovo电脑为载体,无线数传电台通过RS232转USB转接板与Lenovo电脑连接,采用MAVLink协议实现数据传输,最远传输距离可达64Km,其中,所述无线数传电台为9XTend OEM RF低功耗模块。
具体地,所述岸端上位机以Lenovo电脑为载体,无线图传模块与Lenovo电脑连接实现视频传输,其中,所述无线图传模块为AOMWAY 5.8G无线图传模块。
具体地,所述无线数传模块采用全双工无线通信方式连接。
具体地,所述无线图传模块采用半双工无线通信方式连接。
Claims (9)
1.一种基于ARM Cortex-M7处理器的智能无人船平台,其特征在于包括岸端控制***、船载控制***及连接岸端控制***与船载控制***的通信***;
所述的岸端控制***包括岸端上位机、遥控器;
所述的船载控制***包括ARM Cortex-M7处理器、信息采集模块、视频传输模块、电池电压检测***、驱动模块及动力***;ARM Cortex-M7处理器分别与信息采集模块、视频传输模块、电池电压检测***、驱动模块相连,动力***为船载控制***提供电能;
所述的ARM Cortex-M7处理器包括自主航行单元、自主避障单元、方向及速度控制单元;自主航行单元、自主避障单元的输入与信息采集模块相连,自主航行单元、自主避障单元的输出与方向及速度控制单元相连,方向及速度控制单元的输出与驱动模块相连。
2.如权利要求1所述的智能无人船平台,其特征在于,所述岸端上位机包括通信设置模块、模式选择模块、***控制模块、PID控制模块、船状态信息显示模块和船控制信息设置模块;所述船控制信息设置模块包括经纬度控制单元、目标船速控制单元、目标航向控制单元、电机PWM控制单元、舵机PWM控制单元以及电机启动和停止控制单元;所述的船状态信息包括无人船平台的经度、纬度及所在半球信息,当前航速、当前航向、加速度、俯仰角、横滚角、航向角、电机PWM、舵机PWM及电池电压信息,当前无人船所行驶的轨迹。
3.如权利要求1或2所述的智能无人船平台,其特征在于,所述信息采集模块包括:
GPS/北斗定位模块,用于采集无人船的当前位置、当前航向、当前航速;
捷联式惯性导航模块,用于采集当前航向、当前航速、姿态信息;
激光雷达,用于采集周围环境中障碍物信息;
接收机,用于接收岸端控制***的遥控器的遥控指令。
4.如权利要求3所述的智能无人船平台,其特征在于,所述驱动模块包括电调、电机及舵机。
5.如权利要求3所述的智能无人船平台,其特征在于,动力***包括锂电池、稳压降压模块;电池电压检测***检测锂电池电量。
6.如权利要求4所述的智能无人船平台,其特征在于,所述通信***设有:两个无线数传电台,其中一个通过RS232转USB转接板与岸端上位机连接,另一个与ARMCortex-M7处理器连接,两个无线数传电台采用MAVLink协议实现数据传输,两个无线图传模块,其中一个与岸端上位机连接,另一个与视频传输模块连接,实现视频传输,以及配置在无线数传电台与无线图传模块上的若干增益天线。
7.一种如权利要求6所述智能无人船平台的控制方法,其特征在于:
岸端控制***选择无人船平台的控制模式,所述的控制模式包括手动遥控、自主导航及手动遥控和自主导航同时运行三种模式;其中手动遥控是指用遥控器发送指令给船载控制***的接收机的方式对无人船平台发送控制指令,并用上位机显示无人船状态信息,所述的自主导航是指岸端控制***通过无线数传电台的方式对无人船平台发送规划航线的位置信息,由主航行单元自主导航,并由自主避障单元进行避障;
岸端控制***以被选择的控制模式向船载控制***发送指令实时控制无人船平台,船载控制***通过无线数传电台和无线图传模块分别向岸端控制***实时发送无人船状态信息及周边环境信息,
信息采集模块的GPS/北斗定位模块采集当前位置、当前航向、当前航速,捷联式惯性导航模块分别同时采集当前航向、当前航速、姿态信息;激光雷达采集周围环境中障碍物信息;
在自主导航模式下,ARM Cortex-M7处理器读取信息采集模块采集的信息,一方面将所述信息通过无线数传电台发送给岸端上位机,一方面根据采集的信息和岸端上位机发送过来的规划航线的位置信息由自主航行单元、自主避障单元输出信号给方向及速度控制单元,方向及速度控制单元再输出控制信号给驱动模块;岸端上位机可向船载控制***直接发送目标航向、目标航速指令,在该情况下,方向及速度控制单元根据岸端上位机的指令输出控制信号给驱动模块;
其中,自主航行单元根据无人船的当前位置、当前航向与当前航速,与岸端上位机规划好的航线比较,通过航向控制方法及PID控制实时输出给定航向偏差、给定航速给方向及速度控制单元;
自主避障单元根据激光雷达检测到的障碍物信息以及无人船的当前位置、当前航向与当前航速,给定航向差、给定速度给方向及速度控制单元来实时躲避障碍物;
方向及速度控制单元根据岸端上位机的控制指令,或自主航行单元及自主避障单元输出的给定航向差、给定速度计算舵机PWM值、电机PWM值,并输出给驱动模块;
驱动模块通过电调、电机及舵机调整无人船的航向与航速;
视频传输模块包含摄像机,摄像机摄像获取无人船周边环境实时情况,通过无线图传模块、高增益天线将视频实时传输回岸端控制***。
8.根据权利要求7所述的控制方法,其特征在于:
岸端上位机的通信设置模块选择串口号、波特率,打开或关闭串口,模式选择模块选择手动遥控、自主导航及手动遥控和自主导航同时运行三种模式,***控制模块用于开启***、关闭***或重启***;PID控制模块用于航速PID控制、航向PID控制,船状态信息显示模块显示船状态信息,并可以加载地图显示当前无人船所行驶的轨迹,且可在此地图上规划航迹以及设置回航点;
船控制信息设置模块用于设置工作参数,其中:
经纬度控制单元输入目标点的经纬度信息,岸端上位机根据目标点与当前无人船平台位置规划航线,并将所规划好的航线的位置信息发送给船载控制***,
目标航速控制单元用于设置目标船速,方向及速度控制单元根据当前航速与目标航速在来调节电机PWM输出值,以控制无人船达到目标航速;
目标航向控制单元设置目标航向,方向及速度控制单元根据当前航向与目标航向来调节舵机PWM输出值,以控制无人船达到目标航向;
电机PWM控制单元输入有效电机PWM值,以控制电机达到相应的转速,所述有效电机PWM值为能使电机正常转动的电机PWM值;
舵机PWM控制单元输入有效舵机PWM值,以控制舵机转过相应的角度,所述有效舵机PWM值为能使舵机正常转过一定角度的舵机PWM值;
电机启动和停止控制单元分别启动电机和使电机停止转动。
9.根据权利要求7所述的控制方法,其特征在于:
所述电池电压检测***检测无人船的电池状态,并将电池信息通过无线数传电台传回单端控制***,在低电量状态时,发出警报。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710390327.8A CN107229276A (zh) | 2017-05-27 | 2017-05-27 | 基于ARM Cortex‑M7处理器的智能无人船平台及其控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710390327.8A CN107229276A (zh) | 2017-05-27 | 2017-05-27 | 基于ARM Cortex‑M7处理器的智能无人船平台及其控制方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN107229276A true CN107229276A (zh) | 2017-10-03 |
Family
ID=59934000
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710390327.8A Pending CN107229276A (zh) | 2017-05-27 | 2017-05-27 | 基于ARM Cortex‑M7处理器的智能无人船平台及其控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107229276A (zh) |
Cited By (22)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108181908A (zh) * | 2018-01-11 | 2018-06-19 | 福州大学 | 一种用于内河环境监测的无人船*** |
CN108287510A (zh) * | 2018-02-27 | 2018-07-17 | 上海瑞华(集团)有限公司 | 一种无人驾驶纯电动船的船舵***精度识辩***装置 |
CN108345246A (zh) * | 2018-02-27 | 2018-07-31 | 上海瑞华(集团)有限公司 | 一种无人驾驶纯电动船的自适应专用控制器装置 |
CN108469817A (zh) * | 2018-03-09 | 2018-08-31 | 武汉理工大学 | 基于fpga和信息融合的无人船避障控制*** |
CN108549396A (zh) * | 2018-04-17 | 2018-09-18 | 福州大学 | 一种基于stm32f429的双电机驱动无人船控制*** |
CN108762252A (zh) * | 2018-04-28 | 2018-11-06 | 中国科学院沈阳自动化研究所 | 智能浮标的控制*** |
CN108956914A (zh) * | 2018-05-03 | 2018-12-07 | 中山大学南方学院 | 一种水质智能监测*** |
CN109270233A (zh) * | 2018-08-27 | 2019-01-25 | 东南大学 | 一种用于搜寻水污染源的无人船*** |
CN109795629A (zh) * | 2019-01-22 | 2019-05-24 | 深兰科技(上海)有限公司 | 一种无人运输船 |
CN110108318A (zh) * | 2019-04-26 | 2019-08-09 | 宁波大学 | 一种水体环境的自动检测*** |
CN110320805A (zh) * | 2019-07-19 | 2019-10-11 | 山东交通学院 | 一种船舶自动靠泊非线性神经网络控制方法及*** |
CN110632920A (zh) * | 2019-08-29 | 2019-12-31 | 上海海事大学 | 一种无人船控制方法 |
CN110737271A (zh) * | 2019-10-23 | 2020-01-31 | 西南科技大学 | 一种水面机器人自主巡航***及方法 |
CN111538336A (zh) * | 2020-05-20 | 2020-08-14 | 西交利物浦大学 | 一种无人船控制*** |
CN112130575A (zh) * | 2020-10-13 | 2020-12-25 | 江苏科技大学 | 基于OneNET平台的无人船控制***及其自主避障方法 |
CN112947400A (zh) * | 2019-12-11 | 2021-06-11 | 中国科学院沈阳自动化研究所 | 一种海上无人***用水面遥控回航控制方法 |
CN113009915A (zh) * | 2021-05-08 | 2021-06-22 | 广州小鲇智能科技有限公司 | 一种无人船的控制方法和*** |
CN113313923A (zh) * | 2021-04-30 | 2021-08-27 | 苏州优世达智能科技有限公司 | 一种基于stm32f103的无人船智能遥控器控制*** |
CN113552892A (zh) * | 2021-09-18 | 2021-10-26 | 智船科技(北京)有限公司 | 基于船基服务器的无人船操控方式切换控制方法及*** |
CN114089761A (zh) * | 2021-11-22 | 2022-02-25 | 江苏科技大学 | 一种基于ros的领航跟随者多无人船编队控制***及其方法 |
WO2023221586A1 (zh) * | 2022-05-16 | 2023-11-23 | 江苏科技大学 | 一种无人船自主航行***及其方法 |
WO2023226485A1 (zh) * | 2022-05-26 | 2023-11-30 | 江苏科技大学 | 一种无人船自主航行控制*** |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104615134A (zh) * | 2014-12-02 | 2015-05-13 | 上海交通大学 | 基于pc104和arm的船舶自航控制*** |
CN104777833A (zh) * | 2014-08-14 | 2015-07-15 | 北京中科涌泉科技发展有限公司 | 基于arm和dsp处理器的无人船船载控制*** |
CN205375790U (zh) * | 2016-01-04 | 2016-07-06 | 武汉理工大学 | 一种无人船用自组织通信*** |
CN106444767A (zh) * | 2016-10-24 | 2017-02-22 | 天津城建大学 | 一种基于apm和i7智能芯片的联动组合自主导航无人船控制*** |
CN206178469U (zh) * | 2016-08-16 | 2017-05-17 | 北京中科涌泉科技发展有限公司 | 一种无人船控制*** |
CN106781371A (zh) * | 2016-12-06 | 2017-05-31 | 北京臻迪科技股份有限公司 | 一种水下无人船的通信*** |
-
2017
- 2017-05-27 CN CN201710390327.8A patent/CN107229276A/zh active Pending
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104777833A (zh) * | 2014-08-14 | 2015-07-15 | 北京中科涌泉科技发展有限公司 | 基于arm和dsp处理器的无人船船载控制*** |
CN104615134A (zh) * | 2014-12-02 | 2015-05-13 | 上海交通大学 | 基于pc104和arm的船舶自航控制*** |
CN205375790U (zh) * | 2016-01-04 | 2016-07-06 | 武汉理工大学 | 一种无人船用自组织通信*** |
CN206178469U (zh) * | 2016-08-16 | 2017-05-17 | 北京中科涌泉科技发展有限公司 | 一种无人船控制*** |
CN106444767A (zh) * | 2016-10-24 | 2017-02-22 | 天津城建大学 | 一种基于apm和i7智能芯片的联动组合自主导航无人船控制*** |
CN106781371A (zh) * | 2016-12-06 | 2017-05-31 | 北京臻迪科技股份有限公司 | 一种水下无人船的通信*** |
Cited By (25)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108181908A (zh) * | 2018-01-11 | 2018-06-19 | 福州大学 | 一种用于内河环境监测的无人船*** |
CN108287510A (zh) * | 2018-02-27 | 2018-07-17 | 上海瑞华(集团)有限公司 | 一种无人驾驶纯电动船的船舵***精度识辩***装置 |
CN108345246A (zh) * | 2018-02-27 | 2018-07-31 | 上海瑞华(集团)有限公司 | 一种无人驾驶纯电动船的自适应专用控制器装置 |
CN108469817A (zh) * | 2018-03-09 | 2018-08-31 | 武汉理工大学 | 基于fpga和信息融合的无人船避障控制*** |
CN108549396A (zh) * | 2018-04-17 | 2018-09-18 | 福州大学 | 一种基于stm32f429的双电机驱动无人船控制*** |
CN108762252A (zh) * | 2018-04-28 | 2018-11-06 | 中国科学院沈阳自动化研究所 | 智能浮标的控制*** |
CN108956914A (zh) * | 2018-05-03 | 2018-12-07 | 中山大学南方学院 | 一种水质智能监测*** |
CN109270233A (zh) * | 2018-08-27 | 2019-01-25 | 东南大学 | 一种用于搜寻水污染源的无人船*** |
CN109795629A (zh) * | 2019-01-22 | 2019-05-24 | 深兰科技(上海)有限公司 | 一种无人运输船 |
CN110108318A (zh) * | 2019-04-26 | 2019-08-09 | 宁波大学 | 一种水体环境的自动检测*** |
CN110108318B (zh) * | 2019-04-26 | 2021-06-15 | 宁波大学 | 一种水体环境的自动检测*** |
CN110320805A (zh) * | 2019-07-19 | 2019-10-11 | 山东交通学院 | 一种船舶自动靠泊非线性神经网络控制方法及*** |
CN110632920A (zh) * | 2019-08-29 | 2019-12-31 | 上海海事大学 | 一种无人船控制方法 |
CN110737271A (zh) * | 2019-10-23 | 2020-01-31 | 西南科技大学 | 一种水面机器人自主巡航***及方法 |
CN112947400A (zh) * | 2019-12-11 | 2021-06-11 | 中国科学院沈阳自动化研究所 | 一种海上无人***用水面遥控回航控制方法 |
CN111538336A (zh) * | 2020-05-20 | 2020-08-14 | 西交利物浦大学 | 一种无人船控制*** |
CN111538336B (zh) * | 2020-05-20 | 2023-11-21 | 西交利物浦大学 | 一种无人船控制*** |
CN112130575A (zh) * | 2020-10-13 | 2020-12-25 | 江苏科技大学 | 基于OneNET平台的无人船控制***及其自主避障方法 |
CN113313923A (zh) * | 2021-04-30 | 2021-08-27 | 苏州优世达智能科技有限公司 | 一种基于stm32f103的无人船智能遥控器控制*** |
CN113009915A (zh) * | 2021-05-08 | 2021-06-22 | 广州小鲇智能科技有限公司 | 一种无人船的控制方法和*** |
CN113552892A (zh) * | 2021-09-18 | 2021-10-26 | 智船科技(北京)有限公司 | 基于船基服务器的无人船操控方式切换控制方法及*** |
CN113552892B (zh) * | 2021-09-18 | 2021-12-17 | 智船科技(北京)有限公司 | 基于船基服务器的无人船操控方式切换控制方法及*** |
CN114089761A (zh) * | 2021-11-22 | 2022-02-25 | 江苏科技大学 | 一种基于ros的领航跟随者多无人船编队控制***及其方法 |
WO2023221586A1 (zh) * | 2022-05-16 | 2023-11-23 | 江苏科技大学 | 一种无人船自主航行***及其方法 |
WO2023226485A1 (zh) * | 2022-05-26 | 2023-11-30 | 江苏科技大学 | 一种无人船自主航行控制*** |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107229276A (zh) | 基于ARM Cortex‑M7处理器的智能无人船平台及其控制方法 | |
CN206848812U (zh) | 基于ARM Cortex‑M7处理器的无人船平台 | |
CN107168314B (zh) | 基于无人船***的浮标数据信息中转装置 | |
CN108181908B (zh) | 一种用于内河环境监测的无人船*** | |
CN102589531B (zh) | 水下地形测量***及制作方法和测量方法 | |
WO2019227306A1 (zh) | 一种以无人艇为载体的环境监测***及其应用 | |
CN104777833B (zh) | 基于arm和dsp处理器的无人船船载控制*** | |
CN205581642U (zh) | 一种基于stm32的无人艇自适应舵机控制*** | |
CN106444767B (zh) | 一种基于apm和i7智能芯片的联动组合自主导航无人船控制*** | |
CN108062108A (zh) | 一种基于机载计算机的智能多旋翼无人机及其实现方法 | |
CN107040583A (zh) | 一种无人艇信息交互*** | |
CN105302150A (zh) | 无人机无限续航*** | |
CN109582028A (zh) | 一种基于app终端监控的自主避障帆船机器人*** | |
CN104965502A (zh) | 基于物联网的无人水面艇航行监控*** | |
CN108062111A (zh) | 一种多旋翼无人机自主避障装置和避障方法 | |
CN109991386A (zh) | 无人船与无人机协同控制监控方法、装置及*** | |
CN106873608A (zh) | 一种半潜式小型无人艇集成控制*** | |
CN112130575A (zh) | 基于OneNET平台的无人船控制***及其自主避障方法 | |
CN106970624A (zh) | 一种自主无人船 | |
CN208569400U (zh) | 无人船用协同模式控制*** | |
CN104995575A (zh) | 一种数据处理方法、装置及飞行器 | |
CN205139126U (zh) | 北斗导航智能水质监测双体船 | |
CN207319073U (zh) | 无人机和无人飞行*** | |
Mendoza-Chok et al. | Hybrid control architecture of an unmanned surface vehicle used for water quality monitoring | |
WO2023226485A1 (zh) | 一种无人船自主航行控制*** |
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 |
Application publication date: 20171003 |