一种两轮自平衡移动机器人控制系统技术方案

本实用新型专利技术公开了一种两轮自平衡移动机器人控制系统，包括有安装在两轮自平衡移动机器人内部的主控芯片以及与主控芯片连接的电源、速度测量传感器、轨道循迹传感器、参数调整模块和电机驱动模块，还包括有安装在两轮自平衡移动机器人底部的与主控芯片连接的倾角测量传感器和安装在两轮自平衡移动机器人上的与主控芯片连接的显示模块和蓝牙信息接收采集模块，倾角测量传感器包括有加速度计和陀螺仪，加速度计和陀螺仪采集的数据通过数据融合单元发送给主控芯片，所述的轨道循迹传感器是由工字型电感构成的，所述的电机驱动模块还与两轮自平衡移动机器人内部的驱动电机连接。本实用新型专利技术采用多传感器的信息融合，可以得到更加准确的测量数据。

A control system of two wheeled self balancing mobile robot

The utility model discloses a control system of a two wheel self balancing mobile robot, which comprises a main control chip installed inside the two wheel self balancing mobile robot, a power supply connected with the main control chip, a speed measurement sensor, a track tracking sensor, a parameter adjustment module and an electric drive module, and a main control chip installed at the bottom of the two wheel self balancing mobile robot The connected inclinometer sensor and the display module and the Bluetooth information receiving and collecting module connected with the main control chip installed on the two wheel self balancing mobile robot, the inclinometer sensor includes an accelerometer and a gyroscope, and the data collected by the accelerometer and the gyroscope are sent to the main control chip through a data fusion unit, and the track tracking sensor is constructed by an i-type inductance The motor driving module is also connected with the driving motor inside the two-wheel self balancing mobile robot. The utility model adopts multi-sensor information fusion, which can obtain more accurate measurement data.

【技术实现步骤摘要】
一种两轮自平衡移动机器人控制系统
本技术涉及机器人控制
，尤其涉及一种两轮自平衡移动机器人控制系统。
技术介绍
两轮自平衡移动机器人为典型的非完整、非线性及欠驱动控制系统，具有广泛的实际应用价值。为了实现该系统运动过程中的平衡控制，必须具有能够实时检测其姿态信息的检测系统，并将姿态信息及时传递给控制器，以实现对两轮自平衡移动机器人的准确控制。目前，用于两轮自平衡移动机器人控制的角度传感器和陀螺仪都有缺点，容易受外界的影响，造成测量的不准，影响控制精度。
技术实现思路
本技术目的就是为了弥补已有技术的缺陷，提供一种两轮自平衡移动机器人控制系统。本技术是通过以下技术方案实现的：一种两轮自平衡移动机器人控制系统，包括有安装在两轮自平衡移动机器人内部的主控芯片以及与主控芯片连接的电源、速度测量传感器、轨道循迹传感器、参数调整模块和电机驱动模块，还包括有安装在两轮自平衡移动机器人底部的与主控芯片连接的倾角测量传感器和安装在两轮自平衡移动机器人上的与主控芯片连接的显示模块和蓝牙信息接收采集模块，所述的倾角测量传感器包括有加速度计和陀螺仪，加速度计和陀螺仪采集的数据通过数据融合单元发送给主控芯片，所述的轨道循迹传感器是由工字型电感构成的，所述的电机驱动模块还与两轮自平衡移动机器人内部的驱动电机连接。所述的主控芯片采用S9KEA128AMLK芯片。所述的加速度计的型号为MMA845X；所述的陀螺仪的型号为L3G4200。所述的速度测量传感器采用mini512线编码器。r>所述的电机驱动模块是采用MOS管搭建的全桥驱动。所述的参数调整模块是由键盘和拨码开关构成的。所述的倾角测量传感器由安装在两轮自平衡移动机器人底部的加速度计和陀螺仪构成，加速度计和陀螺仪所采集的数据经数据融合单元的处理，从而获得更加准确的采集数据；所述的轨道循迹传感器由电感构成，通过对通电导线周边所产生磁场的采集，算出中线使两轮自平衡移动机器人沿着中线运动；所述的速度测量传感器采用mini512线编码器实现，用于采集两轮自平衡移动机器人的运动速度信息；所述的蓝牙信息接收模块，用于将主控芯片接收的信息发送给上位机，同时上位机也可以发送两轮自平衡移动机器人的控制命令到主控芯片；所述的电机驱动模块MOS管搭建的全桥电路构成，其输出信号用于控制两轮自平衡移动机器人驱动轮的动作；系统所述电源由7.2V锂电池构成；所述参数调整模块由键盘和拨码开个构成，主要用于对控制系统运行的PID算法的相关参数进行设定。对于加速度计传感器容易受电机电压信号的干扰，造成测量数据毛刺太多，不利于控制。陀螺仪测量角速度，需要通过积分运算，但积分运算容易造成滞后，两者经过角度融合，各取所长得去最后的角度。本技术的优点是：本技术采用多传感器的信息融合，可以得到更加准确的测量数据；两轮自平衡移动机器人不同与其它四轮机器人，它靠两个轮子行走，所以在机械结构方面自然要求严格一点了;首先要知道机械零点这个点;没有机械零点的机器人，意味永远无法通过加减速达到平衡状态;另外机器人的重量集中在轴的两侧，这样方便回到平衡状态，机器人的重量比较偏轻，省去了调整所需花费的动力，方便行走。附图说明图1为本技术系统构成框图。图2为本技术各个模块的供电电源电路图。图3为本技术的电机驱动模块电路图。图4为本技术参数调整模块的电路图。图5为本技术ADC数据采集口的电路图。图6为本技术倾角传感器模块的电路图。图7为本技术显示模块模块的电路图。图8为本技术蓝牙串口模块的电路图。图9为本技术速度测量模块的电路图。具体实施方式如图1、2所示，一种两轮自平衡移动机器人控制系统，包括有安装在两轮自平衡移动机器人内部的主控芯片1以及与主控芯片1连接的电源2、速度测量传感器4、轨道循迹传感器5、参数调整模块6和电机驱动模块9，还包括有安装在两轮自平衡移动机器人底部的与主控芯片1连接的倾角测量传感器3和安装在两轮自平衡移动机器人上的与主控芯片1连接的显示模块7和蓝牙信息接收采集模块8，所述的倾角测量传感器3包括有加速度计和陀螺仪，加速度计和陀螺仪采集的数据通过数据融合单元发送给主控芯片，所述的轨道循迹传感器5是由工字型电感构成的，所述的电机驱动模块9还与两轮自平衡移动机器人内部的驱动电机连接。所述的主控芯片1采用S9KEA128AMLK芯片，该芯片自带12位ADC采集功能，PWM控制精确。所述的加速度计的型号为MMA845X；所述的陀螺仪的型号为L3G4200。所述的速度测量传感器4采用mini512线编码器。如图3所示，所述的电机驱动模块9是采用MOS管搭建的全桥驱动，具有驱动电流更大，驱动效果好的特点。所述的参数调整模块6是由键盘和拨码开关构成的。所述的倾角采集模块3由安装在两轮自平衡移动机器人底部的加速度计和陀螺仪构成，加速度计和陀螺仪所采集的数据经数据融合单元的处理，从而获得更加准确的采集数据；所述的轨道循迹传感器5由工字型电感构成，通过对通电导线周边所产生磁场的采集，算出中线使两轮自平衡移动机器人沿着中线运动；所述的速度测量传感器4采用mini512线编码器实现，用于采集两轮自平衡移动机器人的运动速度信息；所述的蓝牙信息接收模块，用于将主控芯片接收的信息发送给上位机，同时上位机也可以发送两轮自平衡移动机器人的控制命令到主控芯片；所述的电机驱动模块9MOS管搭建的全桥电路构成，其输出信号用于控制两轮自平衡移动机器人驱动轮的动作；所述电源由7.2V锂电池构成；如图4、5所示，所述参数调整模块由键盘和拨码开个构成，主要用于对控制系统运行的PID算法的相关参数进行设定。如图5、6、7、8、9所示，分别为ADC数据采集口的电路图、倾角传感器模块的电路图、显示模块模块的电路图、蓝牙串口模块的电路图、速度测量模块的电路图。为了得到更好的控制效果，本技术采用了速度--角度--角速度三级由外到内的串级控制方法，采用串级控制方案的优点有：1）由于副回路的存在，减小了对象的时间常数，缩短了控制通道，使控制作用能得到更加及时的响应。2）使两轮自平衡移动机器人控制系统具有更好的抗干扰能力。3）使两轮自平衡移动机器人对其负荷或者运行环境的变化具有一定的自适应能力。对两轮自平衡移动机器人的控制具体包括三个方面的控制：一、两轮自平衡移动机器人直立控制利用倾角测量传感器读出数据，进行卡尔曼滤波处理得到最终的角度信息。在两轮自平衡移动机器人的直立控制中，角速度环和角度环都使用PD控制算法，通过该算法可以做到两轮自平衡移动机器人直立的控制要求。二、两轮自平衡移动机器人行走控制为了获得两轮自平衡移动机器人速度，本实用信息采用mini512线编码器进行速度检测，两轮自平衡移动机本文档来自技高网...

