一种微型水下机器人控制器制造技术

本发明专利技术涉及一种微型水下机器人控制器，包括控制器主体，控制器主体内设有ARM嵌入式系统，水下机器人上设有传感器系统，ARM嵌入式系统上通过通信接口连接地面上的远程操作控制器，ARM嵌入式系统与水下机器人上的四个螺旋桨推进器连接；螺旋桨推进器包括安装在水下机器人上的多个直流电机，多个直流电机连接防水电机螺旋桨，多个直流电机分别为控制水下机器人前进移动的第一直流电机，控制水下机器人后退移动的第二直流电机，控制水下机器人上浮移动的第三直流电机，控制水下机器人下沉移动的第四直流电机；ARM嵌入式系统内设有STM32系列微控制器。精确解机器人在水下游走、位置检测、姿态控制，为水下探测、水底测量、水下物品打捞等工作提供方便。

【技术实现步骤摘要】
一种微型水下机器人控制器
本专利技术涉及信号检测处理与控制
，尤其是一种微型水下机器人控制器。
技术介绍
近年来国家在海底水下探测监控投入大量的经费，建设了许多海底人工渔礁和珊瑚虫生长保护区，以便每天能观察水下鱼群的活动频度和珊瑚虫的具体生长情况，进而分析海洋生态的恢复程度。然而，能用于这方面做监控的产品比较缺乏，有的下潜深度不够（小于50米），有的造价很高（50万以上），有的性能简单，只能给钓鱼爱好者做辅助用，而海洋水下探测工作又很需要能潜入深度100米以上、游走稳定可靠、视频传输清晰的水下机器人产品。因此，研究开发一种水下视频探测机器人的控制器有很好的现实需求和现实意义。
技术实现思路
本专利技术的目的是为了解决现有技术存在的缺陷，提供一种微型水下机器人控制器。为了实现上述目的，本专利技术采用的技术方案是：一种微型水下机器人控制器，包括控制器主体，控制器主体内设有ARM嵌入式系统，水下机器人上设有传感器系统，ARM嵌入式系统上通过通信接口连接地面上的远程操作控制器，ARM嵌入式系统与水下机器人上的四个螺旋桨推进器连接；所述螺旋桨推进器包括安装在水下机器人上的多个直流电机，多个直流电机连接防水电机螺旋桨，多个直流电机分别为控制水下机器人前进移动的第一直流电机，控制水下机器人后退移动的第二直流电机，控制水下机器人上浮移动的第三直流电机，控制水下机器人下沉移动的第四直流电机；所述ARM嵌入式系统内设有STM32系列微控制器，STM32系列微控制器处理所述传感器系统采集到的数据以及控制多个直流电机的运行状态、与上位机之间的通讯，STM32系列微控制器连接PWM高速定时器。上述的一种微型水下机器人控制器，所述STM32系列微控制器通过运动控制电路连接所述螺旋桨推进器，运动控制电路采用两块智能功率芯片BTN7971构成全桥驱动结构对一个螺旋桨推进器进行驱动，它带有一个P沟道的高边MOSFET、一个N沟道的低边MOSFET，智能功率芯片BTN7971集成逻辑电平输入、电流诊断、过温过压、欠压过流及短路保护的功能。上述的一种微型水下机器人控制器，智能功率芯片BTN7971的OUT1和OUT2接直流电机两端，IN1，IN2分别接控制器的I/O口，通过输出PWM实现正反转控制和PWM调速，PWM1控制OUT1的输出电压值U1，PWM2控制OUT2的输出值U2，U1、U2的大小由PWM1、PWM2的占空比乘以供电电压决定，故U1、U2的差值决定了电机的转速；BTN7971的芯片内部为一个半桥，INH为高电平，IN引脚用于确定哪个MOSFET导通，IN=1且INH=1时，高边MOSFET导通，OUT引脚输出高电平；IN=0且INH=1时，低边MOSFET导通，OUT引脚输出低电平，SR引脚外接电阻，电阻的大小可以调节MOS管导通和关断的时间，具有防电磁干扰的功能，IS引脚是电流检测输出引脚，正常模式下，从IS引脚流出的电流与经过高边MOS管的电流成正比，若Ris=1KΩ，则Vis=Iload/8.5；在故障条件下，从IS引脚流出的电流等于1IS（约4.5mA），最后的效果是IS为高电平。上述的一种微型水下机器人控制器，所述ARM嵌入式系统连接电池，电池为锂电池。上述的一种微型水下机器人控制器，智能功率芯片BTN7971和STM32系列微控制器通过隔离电路保护，隔离电路采用型号为ADUM1411的四通道数字隔离器，数字隔离器防止BTN7971损坏后将电池电压直接输入到控制器。上述的一种微型水下机器人控制器，所述通信接口为RS-485通信电路，RS-485通信电路采用ADM2483芯片设计通信接口，ADM2483芯片为带隔离的增强型RS-485收发器，RXD、EN、TXD分别是接收输出、收发使能端、发送输入，当EN为高电平时，都禁止接收和禁止发送，VDD1为逻辑端供电电源，PV为电源监控脚，当此引脚电平高于2.0V，ADM2483芯片工作，低于2.0V芯片不工作；GND1为逻辑端电源地，GND2为总线端电源地，A为输入/输出同相端，B为输入/输出反相端，VDD2为总线端供电电源，在A、B端分别接一个双向瞬态电压保护二极管，ADM2483具有热关断功能，可防止温度过高时芯片因电源的过度损耗而毁坏，当ADM2483芯片工作温度高于150℃时，ADM2483芯片独有的热关断电路会关断驱动器输出；而当温度回到140℃时，ADM2483芯片会自动使能驱动器输出。上述的一种微型水下机器人控制器，四个螺旋桨推进器分别安装在水下机器人的顶部，底部以及两侧。上述的一种微型水下机器人控制器，所述远程操作控制器包括设置在地面的控制箱和液晶显示屏，控制箱上设有按键。上述的一种微型水下机器人控制器，所述控制器主体上连接4芯电缆，2芯电缆作为水下机器人的外部高压备用供电，2芯电缆作为RS-485通信线。上述的一种微型水下机器人控制器，所述传感器系统包括设置在水下机器人上的陀螺仪传感器和水深压力传感器，水深压力传感器型号为NS-E3-150mH2O-10。本专利技术的有益效果为：该控制器主要精确解机器人在水下游走、位置检测、姿态控制，为水下探测、水底测量、水下物品打捞等工作提供方便。附图说明图1为本专利技术的系统示意图；图2为本专利技术STM32系列微控制器的基本电路图；图3为本专利技术的运动控制电路图；图4为本专利技术的隔离保护电路图；图5为本专利技术的RS-485通信电路图。具体实施方式如图1所示，一种微型水下机器人控制器，包括控制器主体1，控制器主体1内设有ARM嵌入式系统2，水下机器人上设有传感器系统，传感器系统包括设置在水下机器人上的陀螺仪传感器3和水深压力传感器4，水深压力传感器4型号为NS-E3-150mH2O-10，ARM嵌入式系统2上通过通信接口5连接地面上的远程操作控制器6，ARM嵌入式系统2连接电池11，电池11为锂电池，ARM嵌入式系统2与水下机器人上的四个螺旋桨推进器连接；四个螺旋桨推进器分别安装在水下机器人的顶部，底部以及两侧，螺旋桨推进器包括安装在水下机器人上的多个直流电机，多个直流电机连接防水电机螺旋桨，多个直流电机分别为控制水下机器人前进移动的第一直流电机7，控制水下机器人后退移动的第二直流电机8，控制水下机器人上浮移动的第三直流电机9，控制水下机器人下沉移动的第四直流电机10。水下机器人作为一个复杂的系统，其中包含着运动控制、传感器的数据采集和处理、人机交互界面和通信系统等复杂的信息处理，使得其在数据处理和控制算法上具有一定的要求，在本次设计中采用STM32系列微控制器作为水下机器人数据采集和处理的核心处理器。其主要处理陀螺仪传感器3和水深压力传感器4采集到的数据以及对数据的处理、控制电机的运行状态、与上位机之间的通讯；STM32系列微控制器的高速性能使得算法的执行速度和代码效率有了更高的水平，数据传输速率非常快。拥有PWM高速定时器，能够方便快速的对电机的进行控制。其低功耗的工作状态，待机情况下消耗2uA，能足够适用水下机器人低功耗的要求。STM32的基本电路如图2所示，25MHz晶振构成的时钟电路，拥有上电复位和手动按键复位两种形式。3.3V的供电电源，构成控制器的最小系统。水下机器人的执行层动力是由四个防水的直流电机进行提供的，为使本文档来自技高网...

