[发明专利]一种球上自平衡机器人控制系统

说明书

技术领域

本发明涉及一种可以控制机器人在狭窄空间内灵活移动的球上自平衡机器人控制系统。

背景技术

随着对球上机器人的进一步研究，科研人员发现现有球上机器人仍难以适应恶劣的环境且机器人的外部易受撞击破损。韩国大学的Jayoung Kim对机器人做了进一步的改造，将机器人外壳用弹性材质替换，新材质的球上机器人可以更好的应对撞击并提供一定的稳定性。

随着许多高危任务的出现，在美国科研人员Asada的努力下设计出运用于检查核反应堆的机器人。该机器人的设计原理继承了原有球上机器人设计的理念，但整体模型偏小，体型优势可以让机器人行走在各种狭小的空间中。新型球上机器人的外部材质得到了进一步的升级，具有抵抗核辐射的能力，不需担心机器人在执行任务中收到损坏。在机器人的内部安装了前一代球上机器人的摄像头，赋予了机器人传输影像反馈检测任务的能力。新型球上机器人这一功能可以准确的传输影像，对于一些细微的环节可以分析出问题，确保任务的成功概率。

随着电子信息技术的进步和制造水平的提高，我国一些机器人研究人员也逐渐把目光投向了新型球上机器人的研究当中，在前人取得的各项研究成果的基础上进行着默默探索。

目前，各种探测对球上机器人的需求越来越高，为了更好的应对各种恶劣环境下机器人的作业水平，北京航空大学号制造出可以进行指令传输的多功能球上机器人。该球上机器人带有摄像装置，可以从后台观察实时摄像，另外球上机器人有稳定装置，在遇到崎岖不平的地形仍然可以平稳运行。

发明内容

本发明所要解决的技术问题是提供一种可以控制机器人在狭窄空间内灵活移动的球上自平衡机器人控制系统。

本发明解决上述技术问题的技术方案如下：一种球上自平衡机器人控制系统，包括三个电机驱动模块，每个所述电机驱动模块分别与微处理器连接，每个所述电机驱动模块还分别连接至电源模块，所述电源模块还连接稳压模块的输入端，所述稳压模块的输出端连接微处理器；

该控制系统还包括测速编码器，所述测速编码器连接至鉴相倍频模块一端，所述鉴相倍频模块另一端连接至微处理器；

该控制系统还包括与所述微处理器连接的姿态传感器。

本发明的有益效果是：微处理器将控制信号分别发送给三个电机驱动模块，对应地分别驱动三个步进电机，从而实现在狭小空间和距离内能全方位灵活移动。在电源模块与微处理器之间加入稳压模块，使得微处理器输入电压更稳定。

在上述技术方案的基础上，本发明还可以做如下改进。

进一步，该控制系统还包括串口调试接口，所述串口调试接口一端与所述微处理器连接，所述串口调试接口另一端连接至无线通讯模块。

具体的，所述无线通讯模块是蓝牙模块。

采用上述进一步方案的有益效果是，通过串口调试接口和无线通讯模块可以方便调试以及实时了解车体的姿态和运动信息，具体的可以通过蓝牙串口模块将小车的数据传回至电脑上位机进行观察分析。

进一步，还包与所述微处理器连接的括波形显示器。

具体的，所述波形显示器是OLED液晶显示屏。

采用上述进一步方案的有益效果是，采用波形显示器可以实时显示小车角度、速度等信息。具体的，OLED液晶显示屏具有刷屏快、功耗小等特点，在调试过程中起到非常重要的作用。

进一步，所述电源模块是航模锂电池。

采用上述进一步方案的有益效果是，锂电池的体积小、重量轻、电池电压高，很容易在车体上找到合适的位置安装。

进一步，三个所述电机驱动模块均为H桥驱动模块。

采用上述进一步方案的有益效果是，使用IR2104驱动MOS管IRF3205的H桥的电路，每个电机需要2片IR2104和4片IRF3205，因此该驱动模块具有电路简单、驱动电流大、价格便宜的优点。

进一步，所述姿态传感器是MPU6050姿态传感器。

采用上述进一步方案的有益效果是，InvenSense公司的MPU6050传感器是融合了三轴加速度传感器和三轴陀螺仪传感器的六轴姿态传感器。MPU6050的陀螺仪和加速度计具有较高的灵敏度和分辨率，虽然该传感器的寄存器为8位，每次读取数据需要两个读写周期，但是其采样频率比较高，可以满足机器人姿态采样的要求。

进一步，所述微处理器是MK60FX512VLQ15处理器。