军事侦察机器人——仿生蛇_徐海洲.pdf

2023.7电子产品世界设计应用机器人Design&Application军事侦察机器人仿生蛇*Military reconnaissance robot-bionic snake徐海洲，亚 迪，李子轩，杨金全，杨建海，李志刚（辽宁科技大学电子与信息工程学院，辽宁鞍山114051）摘 要：为了在未来战争中占据信息优势，能够在隐蔽的环境下进行军事侦查，为此设计了一种军事侦察机器人仿生蛇。该仿生蛇以STM32微控制器为主控核心，以蛇体搭载各种传感器，使用舵机旋转带动身躯移动作为主要推进机构，在各种复杂的战场环境中具备隐匿前行、实时侦查及时发现目标并将通过WIFI图传模块将侦察信息迅速传回的功能。蛇形机器人体型小，重心位置很低，运动方式灵活多变，复杂环境适应能力很好，具有良好的稳定性等优点，非常适于1隐蔽侦察。关键词：实时侦察；蛇形机器人；隐匿侦察；基金项目：本项目由大学生创新创业训练计划项目基金资助 传统的侦察机器人依靠履带或滚轮等方式进行运动,采用这种方式运动的机器人体型较大,在军事活动中容易被敌人发现,在复杂地形中通过性较差,侦查具有局限性,而仿生蛇军事侦察机器人具有更小巧灵活的特点,能利用复杂的地形隐藏行动路线,能够在复杂的地形下快速机动,可在松软土地以及空间狭小人类无法进入或者其他需要进行侦察而又危险的情况进行侦察。仿生蛇军事侦察机器人能够提高人们的侦察效率,减少危险,具有很高的研究价值。1 机械结构设计该机器主要由主控装置、舵机、发送装置、摄像装置和红外装置来组成。图1 仿生蛇结构图1.1 材料的选择与加工其的工作环境等因素考虑选用树脂作为仿生蛇侦察机器人外型结构材料,能抗老化且能在高温、低温、腐蚀的环境中正常进行工作,并且其成本较低能使用时间长性价比高。根据结构大小进行外形设计,并运用 3D打印技术进行打印,使得外型结构精准,成本较低,结构稳定且质量良好。1.2 外型结构设计仿生机器人的外型结构。仿生蛇的整体结构由多个元件组成,主要分为头部、颈部、躯干和尾部四个部分。整体结构采用仿生结构,模仿蛇的身体结构。头部由小型的机械臂仿照蛇的嘴巴,机械臂内部有一定的空腔,在执行侦察任务时发现一些小型有用的物品可直接由机械臂抓取带回,机械臂上面有两只“眼睛”,一个是 MLX90640 红外热成像仪器,可辅助进行追踪探查任务,另一个为 OpenMv 摄像头模块收取实时图像并通过 WIFI 模块传回实时图像。颈部由主控模块STM32F103C8T6、电源以及 WiFi 模块构成。躯干主要由舵机组成,关节部分前后使用强磁模块连接,通过主控芯片 STM32F103C8T6 驱动相应的舵机运动由此实现50ELECTRONIC ENGINEERING&PRODUCT WORLD 2023.7$机器人电子产品世界Design设计应用&Application仿生蛇的仿生运动。尾部带有起爆电路装有烈性炸药表面做隔热防水处理,尾部与躯干关节连接处采用电磁铁连接,可实现断节功能随时脱离躯干实现定向爆破。该仿生蛇的结构实现了仿生运动,并可以在各种复杂环境下完成相应的指令。1.3 仿生蛇机器人尺寸参数仿生蛇机器人长 60 cm,宽 6 cm,高 8 cm,整个机器人质量8 kg,电池电压由1 500 mAH 12 V锂电池供电。1.4 运动数学建模转弯运动基础,对仿生蛇机器人运动曲线进行分析,蛇形曲线运动方程为 Pbsin bs=(),为幅值角,b 为比例常数,s 为蛇形曲线长度2。由蛇形曲线公式得出关节角关于时间的函数。i()sin(1)tAti=+(1)设第 1 个舵机需要调整的角度是1 nn=.211=Ab sssscos()()|zz2因为在关节处运动是连续的,有(s)=|nfz1coscos 0(bs sssbsss)f(4)设计的运动过程在提高了转弯效率的同时可以减轻系统负担,提高执行效率。1.5 仿生原理本设计模仿蛇类运动设计了四种运动模式,适用于各种复杂环境下进行侦察活动。2 系统硬件设计2.1 仿生蛇机器人总体结构仿生蛇机器人系统的组成部分中,根据仿生蛇机器人的功能要求,选用 MDK5 作为开发平台5,主控芯片采用的是 STM32 单片机,它控制功能强大,可以外接各种控制各种传感器,接收和处理传感器的反馈信号从而检测出其所处的环境,运用 PID 算法对蛇形仿生机器人的运动情况进行实时反馈控制,并且能调节舵机的角度使得仿生蛇机器人运动更加的平滑,运动控制基于STM32 串口功能强大,能够输出多路 PWM 信号,可以灵活调整舵机的旋转角度,获得更稳定的动力。电磁铁模块的使用能够使蛇形机器人的运动更加灵活,摄像头模块可以反馈检测到的图像和一些数据和对环境的简单判断,使得仿生蛇机器人更加的智能。激光雷达模块可以检测周围环境,使得仿生蛇的在一个安全的环境下工作。在蛇形机器人数据传输方面,采用 WIFI图传模块,可以稳定远距离传输图像,以便更精确的控制蛇的运动。系统的总体结构如图 2 所示。图2 系统总体结构图2.2 STM32控制板本设计采用 STM32 控制板,如图 3 所示,是基于表1 仿生蛇机器人运动模式表蜿蜒运动侧向运动螺旋运动行波运动运动机理通过身体的摆动摩擦地面获得前进的力量抬起部分身体向身体侧向运动通过蛇身呈螺旋状抱住管状物体外表滚动或蠕动实现通过伸缩运动前行运动范围水平范围水平和竖直范围竖直范围水平范围适用范围平坦坚硬的地面沙地或软地柱状物体攀爬平坦的地面 2023.7电子产品世界设计应用机器人Design&ApplicationSTM32F103C8T6 主控芯片的微控制板,程序存储器容量是 64KB,工作电压为 2 V3.6 V,能在零下 40 到零上 80 的工作环境下正常工作。相较于其他此控制板具有更小的体积和更强大的功能,能够满足仿生蛇系统的控制要求。主控芯片原理图如图 4 所示。图3 STM32主控板实物图图4 主控芯片原理图2.3 驱动元件为满足仿生蛇机器人能够灵活运动的要求,考虑到整个系统的稳定性,易操作性及耐用性等,本设计的控制方案采用舵机驱动。舵机由减速齿轮组、反馈电路和电机组成的驱动系统。STM32 芯片通过信号线与舵机控制线相连,通过内部定时器产生的 PWM 信号控制舵机的旋转角度,并通过串口接收舵机的反馈角度,作为整个系统的反馈角。经过多方面的测试舵机型号选用RDS3115,该舵机扭力大,精度高,可以有效的驱动蛇身运动。并且此舵机内部带有编码器能够准确的测出旋转角度,并通过自带的串口反馈角度,更加的适合闭环控制,更好的满足多种方式运动需求。舵机旋转角度由脉冲信号控制,舵机可调范围是0180,占空比的大小来控制舵机旋转角的大小,旋转角度和脉冲信号转换公式：脉宽=转动角（90+0.5）,下面是常用角度与脉宽的对应表。表2 常用角度与脉宽对应表舵机转动角度脉宽/ms00.5451901.513521802.52.4 WIFI模块为满足图像传输和远程控制功能本设计采用 ESP32模块,其拥有 32 位双核处理器,CPU 正常工作速度为 80 MHz 最 高 可 达 240 MHz。工 作 温 度 为-2070,工作电压为 4.75 V5.35 V。在接收到摄像头传入的图像后通过无线网络传回图像,可以做到低延迟、高帧率的有效传回,在远程遥控上也是通过无线网络传输给 ESP32,然后通过 ESP32 的串口把控制信号传输给单片机,最终达到控制整个蛇在超远距离移动的目的。2.5 红外热成像模块采用 MLX90640 红外热成像模块,采用远红外热传感器阵列,110 视角,320240 像素,该传感器可以准确测量温度范围为-40 300,可更大范围可精度检测特定区域和温度范围内目标物体。2.6 摄像头模块摄像头采用的方案是通过 OpenMv 采集数据,通过 SPI 传输。OpenMv 摄像头捕捉到图像后,经过图像处理算法进行处理,将处理好后的视频帧转换为 SPI传输格式,再配置好 ESP32 的 SPI 接口,通过串口将OpenMv 采集的数据传输给 ESP32 并通过配置好的 SPI传输到接收端,接收端进行解码配置,就可以转化为可视化图像。如图 5 图像的显示。52ELECTRONIC ENGINEERING&PRODUCT WORLD 2023.7$机器人电子产品世界Design设计应用&Application图5 电脑接收到ESP32传输回来的图像3 系统软件设计3.1 程序流程本次项目所制作的仿生蛇侦察机器人主控芯片是STM32F103C8T6,通过内部时钟产生 6 路 PWM 信号对 6 个舵机进行旋转控制,在通过舵机内部串口返回的角度给主控芯片,最后通过算法实现对舵机角度的自动调节,从而实现对整个仿生蛇侦察机器人的运动进行控制。针对不同的使用场景,仿生蛇侦察机器人在运行的过程中需要具有,前进、左右转弯、克服障碍物等功能。在面对不同的地形设计有 4 种运动方式：蜿蜒运动、侧向运动、螺旋运动和行波运动3。通过 ESP32 和STM32 相连进行运动模式的选择,可以实现远程无线遥控仿生蛇侦察机器人。为了方便数据的实时传输,采用了 OpenMv 摄像头和 ESP32 对图像的传输,为了在夜间行进采用 MLX90640 红外热成像模块进行红外识别,采集到地面信息后传输给 ESP32,减少黑暗对仿生蛇侦察机器人的影响。通过 GPS 定位能够准确的知道仿生蛇军事侦察机器人的准确位置,能够更加完美的实现侦察任务。为了保证仿生蛇侦察机器人运动流畅,在舵机与舵机之间加入了PID算法调节,在第1个关节处是预期量,输出量给第 2 个关节输入,和给第 1 个关节反馈,这样第 1 个关节形成了 1 个闭环控制,通过舵机与舵机之间的串级 PID 调节,会使得整个仿生蛇侦察机器人的控制更加方便,PID 流程图如图 7。图6 程序流程图图7 PID流程4 结束语基于 STM32 最小系统板,与 6 个 RDS3115 舵机,配合 OpenMv 摄像头、MLX90640 红外摄像头和 ESP32等模块设计的仿生蛇军事侦察机器人,能够实现远程遥控,外观具有极高的隐蔽性,并能够高效的传输图像,可根据不同地形选择不同的运动模式,可以高效率的前进,在抗震救灾、城市排爆也有着极高的应用价值。参考文献：1 李秀丽.基于模块GZ-I的蛇形机器人运动性能研究D.杭州:浙江工业大学,2011.2 王超,邓宏彬,彭演宾,等.蛇形仿生机器人的转弯运动控制方法J.指挥与控制学报,2015,1(4):485-492.3 朱红山.基于OMAP平台蛇形机器人控制系统设计及复杂环境下视觉导航的研究D.广州:华南理工大学,2011.4 陈力雄,郭宛霖,张世龙,等.基于Arduino的仿生六足侦察机器人设计J.电子制作,2022,30(21):3-7.5 史志阳.手指关节康复训练器的设计与分析D.徐州:中国矿业大学,2019.