一种纵向两轮自平衡机器人及控制系统技术方案

本发明专利技术公开了一种纵向两轮自平衡机器人及控制系统，一种纵向两轮自平衡机器人包括车头部分、车身部分、车尾部分、电控箱、前轮转向机构、前轮安装机构、前轮、后轮安装机构、后轮，一种纵向两轮自平衡机器人控制系统包括主控制单元、双陀螺平衡部件、舵机驱动单元、后轮驱动单元、人机交互单元、信息检测单元、供电单元。本发明专利技术基于双飞轮陀螺效应原理实现自平衡，其控制系统采用自适应控制算法以及通过在线辨识使模型逐渐接近实际，从而使纵向两轮自平衡机器人在受到一定程度侧向撞击力时可自动恢复平稳状态，在承受一定程度非对称负载时可保持平稳状态，在遇到明显障碍物时可实现自动避障，且具有响应快、修正力矩大、能耗低，噪声小的优点。

Longitudinal two wheel self balancing robot and control system

The invention discloses a longitudinal robot and control system of two wheeled self balancing, a vertical two wheeled self balancing robot, including the front part of the body part and the rear part, control box, front steering mechanism, the front wheel mounting mechanism, a front wheel and a rear wheel mounting mechanism, the rear wheel, a vertical two wheeled self balancing robot control system includes a main control double balance unit, gyro component, servo drive unit, rear wheel drive unit, a man-machine interaction unit, detection unit and a power supply unit. The present invention double flywheel gyro effect principle to achieve self balancing based on its control system using the adaptive control algorithm and the on-line identification of the model gradually close to practice, so that the vertical two wheeled self balancing robot in certain degree by lateral impact force when the automatic recovery in the steady state, can withstand a certain degree of asymmetry in steady state load. Encountered significant obstacles can realize automatic obstacle avoidance, and has a fast, large torque, low energy response correction, advantages of low noise.

