一种用于全海深自主遥控潜水器的推进控制系统技术方案

本实用新型专利技术涉及一种用于全海深自主遥控潜水器的推进控制系统，包括：单片机最小系统电路、CAN收发电路、串口收发电路、继电器控制电路。本实用新型专利技术所述的推进控制电路板浸泡在油中，能够承受120Mpa压力，其上所使用的电子元器件都经过压力测试筛选；本实用新型专利技术所使用的单片机采用基于Cortex‑M4内核的控制芯片，具有功能强大、低功耗、资源丰富可扩展能力强等优点，因此可以既使用一路CAN网络控制电机，又通过另一路CAN网络与航行控制计算机通信；本实用新型专利技术使用单片机的EEPROM实现在推进系统断电前完成对目前舵机角度的记录，再次上电后读取记录，具有电路简单、精度高的优点。

A Propulsion Control System for Deep Autonomous Remote Control Submarine

【技术实现步骤摘要】
一种用于全海深自主遥控潜水器的推进控制系统
本技术涉及水下机器人
，具体地说是一种用于全海深自主遥控潜水器的推进控制系统。
技术介绍
全海深自主遥控潜水器(ARV，Autonomous&RemotelyoperatedVehicle))是一种新型无人潜水器，它综合了遥控水下机器人(ROV)和自主水下机器人(AUV)的优点，它既可以象AUV一样具有大范围水下搜索和探测的能力，又可以像ROV一样通过光纤微缆进行实时遥控完成取样作业。工作模式的多样性与快速可切换功能使得ARV具有安全、高效、灵活、方便的综合优势。现有的水下机器人推进控制电路板无法应用于全海深自主遥控潜水器，主要原因有三个：一是无法承受120Mpa的油压；二是全海深自主遥控潜水器的推进控制系统需要同时控制6台推进电机、2台舵机以及2台开门电机，而现有的水下机器人推进控制电路板由于单片机资源有限，基本采用串口方式控制电机，因此现有方案无法满足要求；三是现有的推进控制电路板基本采用旋转电位计和A/D采样电路的方法来保存并读取舵机角度，此方法需增加附加电路，且精度受旋转电位计和A/D采样精度影响较大。
技术实现思路
针对现有技术的不足，本技术提供一种用于全海深自主遥控潜水器的推进控制系统，可承受120Mpa油压，同时单片机资源丰富，可满足全海深自主遥控潜水器的控制要求。本技术为实现上述目的所采用的技术方案是：一种用于全海深自主遥控潜水器的推进控制系统，包括：单片机最小系统电路，包括单片机及有源晶振电路、复位电路、单片机供电电路以及JTAG程序烧写电路；CAN收发电路，包括第一CAN收发电路和第二CAN收发电路，所述第一CAN收发电路一端连接航行控制计算机，接收航行控制计算机发送的CAN指令，另一端通过第一CAN端口连接单片机最小系统电路，将CAN指令发送给单片机最小系统电路；所述第二CAN收发电路一端与外部驱动器连接，接收外部驱动器反馈的状态信息；另一端通过第二CAN端口连接单片机最小系统电路，将状态信息发送给单片机最小系统电路；串口收发电路，通过调试串口连接单片机最小系统电路，作为备用程序烧写端口；继电器控制电路，一端通过继电器控制端口连接单片机最小系统电路，另一端连接外部驱动器，当与单片机相连继电器控制端输出低电平时，继电器处于导通状态，与外部电机驱动器相连继电器输出端输出+24VDC，从而控制电机驱动器上电。所述外部电机为推进电机，包括左侧主推电机、右侧主推电机、左侧垂推电机、右侧垂推电机、前侧电机和后侧电机。所述外部驱动器包括舵机驱动器和开门电机驱动器，所述舵机驱动器包括左侧舵机驱动器和右侧舵机驱动器，所述开门电机驱动器包括左侧开门电机驱动器和右侧开门电机驱动器。还包括漏水检测电路，通过漏水检测串口连接单片机最小系统电路，当检测到漏水时，漏水检测电路漏水端被拉低，与单片机相连的引脚被拉低，单片机检测到低电平后即发出漏水报警。所述状态信息包括实时角度、实时电流、实时电压以及电机实时故障信息。本技术具有以下有益效果及优点：1.本技术所述推进控制电路板采用基于Cortex-M4内核的控制芯片，该芯片具有丰富的资源，可以既通过一路CAN总线与航行控制计算机通信，又通过另一路CAN总线控制多台推进电机、舵机、开门电机，这样只需要六根连线(GANH、CANL、GANG)就可以实现对多台电机的控制，同时实现与航行控制计算机的通信，降低了推进控制系统的复杂度。2.本技术所述推进控制电路板使用单片机的EEPROM来保存舵机角度，并在单片机重新上电时读取该数值，用于对舵机的控制。此方法较广泛使用的旋转电位计加A/D采样电路的方法具有电路更简单、精度更高的优点。附图说明图1为推进控制系统结构图；图2(a)-2(e)为单片机结构图；图3为串口收发电路图；图4(a)-4(b)为CAN收发电路图；图5(a)-5(b)为继电器控制电路图；图6为漏水检测电路图；图7为工作流程图。具体实施方式下面结合附图及实施例对本技术做进一步的详细说明。为使本技术的上述目的、特征和有点能够更加明显易懂，下面结合附图对本技术的具体实施方式做详细的说明。在下面的描述中阐述了很多具体细节以便于充分理解本技术。但本技术能够以很多不同于在此描述的其他方式来实施，本领域技术人员可以在不违背技术内涵的情况下做类似改进，因此本技术不受下面公开的具体实施的限制。需要说明的是，当元件被称为“设置于”另一个元件，它可能直接在另一个元件上，或也可以存在居中的元件。当一个元件被称为是“连接”另一个元件，它可以直接连接到另一个元件或者可能同时存在居中元件。本文所使用的属于“前”、“后”、“左”、“右”以及类似的标书只是为了说明的目的，并不表示唯一的实施方式。除非另有定义，本文所使用的所有的技术和科学术语与属于本技术的
的技术人员通常理解的含义相同。本文中在技术的说明书中所使用的术语只是为了描述具体的实施例的目的，不是旨在于限制本技术。本技术中涉及到的处理器以及单片机等结构为常规选择，且本技术在软件以及编程上并无创新，仅仅保护硬件连接关系和位置关系等结构技术特征，本领域技术人员通过本技术记载的结构特征，结合常规编程逻辑即可实现本技术功能，解决本技术技术问题。如图1所示为推进控制系统结构图。本技术在推进控制系统外部分别与2台舵机驱动器、2台开门电机驱动器、6台推进电机、航行控制计算机相连。其中，推进控制系统与航行控制计算机之间通过CAN总线进行数据交互，航行控制计算机向推进控制系统发送控制指令，推进控制系统在接收指令后进行解析，变成对舵机、开门电机、推进电机等的控制量。同时推进控制系统将其所控制的舵机、开门电机、推进电机等的状态信息通过CAN总线反馈给航行控制计算机。推进控制系统与舵机、开门电机、推进电机之间的通讯通过另外一路CAN总线完成，一方面推进控制系统将控制量通过CAN总线发送给舵机、开门电机、推进电机，另一方面舵机、开门电机、推进电机将各自状态信息通过CAN总线上报给推进控制系统。在系统断电前，推进控制系统将舵机角度记录在EEPROM内，并在下次上电时读取该角度。推进控制系统通过继电器电路控制舵机、开门电机的电源。推进控制系统通过漏水检测电路检测推进舱内的漏水情况，并上报航行控制计算机。为实现上述功能，本技术推进控制系统包括单片机最小系统电路、串口收发电路、两路CAN收发电路、继电器控制电路以及漏水检测电路。推进控制电路板包括单片机最小系统电路以及与其相连接的串口收发电路、两路CAN收发电路、继电器控制电路以及漏水检测电路。串口收发电路主要用于对推进控制电路板进行调试。两路CAN收发电路其中一路与航行控制计算机相连，另一路与2台舵机驱动器、2台开门电机驱动器、6台推进电机相连。继电器电路与2台舵机驱动器、2台开门电机驱动器相连。漏水检测电路与漏水传感器相连。所述推进控制电路板浸泡在油中，能够承受120Mpa压力，其上所使用的电子元器件都经过压力测试筛选。本技术所述的推进控制电路板浸泡在油中，能够承受120Mpa压力，其上所使用的电子元器件都经过压力测试筛选；本技术所使用的单片机本文档来自技高网...