【技术保护点】
1.一种微型水下机器人控制器，包括控制器主体，控制器主体位于水下机器人的壳体内，控制器主体内设有 ARM嵌入式系统，其特征在于，水下机器人上设有传感器系统，ARM嵌入式系统上通过通信接口连接地面上的远程操作控制器，ARM嵌入式系统与水下机器人上的四个螺旋桨推进器连接；所述螺旋桨推进器包括安装在水下机器人上的多个直流电机，多个直流电机连接防水电机螺旋桨，多个直流电机分别为控制水下机器人前进移动的第一直流电机，控制水下机器人后退移动的第二直流电机，控制水下机器人上浮移动的第三直流电机，控制水下机器人下沉移动的第四直流电机；所述ARM嵌入式系统内设有STM32系列微控制器，STM32系列微控制器处理所述传感器系统采集到的数据以及控制多个直流电机的运行状态、与上位机之间的通讯，STM32系列微控制器连接PWM高速定时器。

【技术特征摘要】
1.一种微型水下机器人控制器，包括控制器主体，控制器主体位于水下机器人的壳体内，控制器主体内设有ARM嵌入式系统，其特征在于，水下机器人上设有传感器系统，ARM嵌入式系统上通过通信接口连接地面上的远程操作控制器，ARM嵌入式系统与水下机器人上的四个螺旋桨推进器连接；所述螺旋桨推进器包括安装在水下机器人上的多个直流电机，多个直流电机连接防水电机螺旋桨，多个直流电机分别为控制水下机器人前进移动的第一直流电机，控制水下机器人后退移动的第二直流电机，控制水下机器人上浮移动的第三直流电机，控制水下机器人下沉移动的第四直流电机；所述ARM嵌入式系统内设有STM32系列微控制器，STM32系列微控制器处理所述传感器系统采集到的数据以及控制多个直流电机的运行状态、与上位机之间的通讯，STM32系列微控制器连接PWM高速定时器。2.根据权利要求1所述的一种微型水下机器人控制器，其特征在于，所述STM32系列微控制器通过运动控制电路连接所述螺旋桨推进器，运动控制电路采用两块智能功率芯片BTN7971构成全桥驱动结构对一个螺旋桨推进器进行驱动，它带有一个P沟道的高边MOSFET、一个N沟道的低边MOSFET，智能功率芯片BTN7971集成逻辑电平输入、电流诊断、过温过压、欠压过流及短路保护的功能。3.根据权利要求2所述的一种微型水下机器人控制器，其特征在于，智能功率芯片BTN7971的OUT1和OUT2接直流电机两端，IN1，IN2分别接控制器的I/O口，通过输出PWM实现正反转控制和PWM调速，PWM1控制OUT1的输出电压值U1，PWM2控制OUT2的输出值U2，U1、U2的大小由PWM1、PWM2的占空比乘以供电电压决定，故U1、U2的差值决定了电机的转速；BTN7971的芯片内部为一个半桥，INH为高电平，IN引脚用于确定哪个MOSFET导通，IN=1且INH=1时，高边MOSFET导通，OUT引脚输出高电平；IN=0且INH=1时，低边MOSFET导通，OUT引脚输出低电平，SR引脚外接电阻，电阻的大小可以调节MOS管导通和关断的时间，具有防电磁干扰的功能，IS引脚是电流检测输出引脚，正常模式下，从IS引脚流出的电流与经过高边MOS管的电流成正比，若Ris=1KΩ，则V...

【专利技术属性】
技术研发人员：陈泽堂，朱兆优，王孚贵，黄旭东，王细文，
申请(专利权)人：广州天地智能科技有限公司，广州海豹光电科技有限公司，
类型：发明
国别省市：广东,44