【技术实现步骤摘要】
一种纵向两轮自平衡机器人及控制系统
本专利技术涉及电动平衡车的
，具体涉及一种纵向两轮自平衡机器人及控制系统。
技术介绍
两轮移动机器人分为同轴两轮(左右分布)和纵向两轮(前后分布)两种。同轴两轮移动机器人具有极强的灵活性且与两足机器人行走有很大的相似性，行业内相关的研究与应用比较多，但是纵向两轮的机器人自平衡的实现极具挑战性。由于纵向两轮平衡机器人是典型的自然不稳定体，在非控制的情况下会左右摆动，而实现自平衡比较困难，因此其平衡控制是一个比较复杂的过程。由于前后两轮结构是不稳定、多变量、非线性、强耦合系统，在实际应用中还存在许多问题待去解决。目前国内外研究的重点主要集中在自平衡技术开发上，以及提高平衡稳定性的方法上。自平衡技术包括飞轮陀螺效应法、前轮转向法、重心调整法、反作用力矩法以及上述方法的结合。飞轮陀螺效应法是依靠飞轮陀螺效应产生的陀螺力矩保持稳定；前轮转向法是依靠控制机器人前轮的转向来保持稳定；重心调整法是依靠调整机器人重心来保持稳定；反作用力矩法是依靠驱动转子的反作用力矩来保持稳定。但目前这些方法都存在稳定性不高、能耗大、自主能力缺乏等弱点，且其控制系统设计过于复杂，难以快速地满足实用性要求。
技术实现思路
有鉴于此，为了解决现有技术中的上述问题，本专利技术提出一种纵向两轮自平衡机器人及控制系统。本专利技术通过以下技术手段解决上述问题：一种纵向两轮自平衡机器人，包括依次连接的车头部分、车身部分、车尾部分，还包括电控箱、前轮转向机构、前轮安装机构、前轮、后轮安装机构、后轮；所述电控箱安装在车身部分的腔体内，用于安装电控及供电部件；所述前轮转向机构安装在车头部分，用于传动前轮的转向运动；所述前轮安装机构安装在前轮转向机构上，用于给前轮提供安装支架；所述前轮安装在前轮安装机构上，用于作为机器人的承重轮以及改变机器人的转向；所述后轮安装机构安装在车尾部分，用于给后轮提供安装支架。进一步地，一种纵向两轮自平衡机器人控制系统，安装在如上所述的一种纵向两轮自平衡机器人上，包括：主控制单元，安装在电控箱内，分别与双陀螺平衡部件、舵机驱动单元、后轮驱动单元、人机交互单元、信息检测单元、供电单元连接，用于控制机器人动作以及读取检测信号；双陀螺平衡部件，安装在车身部分的内腔里，用于保持机器人的平衡；舵机驱动单元，安装在车头部分，包括依次电连接的舵机、舵机驱动器，用于驱动前轮转向机构从而改变前轮转向的角度大小；后轮驱动单元，安装在后轮安装机构，用于驱动后轮前进、后退以及刹车；人机交互单元，安装在车头部分，用于显示电控系统的各种信息以及响应用户的操作输入；信息检测单元，安装在机器人相应的检测位，分别与双陀螺平衡部件、舵机驱动单元、后轮驱动单元连接，用于检测机器人各种运动参数；供电单元，安装在电控箱内，分别与双陀螺平衡部件、舵机及驱动模块、后轮驱动单元、人机交互单元、信息检测单元，用于给整个系统供电以及对电源进行管理。进一步地，所述主控制单元包括：微处理器，分别与信号调理电路、存储区域、工作指示器连接，用于实现机器人自平衡控制算法，用于数据处理和发送命令，用于与外部功能模块进行通信；信号调理电路，用于各路传感器信号的滤波、放大和采集；存储区域，用于保存初始化配置参数，实时记录操作过程中的状态数据；工作指示器，用于指示系统成功运行或故障报警。进一步地，所述双陀螺平衡部件包括：两个飞轮，固定安装在车身部分，用于在高速自转时产生保持机器人平衡的陀螺力矩；两个无刷电机，一对一地与两个飞轮安装连接，用于驱动两个飞轮高速自转；无刷电调装置，分别与两个无刷电机电连接，用于调节无刷电机的转速；飞轮同步偏转装置，用于实现两个飞轮以相反方向的同步偏转从而自平衡的陀螺力矩，同时抵消单飞轮效应存在的不利力矩；飞轮偏转电机驱动单元，包括依次电连接的飞轮偏转电机、飞轮偏转电机驱动器，用于驱动飞轮同步偏转装置。进一步地，所述供电单元包括依次连接的充电电池组、电源管理模块；所述充电电池组，安装在电控箱内，用于提供直流电源给机器人；所述电源管理模块，安装在电控箱内，用于管理与监测充电电池组。进一步地，所述后轮驱动单元包括依次电连接的轮毂电机、轮毂电机驱动器；所述轮毂电机，与所述后轮进行机械连接，用于驱动机器人后轮的前后运动；所述轮毂电机驱动器，用于控制轮毂电机的启停、转速和刹车。进一步地，所述信息检测单元包括：飞轮转速检测传感器，分别与所述飞轮、所述信号调理电路连接，用于测量飞轮自转时的转速并将测量参数反馈到所述主控制单元；飞轮偏转运动检测传感器，分别与所述飞轮偏转电机、所述信号调理电路连接，用于测量飞轮产生进动时偏转角度和角速度并将测量参数反馈到所述主控制单元；姿态仪，安装在机器人上，与所述信号调理电路连接，用于测量纵向两轮平衡机器人侧向倾斜角度和角速度并将测量参数反馈到所述主控制单元；后轮转速检测传感器，分别与所述轮毂电机、所述信号调理电路连接，用于测量后轮的转速并将测量参数反馈到所述主控制单元；前轮转向角度检测传感器，分别与所述舵机、所述信号调理电路连接，用于测量前轮转向的角度和角速度并将测量参数反馈到所述主控制单元；避障传感器，安装在车头部分的最前端，与所述信号调理电路连接，用于测量障碍物的距离并将测量参数反馈到所述主控制单元。进一步地，所述人机交互单元包括高清摄像头、触摸屏、WIFI通信模块；所述高清摄像头，安装在车头部分的最前端，与WIFI通信模块连接，用于获取路况以及障碍物信息等并将信息传输到WIFI通信模块；所述触摸屏，与所述主控制单元连接，用于实时显示机器人整个状态信息，同时响应用户操作事件。所述WIFI通信模块，分别与所述主控制单元、高清摄像头连接，用于回传机器人的状态信息至计算机或移动终端中，同时接收计算机或移动终端的命令与数据，包括TTL串口、USB接口；所述TTL串口，通过协议转换等方式与所述主控制单元连接，用于将WIFI通信模块83接收到的电脑端或移动终端的控制命令转发给所述主控制单元，配置机器人的工作参数，同时回传机器人工作状态数据至计算机或移动终端；所述USB接口，与高清摄像头的USB口连接，用于通过WIFI信号将高清摄像头图像传输至计算机或移动终端。进一步地，所述微处理器包括依次连接的CPU核心、外设接口；所述CPU核心，为ARM控制器，用于计算与控制机器人自平衡过程，用于采集与处理各路传感器数据，用于处理接收与发送的命令，用于ADC转换，用于产生不同频率、占空比的PWM波；所述外设接口，用于CPU核心与外部功能模块之间的数据与命令传输，包括以下至少一种接口：普通I/O口，分别与飞轮转速检测传感器、后轮转速检测传感器、前轮转向角度检测传感器、飞轮偏转运动检测传感器、避障传感器连接，用于获取飞轮转速检测传感器与后轮转速检测传感器的数字信号、前轮转向角度检测传感器与飞轮偏转运动检测传感器的模拟信号、避障传感器的脉冲信号；光耦隔离I/O口，分别与无刷电调装置、轮毂电机驱动器、舵机驱动器、飞轮偏转电机驱动器连接，用于使能信号控制无刷电调装置、轮毂电机驱动器、舵机驱动器和飞轮偏转电机驱动器的；UART接口，与姿态仪连接，用于读取姿态仪中机器人姿态信息与倾斜角速度数据，用于与WIFI通信模块以接收计算机或移动终端的命令或者回本文档来自技高网...