【技术保护点】
1.一种用于全海深自主遥控潜水器的推进控制系统，其特征在于，包括：单片机最小系统电路；CAN收发电路，包括第一CAN收发电路和第二CAN收发电路，所述第一CAN收发电路一端连接航行控制计算机，接收航行控制计算机发送的CAN指令，另一端通过第一CAN端口连接单片机最小系统电路，将CAN指令发送给单片机最小系统电路；所述第二CAN收发电路一端与外部驱动器连接，接收外部驱动器反馈的状态信息；另一端通过第二CAN端口连接单片机最小系统电路，将状态信息发送给单片机最小系统电路；串口收发电路，通过调试串口连接单片机最小系统电路，作为备用程序烧写端口；继电器控制电路，一端通过继电器控制端口连接单片机最小系统电路，另一端连接外部驱动器，控制外部驱动器上电。

【技术特征摘要】
1.一种用于全海深自主遥控潜水器的推进控制系统，其特征在于，包括：单片机最小系统电路；CAN收发电路，包括第一CAN收发电路和第二CAN收发电路，所述第一CAN收发电路一端连接航行控制计算机，接收航行控制计算机发送的CAN指令，另一端通过第一CAN端口连接单片机最小系统电路，将CAN指令发送给单片机最小系统电路；所述第二CAN收发电路一端与外部驱动器连接，接收外部驱动器反馈的状态信息；另一端通过第二CAN端口连接单片机最小系统电路，将状态信息发送给单片机最小系统电路；串口收发电路，通过调试串口连接单片机最小系统电路，作为备用程序烧写端口；继电器控制电路，一端通过继电器控制端口连接单片机最小系统电路，另一端连接外部驱动器，控制外部驱动器上电。2.根据权利要求1所述的用于全海深自主遥控潜水器的推进控制系统，其特征在于...

【专利技术属性】
技术研发人员：李吉旭，阎述学，刘铁军，唐元贵，
申请(专利权)人：中国科学院沈阳自动化研究所，
类型：新型
国别省市：辽宁,21