CN105807689A - 一种两轮自平衡车控制系统 - Google Patents

Abstract

本发明公开了一种两轮自平衡车控制系统，所述系统的参数调试的采用无线通信方式，通过滑阻改变参数值的大小进行实时参数传输和调试，对其中PID控制的PD参数进行调节改变，通过编程的方式将之前写好的无线控制程序烧录到单片机内部，无线传输模块分为发送机A和接收机B，发送机A上与两个滑动变阻器相连，每当滑阻值在人为的不停的有规律的变化时，发送机A此时就将每一个滑阻值传输给接收机B，同样在接收机B中将这个接收的值放入对应的算法中去运算，此时可以看到智能平衡车的摇摆情况再去调整发送机A上要传输的值的大小，人为的进行反馈调节。

Description

一种两轮自平衡车控制系统

技术领域

本发明属于便携代步工具技术领域，特别涉及一种两轮自平衡车控制系统。

背景技术

两轮自平衡小车也可以作为一种崭新的，便携的交通工具，由于两轮车采用电力驱动，且体积小，驾驶操作灵活方便，不仅占用空间更小，方便实用，对于短途出行是一种很好的选择，具有实用价值。然而，现有技术中，两轮自平衡小车的在参数调试上非常不方便，影响了市场推广。

发明内容

本发明提供一种两轮自平衡车控制系统，以解决现有系统参数调试不方便的问题。

本发明的技术方案是，一种两轮自平衡车控制系统，包括MCU，以及MCU连接的通过电源驱动模块连接的电源模块、电机驱动模块，电机编码器模块，姿态检测模块、无线控制模块和OLED显示模块，

所述系统的参数调试的采用无线通信方式，通过滑阻改变参数值的大小进行实时参数传输和调试，对其中PID控制的PD参数进行调节改变，具体过程是：

通过编程的方式将之前写好的无线控制程序烧录到单片机内部，无线传输模块分为发送机A和接收机B，发送机A上与两个滑动变阻器相连，每当滑阻值在人为的不停的有规律的变化时，发送机A此时就将每一个滑阻值传输给接收机B，同样在接收机B中将这个接收的值放入对应的算法中去运算，此时可以看到智能平衡车的摇摆情况再去调整发送机A上要传输的值的大小，人为的进行反馈调节。

PD参数调整时，采取如下方法：

比例参数相当于两轮自平衡车倒下的回复力，该参数要大于重力加速度所产生的效果才能够使得两轮自平衡车保持直立，当逐步增大比例参数时，两轮自平衡车开始能够保持直立，进一步加大时，两轮自平衡车开始出现来回摆动现象；微分参数相当于阻尼力，它可以有效抑制车模的摆动。由于车模本身不是一个刚体，车体具有一定的共振频率，因此当参数过大时会引起车模本身的震动。

调节比例参数P、微分参数D这两个参数时遵循先比例后微分的顺序，先调整比例参数使得两轮自平衡车能够保持直立并且开始来回摆动，然后逐步增加微分参数，两轮自平衡车逐步直立稳定，进一步增大微分参数直到两轮自平衡车开始共振，至此确定微分参数的最大值；

适当减小微分参数，然后逐步增大比例参数，直到两轮自平衡车又开始震荡，至此确定比例参数的最大值，在这些参数附近进行多次试验，直到得出一组最优参数为止。

电源模块采用12v的3600mhA可充电镍氢电池，

电机驱动模块采用TB6612FNG驱动器件，

电机编码器模块采用工作电压为12V，最大转速1000转/分的增量式编码器，该编码器作为两轮自平衡车的速度传感器，

姿态检测模块采用整合了3轴陀螺仪和3轴加速度计的6轴运动处理组件MPU6050，

无线控制模块采用单芯片无线收发芯片nRF24L01，

MCU采用STC12C5A60S2系列单片机。

本发明区别于其他的传统方法主要是快捷，方便，而不是每次将参数改变后再进行程序烧录，省去了很多不必要的烧录时间大大节省了人力物力，提高了芯片的使用寿命。

附图说明

图1是本发明实施例的电路组成示意图。

图2是本发明实施例中单片机与无线模块连接图。

图3是本发明实施例中OLED与单片机连接图。

具体实施方式

本发明对两轮平衡车的硬件结构和软件算法均进行了设计，优化现有的两轮平衡车。两轮车整体设计图如图1所示。

其硬件结构分为电源模块，电机驱动模块，电机和编码器模块，姿态检测模块MPU6050，无线控制模块，单片机微控制器，OLED显示模块。

(1)电源模块：采用12v，3600mhA大容量可充电镍氢电池，以保证供电的充足，电源转化模块可以提供不同电压的转化12V电压提供给电机，3.3V供给mpu6050，5V电压提供给主芯片供电。

