摆线推进器的监测控制系统以及包括该系统的无人船的制作方法
【技术领域】
[0001] 本实用新型属于船舶特种推进器监测与控制领域，具体设及一种摆线推进器的监 测控制系统W及包括该系统的无人船。
【背景技术】
[0002] 当今世界各国越来越重视海洋发展战略。推进器是推动船舶运动的装置，长期W 来人们为探索新型高效的推进器而不屑地努力。船用螺旋奖推进器是海洋工程装备中最常 见的船舶推进器，其结构简单、造价低廉、市场宽广，但是其操纵和控制性能不足，难于适应 船舶侧移、后退、停止、变速、W及原地打转等要求。摆线推进器在机动性方面优越于普通的 螺旋奖推进器。 【实用新型内容】
[0003] 本实用新型提供一种摆线推进器的监测控制系统W及包括该系统的无人船，摆线 推进器的监测控制系统实现了对整个无人船的监控，包括该监测控制系统的无人船具有可 控性高、机动性强、操纵简单的优点。
[0004] 为了解决上述技术问题，本实用新型采用W下的技术方案：
[0005] 摆线推进器的监测控制系统，一艘无人船包括两个摆线推进器，每个摆线推进器 由两个舱机控制其偏屯、点，各个摆线推进器的转盘在偏屯、点处的速度方向为该摆线推进器 的推力方向，所述两个摆线推进器由一个监测控制系统监控，两个摆线推进器的监测控制 系统包括ARM主控制板、分别驱动各个所述转盘转动的主驱动电机、通过无线通信模块和所 述ARM主控制板通信的上位机、安装于无人船上的GPS和电子罗盘，所述ARM主控制板通过电 机驱动器控制所述主驱动电机转动，所述主驱动电机的输出轴上装有用于测量主驱动电机 的转速和加速度的编码器、用于测量主驱动电机输出扭矩的扭矩传感器，所述主驱动电机 的内部装有用于测量主驱动电机内部溫度的电机溫度传感器，所述摆线推进器的主传动箱 内装有用于测量摆线推进器的叶片摆动机构的油溫的油液溫度传感器，所述ARM主控制板 和电机驱动器通过电池供电；
[0006] 所述ARM主控制板根据编码器、扭矩传感器、电机溫度传感器、油液溫度传感器的 数据输出四个PWM信号至四个舱机，通过四个PWM信号的占空比的不同控制四个舱机转动相 应的角度，其中两个舱机通过主动杆、从动杆连接一摆线推进器的偏屯、杠杆的上端，从而可 W确定与该两个舱机对应的摆线推进器的偏屯、点位置，另两个舱机通过主动杆、从动杆连 接另一摆线推进器的偏屯、杠杆的上端，从而可W确定与该另两个舱机对应的另一摆线推进 器的偏屯、点位置，通过各个摆线推进器的偏屯、点位置W及对应转盘的转动方向可W得到两 个摆线推进器各自的推力方向，各个摆线推进器的推力方向为与其对应的转盘在偏屯、点处 的速度矢量方向，在两个摆线推进器的推力合力作用下，船舶的运动可W是前进、后退、侧 移、停止、变速、W及原地打转；
[0007] 所述无线通信模块包括设在上位机内的第一无线通信模块W及设在ARM主控制板 内的第二无线通信模块，第一无线通信模块通过USB接口和上位机连接，第二无线通信模块 通过UART串行口和ARM主控制板连接，第一无线通信模块和第二无线通信模块之间无线通 信连接;第一无线通信模块和第二无线通信模块之间的传输协议自定义，传输的数据包括 舱机的转动角度、主驱动电机的转速和加速度、W及电机溫度传感器、油液溫度传感器和扭 矩传感器的测量数据、W及GI^和电子罗盘的位置和航向数据；
[000引所述ARM主控制板通过UART串行口将TTL电平经转换器转换成485电平控制对应两 个摆线推进器的两个电机驱动器，二者之间的传输协议为Mcxlbus协议，通过Mcxlbus协议，在 ARM主控制板内写入需要主驱动电机实现的转速值、加速度值，并从电机驱动器中读取所述 编码器传来的主驱动电机的转速值、加速度值、W及电机溫度传感器传来的电机内部溫度 值，从而完成对两个主驱动电机的控制;所述扭矩传感器和油液溫度传感器则通过A/D转换 接口和ARM主控制板连接；
[0009] 所述GI^采用UART串行口和ARM主控制板连接，GPS会实时发送地理位置数据给ARM 主控制板，6?5数据格式为：$信息类型，^，^，^，^，^，^，^，^，^，^，^，^，^，信息类型可^为， GPGSV:可见卫星信息，地理定位信息，GPRMC:推荐最小定位信息，GPVTG:地面速度信 息，GPGGA: GPS定位信息，GPGSA:当前卫星信息，ARM主控制板解析GPS发送来的地理位置数 据，提取有用的信息，包括船体航向、速度W及具体方位信息，传回上位机；
[0010] 所述电子罗盘采用IIC接口和ARM主控制板连接，电子罗盘会发送无人船的航行角 度数据给ARM主控制板，ARM主控制板解析电子罗盘的航行角度数据，结合GI^的地理位置数 据，可W得到船体航向、速度W及具体方位信息，并传回上位机；
[0011] 所述摆线推进器的监测控制系统还包括设在上位机内的上位机控制软件，所述上 位机控制软件包括收发数据解析程序、基于推进器数学模型程序、路径规划程序、实时监控 程序、W及预警程序，所述ARM主控制板内设有与上位机控制软件对应的ARM主控制板转换 程序；
[0012] 收发数据解析程序，接收ARM主控制板通过无线通信模块发过来的数据包，并解析 数据包，然后把相应的不同参数赋给不同的变量，收发数据解析程序也可W发送上位机对 摆线推进器控制的相关参数，并将运些参数打包，通过无线通信模块发送给ARM主控制板；
[0013] 基于推进器数学模型程序，根据摆线推进器中舱机的转动角度W及主驱动电机的 转速和转动方向对于无人船的航向和航速的数学模型编写而成，用户在其中输入无人船的 航向和航速，基于推进器数学模型程序就能自动计算出最优的两个舱机的转动角度和两个 主驱动电机的转速；
[0014] 两个摆线推进器的数学模型如下：
[0015] -舱机的转动角度：
[0016]
[0017]另一舱机的转动角度：
[001 引
[0019]其中XO，yo表示偏屯、点坐标，r为舱机转动半径，L为偏屯、点和舱机圆周切点连线的 距离，θ?，02为对应两个舱机的转动角度；
[0020] 路径规划程序，路径规划采用蚁群算法，在用户确定目的地后，路径规划程序能够 对水域上的障碍进行识别，避开水域的障碍物，根据地理信息自动规划并计算出合适的路 径，经基于蚁群算法的数学模型换算后，得到无人船合适的航向和航速，从而让船舶自动到 达目的地;所述上位机通过对接收到的GPS和电子罗盘的位置和航向数据进行解析，实时监 控无人船的位置和航向，并与路径规划程序规划好的路径的位置和航向相比较，将比较结 果转化为舱机和主驱动电机的控制代码，通过无线通信模块发送给无人船的ARM主控制板， ARM主控制板通过发送不同占空比的PWM信号给舱机W控制舱机的转动角度，并通过和电机 驱动器之间的Mo化US协议控制主驱动电机的转速和加速度，从而实时修正船舶运行路线， 让船舶按照路径规划程序规划好的路径行走；
[0021] 实时监控程序，接收ARM主控制板传递来的相关参数，实时在上位机中显示运些相 关参数，并根据要求对无人船的航向和航速进行相关控制；
[0022] 预警程序，当上位机监测到所接收的电机溫度传感器或者油液溫度传感器的值超 过设定的临界值时，上位机控制软件会发出预警通知用户，并自动降低主驱动电机的转速， W及，当上位机监测到所接收的扭矩传感器的值超过设定的临界值时，上位机控制软件会 发出预警通知用户，并自动降低主驱动电机的转速或者使主驱动电机停转；
[0023] ARM主控制板转换程序，作为上位机W及与ARM主控制板连接的各个部件(如各个 传感器、电机驱动器等）的桥梁，转换上位机发送过来的信号成各个部件能够识别的信号， 让上位机间接控制各个部件；
[0024] 除通过上位机实时监控无人船的运行之外，所述ARM主控制板带有触摸屏，不通过 上位机，用户可W直接通过触摸屏在船上实时地监控无人船的运行；
[0025] 监测控制系统的流程为，系统上电W后，ARM主控制板先初始化各种环境变量，然 后ARM主控制板控制等待用户选择模式，模式有远程控制模式和本地控制模式两种，当触摸 屏有信号输入时，代表用户在无人船上实时控制无人船，此时为本地控制模式，当无线通信 模块端有信号输入时，代表用户通过上位机远程控制无人船，此时为远程控制模式；当用户 远程控制无人船时，ARM主控制板等待接收到完整的控制数据后，ARM主控制板执行该控制 数据，控制舱机的转动角度和主驱动电机的转速，然后开始循环读取GPS和电子罗盘的位置 和航向数据、油液溫度传感器数据、电机溫度传感器数据、力矩传感器数据并发送到上位 机;当上位机发送数据给ARM主控制板时，ARM主控制板立即触发中断，来执行上位机发送的 数据，完毕后继续执行循环段，当用户在无人船上实时监控无人船时，ARM主控制板监测到 触摸屏输入的数据后，会立即触发中断，执行触摸屏上传来的数据。
[0026] 包括上述监测控制系统的无人船，包括船舶本体，船舶本体由两个摆线推进器推 动运动，所述船舶本体上装有用于实时监控无人船的位置和航向的GI^和电子罗盘，所述两 个摆线推进器由上述的监测控制系统监控，所述GPS采用UART串行口和ARM主控制板连接， 电子罗盘采用lie接口和ARM主控制板连接。
[0027] 进一步地，