双轮自平衡小车的控制系统的制作方法

文档序号:13803999阅读:113来源:国知局

本发明属于平衡车技术领域,具体涉及一种双轮自平衡小车的控制系统。



背景技术:

双轮自平衡小车是双轮机器人研究的基础,具有多变量、非线性、强耦合等特性。双轮自平衡小车因其结构简单、转向灵活等特点,能在狭窄空间中行驶,以及在特殊环境下执行特殊任务,对变化的地形适应性强,引起新一轮研究热潮和广泛的应用开发。双轮自平衡小车作为控制系统的经典模型,是验证控制理论和力学理论的理想实验平台,为科学理论的实验研究起到了硬件平台的作用,有着巨大的研究价值。

但是,现有的双轮自平衡小车的控制系统结构复杂,成本高。



技术实现要素:

针对现有技术的缺陷,本发明提供一种双轮自平衡小车的控制系统。

双轮自平衡小车的控制系统,包括微控制器、电池组、电压转化模块、人机交互模块、霍尔测速传感器、电机驱动电路、直流电机、姿态检测模块,所述电池组通过电压转化模块与微控制器相连、所述人机交互模块与微控制器相连,所述姿态检测模块与微控制器相连,所述微控制器还通过电机驱动电路与直流电机相连,所述微控制器还通过霍尔测速传感器与直流电机相连。

优选地,所述微控制器为stc15w4k32s4单片机。

优选地,所述姿态检测模块为六轴姿态传感器。

优选地,所述六轴姿态传感器为mpu6050。

优选地,所述姿态检测模块包括三轴陀螺仪和三轴加速器。

优选地,所述陀螺仪和加速器并联连接。

优选地,所述电机驱动电路中采用的电动驱动芯片为tb6612。

优选地,所述电压转化模块为lm2940-5.0。

优选地,所述人机交互模块包括显示屏和四个独立的按键。

优选地,所述显示屏为lcd1602。

电压转换电路采用lm2940-5.0,将电池组的+12v电压转成+5v,用ams1117-3.3稳压电路将+5v转成+3.3v,人机交互模块使用lcd1602和四个独立按键,实现系统调试时的参数设置和显示。

stc15w4k32s4通过引脚1、3与mpu6050进行i2c通信,采集姿态数据,引脚30~33、34、35连接电机驱动芯片tb6612,控制电机的转向和转速,通过引脚38、39捕获霍尔传感器输入脉冲;通过引脚21、2、22、4可以对霍尔传感器两相a1(a2)、b1(b2)进行外部中断触发和计数器计数。

霍尔传感器是基于霍尔效应的磁场传感器,主要由磁块和磁电检测装置组成。将磁铁粘在非磁性圆盘的边沿,靠近圆盘边沿处放置霍尔传感器,当圆盘转动时,霍尔传感器就输出脉冲,相应的计数变量就加1,在单位时间内测得的脉冲数越多代表速度越快。脉冲采集电路主要由电压比较器lm393、霍尔元件3144和磁感应探头组成,采用非接触检测方式,d6为感应指示灯,当感应到磁场时,输出低电平,信号灯d6亮,3144感应磁场的强度并输出数字信号,再由lm393转化成为脉冲。

本发明的优点:

本发明提供的控制系统,结构简单,可操作性高,能有效实现对小车整体平稳运行。

附图说明

图1本发明的结构示意图。

具体实施方式

双轮自平衡小车的控制系统,包括微控制器、电池组、电压转化模块、人机交互模块、霍尔测速传感器、电机驱动电路、直流电机、姿态检测模块,所述电池组通过电压转化模块与微控制器相连、所述人机交互模块与微控制器相连,所述姿态检测模块与微控制器相连,所述微控制器还通过电机驱动电路与直流电机相连,所述微控制器还通过霍尔测速传感器与直流电机相连。

所述微控制器为stc15w4k32s4单片机。

所述姿态检测模块为六轴姿态传感器。

所述六轴姿态传感器为mpu6050。

所述姿态检测模块包括三轴陀螺仪和三轴加速器。

所述陀螺仪和加速器并联连接。

所述电机驱动电路中采用的电动驱动芯片为tb6612。

所述电压转化模块为lm2940-5.0。

所述人机交互模块包括显示屏和四个独立的按键。

所述显示屏为lcd1602。

电压转换电路采用lm2940-5.0,将电池组的+12v电压转成+5v,用ams1117-3.3稳压电路将+5v转成+3.3v,人机交互模块使用lcd1602和四个独立按键,实现系统调试时的参数设置和显示。

stc15w4k32s4通过引脚1、3与mpu6050进行i2c通信,采集姿态数据,引脚30~33、34、35连接电机驱动芯片tb6612,控制电机的转向和转速,通过引脚38、39捕获霍尔传感器输入脉冲;通过引脚21、2、22、4可以对霍尔传感器两相a1(a2)、b1(b2)进行外部中断触发和计数器计数。

霍尔传感器是基于霍尔效应的磁场传感器,主要由磁块和磁电检测装置组成。将磁铁粘在非磁性圆盘的边沿,靠近圆盘边沿处放置霍尔传感器,当圆盘转动时,霍尔传感器就输出脉冲,相应的计数变量就加1,在单位时间内测得的脉冲数越多代表速度越快。脉冲采集电路主要由电压比较器lm393、霍尔元件3144和磁感应探头组成,采用非接触检测方式,d6为感应指示灯,当感应到磁场时,输出低电平,信号灯d6亮,3144感应磁场的强度并输出数字信号,再由lm393转化成为脉冲。



技术特征:

技术总结
本发明公开一种双轮自平衡小车的控制系统,包括微控制器、电池组、电压转化模块、人机交互模块、霍尔测速传感器、电机驱动电路、直流电机、姿态检测模块,所述电池组通过电压转化模块与微控制器相连、所述人机交互模块与微控制器相连,所述姿态检测模块与微控制器相连,所述微控制器还通过电机驱动电路与直流电机相连,所述微控制器还通过霍尔测速传感器与直流电机相连。本发明提供的控制系统,结构简单,可操作性高,能有效实现对小车整体平稳运行。

技术研发人员:郝青
受保护的技术使用者:陕西环珂生物科技有限公司
技术研发日:2017.11.24
技术公布日:2018.02.23
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1