(2)电机驱动模块：设计中使用的TB6612FNG是一款新型驱动器件，能独立双向控制2个直流电机，它具有很高的集成度，同时能提供足够的输出能力，运行性能和能耗方面也具有优势，因此在集成化、小型化的电机控制系统中，它可以作为理想的电机驱动器件。TB6612FNG是东芝半导体公司生产的一款直流电机驱动器件，它具有大电流MOSFET-H桥结构，双通道电路输出，可同时驱动2个电机。TB6612FNG每通道输出最高1.2A的连续驱动电流，启动峰值电流达2A/3.2A(连续脉冲/单脉冲)；4种电机控制模式：正转/反转/制动/停止；PWM支持频率高达100kHz；待机状态；片内低压检测电路与热停机保护电路；工作温度：-20～85℃；SSOP24小型贴片封装。

(3)电机和编码器模块：工作电压为12V，最大转速1000转每分。选择增量式编码器作为两轮平衡小车的速度传感器，这款编码器可以提供两相输出，体积小，质量轻，线数多，能够满足实际需求，另外选用齿数较少的传动齿轮，能够有效的提高光电编码器与电机的转速相比，使相同的速度下采到的脉冲更多，这就提高了速度反馈的精度。增量式光电编码器的每一个输出信号对应一个位移增量，但它不能通过其输出脉冲来区别增量具体的位置。它可以产生和位移增量值相等的脉冲信号，其作用是可以提供对连续的位移量增量化或离散化及位移变化的一种传感方法，是相对某个基准点相对的位置增量，不能直接测出其轴的绝对位置；此光电编码器的输出相和相相差。脉冲信号，可方便的判断出来旋转的方向，作为参考零位相标志的脉冲信号，码盘旋转一周，就发出相应的一个标志脉冲信号。其中标志脉冲通常指示对积累量清零或机械位置。此编码器主要是由码盘、光源、检测光栅光、电检测器件和转换电路构成。

(4)姿态检测模块MPU6050：该模块为全球首例整合了6轴运动处理组件，整合了3轴陀螺仪，3轴加速度计，相较于多组件方案，不仅免除了组合陀螺仪和加速度计数据时所存在的时差问题，而且减少了大量的包装空间缩小了整个套件的尺寸。其其角速度全格感测范围为正负250，正负500，正负2000，可以通过编程进行选择，以准确追踪快速与慢速动作；并且用户可以在正负2g，正负4g，正负16g之间选择加速度值测量范围。角度、角速度计算和角度控制是自平衡控制算法中的重点部分，良好的角度控制算法产生稳定的平衡控制效果，角度、角速度的计算将根据传感器的外围电路信号的放大及信号滤波等来确定相关角度和角速度换算。角度控制采用经典PID控制。

(5)无线传输模块：nRF24L01是由Nordic公司出品的单芯片无线收发芯片，工作于2.4GHz～2.5GHz的频率，芯片内置频率合成器、功率放大器、晶体振荡器和调制器等功能模块，输出功率和通信频道可通过程序进行配置。发射功率和工作频率等工作参数可以很容易的通过6线I2C端口与单片机设定的端口所连接。本设计中无线模块包括连接在发送单片机的发送模块A，连接在接收单片机的接收模块B。

(6)单片机微处理模块：STC12C5A60S2系列单片机是宏晶科技生产的单时钟周期的单片机，是高速，低功耗，超强抗干扰的新一代8051单片机，指令代码完全兼容传统8051,但速度快8-12倍。内部集成MAX810专用复位电路,2路PWM,8路高速10位A/D转换,针对电机控制，强干扰场合。STC12C5A60S2单片机内部就自带高达60KFLASHROM,这种工艺的存储器用户可以用电的方式瞬间擦除、改写。而且STC系列单片机支持串口程序烧写。显而易见，这种单片机对开发设备的要求很低，开发时间也大大缩短。写入单片机内的程序还可以进行加密，这又很好地保护了你的劳动成果。本设计采用两个STC12系列单片机一个作为发送PD值的发送机，另一个作为算法处理和中断搭载的接收机。单片机与无线模块连接图如图2所示。

现有技术中，智能平衡车装置，调试参数都非常麻烦，每次改变一次参数值都需要进行烧录，对时间和精力的浪费太大，且对单片机的反复可擦除性要求较高。关于两轮平衡车的调试方法改进基于STC12芯片的调节，本车主要对其参数调试的过程进行修改的，方法是采用无线通讯方式，通过滑阻改变参数值的大小进行实时参数传输和调试，主要针对参数PID中的PD进行调节改变。

具体实施方法主要是通过编程的方式将之前写好的无线控制程序烧录到单片机内部，无线传输模块分为发送机A和接收机B，发送机A上与两个50K的滑动变阻器相连(发送Kp和Kd值前文中提到的)，每当滑阻值在人为的不停的有规律的变化时，发送机A此时就将每一个滑阻值传输给接收机B，同样在B中将这个接收的值放入对应的算法中去运算。此时可以看到智能平衡车的摇摆情况再去调整发送机A上要传输的值的大小，人为的进行反馈调节。

