[发明专利]一种微型水下机器人控制器在审
申请号: | 201811181557.4 | 申请日: | 2018-10-11 |
公开(公告)号: | CN109283939A | 公开(公告)日: | 2019-01-29 |
发明(设计)人: | 陈泽堂;朱兆优;王孚贵;黄旭东;王细文 | 申请(专利权)人: | 广州天地智能科技有限公司;广州海豹光电科技有限公司 |
主分类号: | G05D1/10 | 分类号: | G05D1/10;G05D1/08;B63C11/52 |
代理公司: | 南昌新天下专利商标代理有限公司 36115 | 代理人: | 李炳生 |
地址: | 510000 广东省广州市高*** | 国省代码: | 广东;44 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 水下机器人 直流电机 控制器 微型水下机器人 螺旋桨推进器 控制器主体 传感器系统 电机螺旋桨 后退移动 连接防水 前进移动 水底测量 水下探测 通信接口 微控制器 位置检测 物品打捞 远程操作 姿态控制 上浮 移动 下沉 机器人 | ||
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Ω,则Vis=Iload/8.5;在故障条件下,从IS引脚流出的电流等于1IS(约4.5mA),最后的效果是IS为高电平。
4.根据权利要求2所述的一种微型水下机器人控制器,其特征在于,所述ARM嵌入式系统连接电池,电池为锂电池。
5.根据权利要求4所述的一种微型水下机器人控制器,其特征在于,智能功率芯片BTN7971和STM32系列微控制器通过隔离电路保护,隔离电路采用型号为ADUM1411的四通道数字隔离器,数字隔离器防止BTN7971损坏后将电池电压直接输入到控制器。
6.根据权利要求1所述的一种微型水下机器人控制器,其特征在于,所述通信接口为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芯片会自动使能驱动器输出。
7.根据权利要求1所述的一种微型水下机器人控制器,其特征在于,四个螺旋桨推进器分别安装在水下机器人的顶部,底部以及两侧。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于广州天地智能科技有限公司;广州海豹光电科技有限公司,未经广州天地智能科技有限公司;广州海豹光电科技有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/201811181557.4/1.html,转载请声明来源钻瓜专利网。
- 上一篇:一种无人机系统和无人机系统控制方法
- 下一篇:一种输电线路无人机夜间巡检系统