【技术保护点】
一种纵向两轮自平衡机器人，其特征在于，包括依次连接的车头部分、车身部分、车尾部分，还包括电控箱、前轮转向机构、前轮安装机构、前轮、后轮安装机构、后轮；所述电控箱安装在车身部分的腔体内，用于安装电控及供电部件；所述前轮转向机构安装在车头部分，用于传动前轮的转向运动；所述前轮安装机构安装在前轮转向机构上，用于给前轮提供安装支架；所述前轮安装在前轮安装机构上，用于作为机器人的承重轮以及改变机器人的转向；所述后轮安装机构安装在车尾部分，用于给后轮提供安装支架。

【技术特征摘要】
1.一种纵向两轮自平衡机器人，其特征在于，包括依次连接的车头部分、车身部分、车尾部分，还包括电控箱、前轮转向机构、前轮安装机构、前轮、后轮安装机构、后轮；所述电控箱安装在车身部分的腔体内，用于安装电控及供电部件；所述前轮转向机构安装在车头部分，用于传动前轮的转向运动；所述前轮安装机构安装在前轮转向机构上，用于给前轮提供安装支架；所述前轮安装在前轮安装机构上，用于作为机器人的承重轮以及改变机器人的转向；所述后轮安装机构安装在车尾部分，用于给后轮提供安装支架。2.一种纵向两轮自平衡机器人控制系统，安装在如权利要求1所述的一种纵向两轮自平衡机器人上，其特征在于，包括：主控制单元，安装在电控箱内，分别与双陀螺平衡部件、舵机驱动单元、后轮驱动单元、人机交互单元、信息检测单元、供电单元连接，用于控制机器人动作以及读取检测信号；双陀螺平衡部件，安装在车身部分的内腔里，用于保持机器人的平衡；舵机驱动单元，安装在车头部分，包括依次电连接的舵机、舵机驱动器，用于驱动前轮转向机构从而改变前轮转向的角度大小；后轮驱动单元，安装在后轮安装机构，用于驱动后轮前进、后退以及刹车；人机交互单元，安装在车头部分，用于显示电控系统的各种信息以及响应用户的操作输入；信息检测单元，安装在机器人相应的检测位，分别与双陀螺平衡部件、舵机驱动单元、后轮驱动单元连接，用于检测机器人各种运动参数；供电单元，安装在电控箱内，分别与双陀螺平衡部件、舵机及驱动模块、后轮驱动单元、人机交互单元、信息检测单元，用于给整个系统供电以及对电源进行管理。3.如权利要求2所述纵向两轮自平衡机器人的控制系统，其特征在于，所述主控制单元包括：微处理器，分别与信号调理电路、存储区域、工作指示器连接，用于实现机器人自平衡控制算法，用于数据处理和发送命令，用于与外部功能模块进行通信；信号调理电路，用于各路传感器信号的滤波、放大和采集；存储区域，用于保存初始化配置参数，实时记录操作过程中的状态数据；工作指示器，用于指示系统成功运行或故障报警。4.如权利要求2所述纵向两轮自平衡机器人的控制系统，其特征在于，所述双陀螺平衡部件包括：两个飞轮，固定安装在车身部分，用于在高速自转时产生保持机器人平衡的陀螺力矩；两个无刷电机，一对一地与两个飞轮安装连接，用于驱动两个飞轮高速自转；无刷电调装置，分别与两个无刷电机电连接，用于调节无刷电机的转速；飞轮同步偏转装置，用于实现两个飞轮以相反方向的同步偏转从而自平衡的陀螺力矩，同时抵消单飞轮效应存在的不利力矩；飞轮偏转电机驱动单元，包括依次电连接的飞轮偏转电机、飞轮偏转电机驱动器，用于驱动飞轮同步偏转装置。5.如权利要求2所述纵向两轮自平衡机器人控制系统，其特征在于，所述供电单元包括依次连接的充电电池组、电源管理模块，所述后轮驱动单元包括依次电连接的轮毂电机、轮毂电机驱动器；所述充电电池组，安装在电控箱内，用于提供直流电源给机器人；所述电源管理模块，安装在电控箱内，用于管理与监测充电电池组；所述轮毂电机，与所述后轮进行机械连接，用于驱动机器人后轮的前后运动；所述轮毂电机驱动器，用于控制轮毂电机的启停、转速和刹车。6.如权利要求2-5任一所述的纵向两轮自平衡机器人控制系统，其特征在于，所述信息检测单元包括：飞轮转速检测传感器，分别与所述飞轮、所述信号调理电路连接，用于测量飞轮自转时的转速并将测量参数反馈到所述主控制单元；飞轮偏转运动检测传感器，分别与所述飞轮偏转电机、所述信号调理电路连接，用于测量飞轮产生进动时偏转角度和角速度并将测量参数反馈到所述主控制单元；姿态仪，安装在机器人上，与所述信号调理电路连接，用于测量纵向两轮平衡机器人侧向倾斜角度和角速度并将测量参数反馈到所述主控制单元；后轮转速检测传感器，分别与所述轮毂电机、所述信号调理电路连接，用于测量后轮的转速并将测量参数反馈到所述主控制单元；前轮转向角度检测传感器，分别与所述舵机、所述信号调理电路连接，用于测量前轮转向的角度和角速度并将测量参数反馈到所述主控制单元；避障传感器，安装在车头部分的最前端，与所述信号调理电路连接，用于测量障碍物的距离并将测量参数反馈到所述主控制单元。7.如权利要求2所述纵向两轮自平衡机器人控制系统，其特征在于，所述人机交互单元包括高清摄像头、触摸屏、WIFI通信模块：所述高清摄像头，安装在车头部分的最前端，...

【专利技术属性】
技术研发人员：李亚锋，王卫军，张弓，邱金凤，杨根，李友浩，李冰清，梁松松，
申请(专利权)人：广州中国科学院先进技术研究所，深圳市中科德睿智能科技有限公司，
类型：发明
国别省市：广东,44