PD参数调整时，应当采取如下方法：

比例参数相当于车模倒下的回复力，这个参数要大于重力加速度所产生的效果才能够使得车模保持直立，当逐步增大比例参数时，车模开始能够保持直立，进一步加大时，车模开始出现来回摆动现象。微分参数相当于阻尼力，它可以有效抑制车模的摆动。由于车模本身不是一个刚体，车体具有一定的共振频率，因此当参数过大时会引起车模本身的震动。调节这两个参数时遵循先比例后微分的顺序。先调整比例参数使得车模能够保持直立并且开始来回摆动，然后逐步增加微分参数，车模逐步直立稳定，进一步增大微分参数直到车模开始共振，至此确定微分参数的最大值。然后适当减小微分参数，然后逐步增大比例参数，直到车模又开始震荡，至此确定比例参数的最大值，在这些参数附近进行多次试验，直到得出一组最优参数为止。本方法区别于其他的传统方法主要是快捷，方便，而不是每次将参数改变后再进行程序烧录，省去了很多不必要的烧录时间大大节省了人力物力，提高了芯片的使用寿命。

(7)OLED显示模块：OLED，即有机发光二极管。模块分辨率是128x64，内置了升压电路(OLED点亮显示8～14V的高压)和复位电路，所以只要3～5V电源输入电压即可。采用I2C或SPI总线通过，电路连接简洁。小体积带来小的功耗，只要3mA左右的电流就能让它显示内容，耗能非常小。MCU的控制方式如下：控制方式是OLED显示控制器与单片机系统中的某个并行I/O接口衔接，单片机通过对该I/O接口的操作间接地实现对OLED显示控制器的控制。这种控制方式在硬件电路上系统需要一个8位并行接口与OLED显示控制器的数据线连接，作为数据总线，还需要一个3位并行接口作为时序控制信号线RD，WR，RS或E，R/W，RS。这种控制方式的接口电路与时序无关。再有由于并行接口是专用于OLED显示控制器的接口，而且该并行接口自身在单片机系统中有相应的片选地址，所以OLED显示控制器的片选信号可以直接接地作选通态。电路连接如图3所示。

Claims (3)

1.一种两轮自平衡车控制系统，其特征在于，包括MCU，以及MCU连接的通过电源驱动模块连接的电源模块、电机驱动模块，电机编码器模块，姿态检测模块、无线控制模块和OLED显示模块，

所述系统的参数调试的采用无线通信方式，通过滑阻改变参数值的大小进行实时参数传输和调试，对其中PID控制的PD参数进行调节改变，具体过程是：

通过编程的方式将之前写好的无线控制程序烧录到单片机内部，无线传输模块分为发送机A和接收机B，发送机A上与两个滑动变阻器相连，每当滑阻值在人为的不停的有规律的变化时，发送机A此时就将每一个滑阻值传输给接收机B，同样在接收机B中将这个接收的值放入对应的算法中去运算，此时可以看到智能平衡车的摇摆情况再去调整发送机A上要传输的值的大小，人为的进行反馈调节。

2.如权利要求1所述的两轮自平衡车控制系统，其特征在于，PD参数调整时，采取如下方法：

比例参数相当于两轮自平衡车倒下的回复力，该参数要大于重力加速度所产生的效果才能够使得两轮自平衡车保持直立，当逐步增大比例参数时，两轮自平衡车开始能够保持直立，进一步加大时，两轮自平衡车开始出现来回摆动现象；微分参数相当于阻尼力，调节微分参数用于抑制车模的摆动；

调节比例参数P、微分参数D这两个参数时遵循先比例后微分的顺序，先调整比例参数使得两轮自平衡车能够保持直立并且开始来回摆动，然后逐步增加微分参数，两轮自平衡车逐步直立稳定，进一步增大微分参数直到两轮自平衡车开始共振，至此确定微分参数的最大值；

适当减小微分参数，然后逐步增大比例参数，直到两轮自平衡车又开始震荡，至此确定比例参数的最大值，在这些参数附近进行多次试验，直到得出一组最优参数为止。

3.如权利要求1所述的两轮自平衡车控制系统，其特征在于，

电源模块采用12v的3600mhA可充电镍氢电池，

电机驱动模块采用TB6612FNG驱动器件，

电机编码器模块采用工作电压为12V，最大转速1000转/分的增量式编码器，该编码器作为两轮自平衡车的速度传感器，

姿态检测模块采用整合了3轴陀螺仪和3轴加速度计的6轴运动处理组件MPU6050，

无线控制模块采用单芯片无线收发芯片nRF24L01，

MCU采用STC12C5A60S2系列单片机。