【技术保护点】
1.一种两轮自平衡移动机器人控制系统，其特征在于：包括有安装在两轮自平衡移动机器人内部的主控芯片以及与主控芯片连接的电源、速度测量传感器、轨道循迹传感器、参数调整模块和电机驱动模块，还包括有安装在两轮自平衡移动机器人底部的与主控芯片连接的倾角测量传感器和安装在两轮自平衡移动机器人上的与主控芯片连接的显示模块和蓝牙信息接收采集模块，所述的倾角测量传感器包括有加速度计和陀螺仪，加速度计和陀螺仪采集的数据通过数据融合单元发送给主控芯片，所述的轨道循迹传感器是由工字型电感构成的，所述的电机驱动模块还与两轮自平衡移动机器人内部的驱动电机连接。/n

【技术特征摘要】
1.一种两轮自平衡移动机器人控制系统，其特征在于：包括有安装在两轮自平衡移动机器人内部的主控芯片以及与主控芯片连接的电源、速度测量传感器、轨道循迹传感器、参数调整模块和电机驱动模块，还包括有安装在两轮自平衡移动机器人底部的与主控芯片连接的倾角测量传感器和安装在两轮自平衡移动机器人上的与主控芯片连接的显示模块和蓝牙信息接收采集模块，所述的倾角测量传感器包括有加速度计和陀螺仪，加速度计和陀螺仪采集的数据通过数据融合单元发送给主控芯片，所述的轨道循迹传感器是由工字型电感构成的，所述的电机驱动模块还与两轮自平衡移动机器人内部的驱动电机连接。


2.根据权利要求1所述的一种两轮自平衡移动机器人控制系统，其特征在于：所...

【专利技术属性】
技术研发人员：郭一军，黄辉，倪康，
申请(专利权)人：黄山学院，
类型：新型
国别省市：安徽;34