军事侦察机器人——仿生蛇

  ：为了在未来战争中占据信息优势，能够在隐蔽的环境下进行军事侦查，为此设计了一种军事侦察机器人仿生蛇。该仿生蛇以STM32微控制器为主控核心，以蛇体搭载各种传感器，使用舵机旋转带动身躯移动作为主要推进机构，在各种复杂的战场环境中具备隐匿前行、实时侦查及时有效地发现目标并将通过WIFI图传模块将侦察信息迅速传回的功能。蛇形机器人体型小，重心位置很低，运动方式灵活多变，复杂环境适应能力很好，拥有非常良好的稳定性等优点，非常适于[1]隐蔽侦察。

  传统的侦察机器人依靠履带或滚轮等方式来进行运动，采用这样的形式运动的机器人体型较大，在军事活动中容易被敌人发现，在复杂地形中通过性较差，侦查具有局限性，而仿生蛇军事侦察机器人具有更小巧灵活的特点，能利用复杂的地形隐藏行动路线，能够在复杂的地形下快速机动，可在松软土地以及空间狭小人类没办法进入或者别的需要进行侦察而又危险的情况做侦察。仿生蛇军事侦察机器人可提升人们的侦察效率，减少危险，具备极高的研究价值。

  其的工作环境等因素考虑选用树脂作为仿生蛇侦察机器人外型结构材料，能抗老化且能在高温、低温、腐蚀的环境中正常进行工作，并且其成本较低能使用时间长性能好价格低。依照结构大小进行外形设计，并运用3D打印技术进行打印，使得外型结构精准，成本较低，结构稳定且质量良好。

  仿生机器人的外型结构。仿生蛇的整体结构由多个元件组成，大致上可以分为头部、颈部、躯干和尾部四个部分。整体结构采用仿生结构，模仿蛇的身体结构。头部由小型的机械臂仿照蛇的嘴巴，机械臂内部有一定的空腔，在执行侦察任务时发现一些小型有用的物品可直接由机械臂抓取带回，机械臂上面有两只“眼睛”，一个是MLX90640 红外热成像仪器，可辅助进行追踪探查任务，另一个为OpenMv 摄像头模块收取实时图像并通过WIFI 模块传回实时图像。颈部由主控模块STM32F103C8T6、电源以及WiFi 模块构成。躯干主要由舵机组成，关节部分前后使用强磁模块连接，通过主控芯片STM32F103C8T6 驱动相应的舵机运动由此实现仿生蛇的仿生运动。尾部带有起爆电路装有烈性炸药表面做隔热防水处理，尾部与躯干关节连接处采用电磁铁连接，可实现断节功能随时脱离躯干实现定向爆破。该仿生蛇的结构实现了仿生运动，并可以在各种复杂环境下完成相应的指令。

  转弯运动基础，对仿生蛇机器人运动曲线做多元化的分析，蛇形曲线运动方程为P=αbsin(bs), α 为幅值角，b 为比例常数，s 为蛇形曲线]。

  [5]，主控芯片采用的是STM32 单片机，它控制功能强大，可以外接各种控制各种传感器，接收和处理传感器的反馈信号从而检测出其所处的环境，运用 PID 算法对蛇形仿生机器人的运动情况做实时反馈控制，并且能调节舵机的角度使得仿生蛇机器人运动更加的平滑，运动控制基于STM32串口功能强大，能够输出多路PWM 信号，可以灵活调整舵机的旋转角度，获得更稳定的动力。电磁铁模块的使用能够使蛇形机器人的运动灵活性更好，摄像头模块可以反馈检测到的图像和一些数据和对环境的简单判断，使得仿生蛇机器人更的智能。激光雷达模块可以检测周围环境，使得仿生蛇的在一个安全的环境下工作。在蛇形机器人数据传输方面，采用WIFI 图传模块，可以稳定远距离传输图像，以便更精确的控制蛇的运动。

  本设计采用STM32 控制板，如图3 所示，是基于STM32F103C8T6 主控芯片的微控制板，程序存储器容量是64KB，工作电压为2 V~3.6 V，能在零下40℃ 到零上80℃ 的工作环境下正常工作。相较于其他此控制板具有更小的体积和更强大的功能，能够很好的满足仿生蛇系统的控制要求。主控芯片原理图如图4 所示。

  为满足仿生蛇机器人能够灵活运动的要求，考虑到总系统的稳定性，易操作性及耐用性等，本设计的控制方案采用舵机驱动。舵机由减速齿轮组、反馈电路和电机组成的驱动系统。STM32 芯片通过信号线与舵机控制线相连，通过内部定时器产生的PWM 信号控制舵机的旋转角度，并通过串口接收舵机的反馈角度，作为总系统的反馈角。经过多方面的测试舵机型号选用RDS3115，该舵机扭力大，精度高，可以轻松又有效的驱动蛇身运动。并且此舵机内部带有编码器能够准确的测出旋转角度，并通过自带的串口反馈角度，更加的适合闭环控制，更好的满足多种方式运动需求。

  为满足图像传输和远程控制功能本设计采用ESP32模块，其拥有32 位双核处理器，CPU 正常工作速度为80 MHz 最高可达240 MHz。工作时候的温度为-20℃~70℃，工作电压为4.75 V~5.35 V。在接收到摄像头传入的图像后通过无线网络传回图像，能做到低延迟、高帧率的有效传回，在远程遥控上也是通过无线 的串口把控制信号传输给单片机，最终达到控制整个蛇在超远距离移动的目的。

  摄像头采用的方案是通过OpenMv 采集数据，通过SPI 传输。OpenMv摄像头捕捉到图像后，经过图像处理算法做处理，将处理好后的视频帧转换为SPI传输格式，再配置好ESP32 的SPI接口，通过串口将OpenMv 采集的数据传输给ESP32 并通过配置好的SPI传输到接收端，接收端进行解码配置，就可以转化为可视化图像。如图5图像的显示。

  本次项目所制作的仿生蛇侦察机器人主控芯片是STM32F103C8T6，通过内部时钟产生6 路PWM 信号对6 个舵机进行旋转控制，在通过舵机内部串口返回的角度给主控芯片，最后通过算法实现对舵机角度的自动调节，以此来实现对整个仿生蛇侦察机器人的运动来控制。针对不同的使用场景，仿生蛇侦察机器人在运行的过程中需要具有，前进、左右转弯、克服障碍物等功能。在面对不同的地形设计有4 种运动方式：蜿蜒运动、侧向运动、螺旋运动和行波运动

  [3]。通过ESP32 和STM32 相连进行运动模式的选择，能轻松实现远程无线遥控仿生蛇侦察机器人。为了方便数据的实时传输，采用了OpenMv 摄像头和ESP32 对图像的传输，为了在夜间行进采用MLX90640 红外热成像模块进行红外识别，采集到地面信息后传输给ESP32，减少黑暗对仿生蛇侦察机器人的影响。通过GPS 定位能够准确的知道仿生蛇军事侦察机器人的准确位置，能更完美的实现侦察任务。

  为了保证仿生蛇侦察机器人运动流畅，在舵机与舵机之间加入了PID 算法调节，在第1 个关节处是预期量，输出量给第2 个关节输入，和给第1 个关节反馈，这样第1 个关节形成了1 个闭环控制，通过舵机与舵机之间的串级PID 调节，会使得整个仿生蛇侦察机器人的控制更便利,PID 流程图如图7。

  基于STM32 最小系统板，与6 个RDS3115 舵机，配合OpenMv 摄像头、MLX90640 红外摄像头和ESP32等模块设计的仿生蛇军事侦察机器人，可以在一定程度上完成远程遥控，外观具有极高的隐蔽性，并能够高效的传输图像，可根据不同地形选不一样的运动模式，可以高效率的前进，在抗震救灾、城市排爆也有着极高的应用价值。