基于三维云台控制键盘的管道机器人设计及实现

针对石油、天然气、化工等管道的故障检测与定位,研制了一套带有可动摄像头的高性价比的轮式管道机器人。系统以STC12LE5A16S2单片机为处理核心,以基于PELCO-D协议的三维云台控制键盘作为操控单元、以RS485作为通信协议,以SM-S4315R舵机为动力源,采用输出比较的算法产生高分辨率的PWM控制脉冲,提高了舵机控制的平滑性和连续性;以基于查表匹配结合分段匹配的差速转向策略实现机器人的万向协调运动的控制,提高了系统操控的便捷性和运行的稳定性。样机的测试表明,管道机器人操控灵活、运行稳定、携带方便,在小型管道机器人领域具有较大的应用价值和推广空间。