一种自跟随平衡小车的控制系统及方法技术方案

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

A Control System and Method of Self-Following Balanced Car

【技术实现步骤摘要】
一种自跟随平衡小车的控制系统及方法
本专利技术涉及自平衡小车控制
，具体涉及一种自跟随平衡小车的控制系统及方法。
技术介绍
随着自动控制技术的发展，越来越多的研究人员投入到两轮移动机器人方面的研究。两轮自平衡小车具有多变量、强耦合、非线性等复杂性以及高耦合的运动控制特点，是两轮移动机器人和各种控制算法研究的理想平台，目前已经有很多关于自动跟随的技术，以FiveElementsRobotics推出的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轴传感器回传数据进行优化处理；步骤3：通过PID控制算法处理步骤2中优化后的数据，使自跟随小车保持平衡，构成平衡和速度的双闭环控制，由TB6612FNG型电机驱动模块控制小车运动，若PID输出调节量角度大于45度，平衡小车自动会执行制动命令；步骤4：在步骤1中的系统上电步骤后，所述红外超声分体测距发送模块超声波与红外就开始发送，红外超声分体测距接收模块采用上电后就接收超声波与红外信号并串口输出距离数。步骤5：所述的两个红外超声分体测距接收装置与被追踪物体的距离构成了一个三角形，当两个红外超声分体测距接收模块测出到被追踪物体的距离X＝Y时，平衡小车追踪行走。当距离X不等于Y时，通过调整平衡小车的方向和速度来改变自跟随小车的运动角度实现自动跟随功能。步骤3中，所述TB6612FNG型电机驱动模块的STBY口接主控STM32F103RBT6的I/O口清零电机全部停止；置1通过AIN1、AIN2、BIN1、BIN2来控制正反转。本专利技术提供了一种基于嵌入式控制器的自动跟随平衡小车系统，该系统具有自动测距装置，通过卡尔曼滤波优化算法对陀螺仪和加速度计数据进行融合，并以最优姿态角和小车速度为反馈量构成平衡和速度的双闭环控制，再利用模糊PID控制算法实现小车系统的自平衡控制，能够根据自动测距装置获取前方物体和自平衡小车之间的距离，实现自主追踪。本专利技术一种自跟随平衡小车的控制系统及方法的有益效果是，在传统的小车控制基础之上，增加了对驱动装置的优化，以及对交互机制的改良，运用全新的控制方法，提高了基于嵌入式控制器的自动跟随平衡小车系统的整体性能，使平衡小车具有耗时短、稳定性及抗干扰能力强、功耗低等特点。附图说明图1为按照本专利技术一种自跟随平衡小车的控制系统结构示意图；图2为按照本专利技术一种自跟随平衡小车的控制方法原理图；图3为按照本专利技术一种自跟随平衡小车的控制方法自平衡控制的原理图；图4为按照本专利技术一种自跟随平衡小车的控制方法测距追踪的示意图。具体实施方式下面结合附图和具体实施方式对本专利技术进行详细说明。一种自跟随平衡小车的控制系统，包括主控装置和自动跟随装置，主控装置和自动跟随装置之间通过红外超声测距接收和发送装置实现信息交互；主控装置采用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轴传感器回传数据进行优化处理；步骤3：通过PID控制算法处理步骤本文档来自技高网...

【技术保护点】
1.一种自跟随平衡小车的控制系统，其特征在于，包括主控装置和自动跟随装置，主控装置和自动跟随装置之间通过红外超声测距接收和发送装置实现信息交互；主控装置采用STM32F103RBT6主控板，STM32F103RBT6主控板连接有小车姿态获取装置，小车姿态获取装置包括传感器模块，STM32F103RBT6主控板连接有红外超声分体测距发送装置、小车姿态获取装置、测速装置、电机驱动装置连接，STM32F103RBT6主控板通过设置与调试模块连接上位机；自动跟随装置包括红外超声分体测距接收装置。

【技术特征摘要】
1.一种自跟随平衡小车的控制系统，其特征在于，包括主控装置和自动跟随装置，主控装置和自动跟随装置之间通过红外超声测距接收和发送装置实现信息交互；主控装置采用STM32F103RBT6主控板，STM32F103RBT6主控板连接有小车姿态获取装置，小车姿态获取装置包括传感器模块，STM32F103RBT6主控板连接有红外超声分体测距发送装置、小车姿态获取装置、测速装置、电机驱动装置连接，STM32F103RBT6主控板通过设置与调试模块连接上位机；自动跟随装置包括红外超声分体测距接收装置。2.根据权利要求1所述的一种自跟随平衡小车的控制系统，其特征在于，所述红外超声分体测距接收装置设置有2个，分别安装在平衡小车的两端。3.根据权利要求1所述的一种自跟随平衡小车的控制系统，其特征在于，所述电源装置通过稳压模块为主控装置、电机驱动装置供电，小车姿态获取装置采用5V供电，STM32F103RBT6主控板采用3.3V供电。4.根据权利要求1所述的一种自跟随平衡小车的控制系统，其特征在于，所述传感器模块采用带串口MPU6050型6轴传感器模块；所述带串口MPU6050型6轴传感器模块Rx接收端接PA9；Tx发送端接PA10；VCC接5V电源；GNG接电源的GND。5.根据权利要求1所述的一种自跟随平衡小车的控制系统，其特征在于，所述电机驱动装置采用TB6612FNG型电机驱动模块，VM接12V以内电源；VCC接5V电源；GND接电源负极；驱动1路PWMA接STM32F103RBT6的PA8口；A01、AO2接电机1的两个引脚；驱动2路PWMB接STM32F103RBT6的PA11口；B01、BO2接电机2的两个引脚。6.根据权利要求1所述的一种自跟随平衡...

【专利技术属性】
技术研发人员：刘成涛，李显鹏，李彦斌，王震，幸逍，王山林，
申请(专利权)人：西安工程大学，
类型：发明
国别省市：陕西,61