为了使蛇形机器人在不同地形环境下能更好地完成搜救任务,文中根据蛇形机器人的特点,从总体上设计了一种新型的前端执行机构。针对传统的蛇形机器人头部只有搜寻传感器无执行器的缺点,提出采用4自由度的正交机械臂作为前端执行器的方法,并以ARM7-LPC2132为控制器、L298N为电机驱动模块、液晶屏12864为人机交互界面搭建了系统的硬件平台。通过无线路由器WR703n可将天敏S608摄像头数据传至上位机进行视频监控、上位机可通过NRF24L01无线数传模块对下位机进行实时控制、温度测量、烟雾报警、机械臂除障等功能,从而可以进行复杂地形及位置领域的探测。系统程序软件采用C语言及C#编写。系统经过调试,可以实现对障碍物的夹取和搬运等预定功能。无线遥控距离可以达到100 m,而且通信效果稳定可靠。

交流异步电机直接转矩控制程序，基于LPC2132，经测试可用