[发明专利]大尺寸球形机器人控制系统

说明书

技术领域

    本发明涉及大尺寸球形机器人控制系统，特别是适用于环境探测的大尺寸球形机器人控制系统。

背景技术

在环境探测过程中，通常会遇到崎岖不平，湿地，沼泽，极热或极寒等恶劣的环境，极大的制约着科学考察的开展，因此机器人代替人工进行探测，成为一种新的趋势。目前，出现了轮式、腿式或履带式等机器人应用于科考活动。

由于球形机器人具有结构简单、控制方便、运动灵活，以及效率高、能耗小，并具有良好的动态和静态平衡性等优点，近些年来得到了快速的发展，广泛应用于环境探测，科学研究，娱乐等领域，国内外都做了大量的研究，并且取得了较好的成果。但是，对比分析了国内外的研究，球形机器人驱动主要分为内驱动和外驱动。对于内驱动的球形机器人，目前国内外通常做得比较小，北京邮电大学的BYQ系列，哈尔滨工业大学研制的球形机器人，北航的BHQ等，通常直径在320mm~600mm，大小不等，主要用于简单的环境探测，因此对应的控制系统采用单一的单片机，DSP或是ARM类控制单元。外驱动的球形机器人，大多是充气型或是结构简单的框架结构，依靠风力驱动，内部结构配置探测环境数据的器件，控制部分很少，自主性比较差，不能按照预定的轨迹运动。

对于用于环境探测的球形机器人，要能克服越障困难，陷入凹凸不平的缝隙中的各种困难，并且能根据环境的参数进行调整，具有自主性。这些要求制约了尺寸偏小的球形机器人和外驱动球形机器人的应用。为了能适用于恶劣环境的探测，研制了一个直径为1米的大尺寸球形机器人。球形机器人通过驱动电机和转向电机，带动摆杆和配置块运动，改变机器人的质心位置，产生偏心力矩，驱动机器人运动，实现直线运动和转向运动。为了实现这种自主的运动，针对大尺寸的球形机器人，设计发明了一套大尺寸球形机器人的控制系统。

发明内容

    本发明的目的在于解决现有的技术存在的问题，为大尺寸球形机器人提供一种能实现直线运动和转向运动的大尺寸球形机器人控制系统。

为解决上述技术问题，本发明提供一种大尺寸球形机器人控制系统，包括上位机部分和球形机器人部分。所述上位机部分包括计算机，单片机和无线通信模块，负责系统管理、人机接口、任务规划和动作指令生成等功能。所述球形机器人部分的包括主控制器，单片机和姿态传感器，避障传感器，伺服电机控制器，无线通信模块，24V锂电池，5V锂电池,24V继电器，5V继电器。所述控制器连接伺服电机控制器、单片机、姿态传感器、避障传感器和5V继电器，所述24V锂电池经24V继电器和伺服电机控制器连接伺服电机，所述单片机连接24V继电器、无线通信模块、5V锂电池和5V继电器；

上位机部分无线通信模块包括接收和发射两块射频芯片。

球形机器人部分无线通信模块包括接收和发射两块射频芯片。

所述球形机器人部分的主控制器集成在一块开发板上。

大尺寸球形机器人的控制系统，计算机操作通过单片机和无线通信模块向球形机器人发送指令，机器人的无线通信模块接收指令，单片机根据指令与主控制器通信，主控制器，控制继电器、伺服电机控制器动作，并根据姿态传感器和避障传感器反馈调整机器人运动，实现机器人直线和转向运动；主控制器通过单片机向计算机发送机器人的状态信息。

上位机部分的单片机，型号为STM32，带有SPI接口，采用串口转USB芯片，通过USB连接计算机。用于控制无线通信的接收和发送。

所述上位机部分的两块射频芯片，型号为nRF24L01，与单片机连接。用于发射和接受计算机和主控制器的信号

上位机部分与球形机器人部分是通过无线传输通信的方式连接。

所述球形机器人部分的主控制器型号是S3C6410处理器，主频率为 667MHz ，运行于 Linux2.6平台。安装于开发板上。用于计算机器人的各种姿态信息和控制机器人的各种动作，执行控制算法，发送状态信息等。 

球形机器人的开发板，是安装于球形机器人的内框的控制盒内。用于加快开发速度。

球形机器人部分的单片机，型号为STM32。通过USB接口与主控制连接，安装于球形机器人的内框控制盒内。主要发挥其外设齐全且编程简单的优势，并为主控制器分担一些任务。

所述球形机器人部分的两块射频芯片，与单片机连接，接收计算机的信息指令和发射球形机器人的信息。

球形机器人部分的姿态传感器，，内部包含三轴陀螺仪，三轴加速度以及三轴磁场传感器，用于测量球形机器人的姿态数据。通过USB接口，与主控器连接，其安装于球形机器人的侧板上。