[发明专利]一种自跟随平衡小车的控制系统及方法

说明书

本发明提供了一种自跟随平衡小车的控制系统及方法，该系统具有自动测距装置，通过一种自跟随平衡小车的控制方法中卡尔曼滤波优化算法对陀螺仪和加速度计数据进行融合，并以最优姿态角和小车速度为反馈量构成平衡和速度的双闭环控制，再利用模糊PID控制算法实现小车系统的自平衡控制，能够根据自动测距装置获取前方物体和自平衡小车之间的距离，实现自主追踪，本发明提高了基于嵌入式控制器的自动跟随平衡小车系统的整体性能，使平衡小车具有耗时短、稳定性及抗干扰能力强、功耗低等特点。

技术领域

本发明涉及自平衡小车控制技术领域，具体涉及一种自跟随平衡小车的控制系统及方法。

背景技术

随着自动控制技术的发展，越来越多的研究人员投入到两轮移动机器人方面的研究。两轮自平衡小车具有多变量、强耦合、非线性等复杂性以及高耦合的运动控制特点，是两轮移动机器人和各种控制算法研究的理想平台，目前已经有很多关于自动跟随的技术，以Five Elements Robotics推出的Budgee机器人为例，这是一款专门针对老年人和残疾人的轻量级助力机器人。Budgee的最高速度为每小时3.9公里左右，如果主人的行进速度太快，它就会用消息推送的方式提醒主人慢一些。但是这些技术都还不成熟，它们大多是使用简单的传感器，大都存在跟随的稳定性较差，反馈时间长，能耗较高的问题；且有一定安全隐患，产品也相当昂贵。

发明内容

本发明的目的是提供一种自跟随平衡小车的控制系统，解决了现有技术中存在的自动跟随技术中稳定性较差的问题。

本发明的目的是提供一种自跟随平衡小车的控制方法，解决了现有技术中存在的自动跟随技术中稳定性较差的问题。

本发明采用的技术方案是，一种自跟随平衡小车的控制系统，包括主控装置和自动跟随装置，主控装置和自动跟随装置之间通过红外超声测距接收和发送装置实现信息交互；

主控装置采用STM32F103RBT6主控板，STM32F103RBT6主控板连接有小车姿态获取装置，小车姿态获取装置包括传感器模块，STM32F103RBT6主控板连接有红外超声分体测距发送装置、小车姿态获取装置、测速装置、电机驱动装置连接，STM32F103RBT6主控板通过设置与调试模块连接上位机；

自动跟随装置包括红外超声分体测距接收装置。

红外超声分体测距接收装置设置有2个，分别安装在平衡小车的两端

电源装置通过稳压模块为主控装置、电机驱动装置供电，小车姿态获取装置采用5V供电，STM32F103RBT6主控板采用3.3V供电。

传感器模块采用带串口MPU6050型6轴传感器模块；所述带串口MPU6050型6轴传感器模块Rx接收端接PA9；Tx发送端接PA10；VCC接5V电源；GNG接电源的GND。

电机驱动装置采用TB6612FNG型电机驱动模块，VM接12V以内电源；VCC接5V电源；GND接电源负极；驱动1路PWMA接STM32F103RBT6的PA8口；A01、AO2接电机1的两个引脚；驱动2路PWMB接STM32F103RBT6的PA11口；B01、BO2接电机2的两个引脚。

红外超声分体测距发送模块VCC接5V电源；Tx发送端接PA3；Rx接收端接PA2；GNG接电源的GND。红外超声分体测距发送模块的VCC接普通5号供电电池的正极，GNG接电池负极。

一种自跟随平衡小车的控制方法，本方法采用上述一种自跟随平衡小车的控制系统，具体实施步骤为：

步骤1：系统上电，通过MPU6050型6轴传感器模块检测自跟随小车车体的倾角，以及小车的加速度值，并传送给主控装置；

步骤2：利用卡尔曼滤波优化算法对陀螺仪和加速度计数据进行融合，并以最优姿态角和小车速度为反馈量，对MPU6050型6轴传感器回传数据进行优化处理；