【平衡小车制作】(一)硬件原理图讲解(超详解)

  大家好,我是小政。之后的一系列文章我将介绍我玩平衡小车的过程以及遇到的一些问题,将这些内容记录下来分享给大家,也让大家少走一些弯路。接下来我将从硬件框架选择、软件编程、PID算法、PID调参、蓝牙遥控这五个部分向大家讲解平衡小车的制作过程。
  本系列平衡小车文章适合于刚刚学习STM32但感觉没有玩透,想找个项目练练手,那么平衡小车绝对适合你。同时也适合于对于平衡小车感兴趣但编程和硬件基础较差,没有关系,跟随小政将让你轻松学会制作一个属于自己的平衡小车。
  第一篇文章我会首先介绍平衡小车的硬件组成,对硬件原理图进行详解。

一、硬件结构

1. 主控板:主控芯片(STM32F103C8T6)+电机驱动芯片(TB6612FNG),利用AD20画的PCB并进行打板。
2. 小车框架:平衡车底盘、电机、轮子(某宝有售)
3. 电池:狮子航模电池2200mAh11.1V35C,T母头
4. DC-DC降压模块:MP1584EN,3A可调降压稳压电源模块
5. 陀螺仪:MPU6050,检测倾斜角度
6. OLED:4线I2C OLED显示屏
7. 超声波模块:HC-SR04
8. 蓝牙:HC-05

二、硬件原理图

  硬件原理图我利用Altium Designer 20画的,并进行了PCB打板。想要获取原理图的小伙伴可以去我的百度网盘下载。
网址:https://pan.baidu.com/s/12LstSbIAEuiyO8rI9XfSFg
提取码:rddh
在这里插入图片描述

图1 平衡小车硬件原理图

  上图中的串口电路存在问题,各位参考下图的串口电路:
在这里插入图片描述

在这里插入图片描述

图2 平衡小车3D视图PCB

三、硬件框架讲解

(1)STM32F103C8T6

主控芯片及周围电路结构如下:
1)STM32F103C8T6(48脚芯片)
2)8M晶振(STM32内部倍频至72MHz,产生供系统正常工作的稳定的脉冲信号),
3)复位电路(RST)
4)启动模式选择电路(BOOT0和BOOT1)
5)去耦电容(3.3V与GND之间加几个104电容)
6)烧写电路(SW)
在这里插入图片描述

图3 主控芯片及周围电路

(2)电源电路

   电源采用11.1V锂电池供电,通过DC-DC降压模块获取5V电压,在通过AMS1117降至3.3V。图中电解电容主要目的是滤低频纹波,瓷片电容主要目的是抑制高频噪声,需靠近管脚。
在这里插入图片描述

图4 DC-DC降压模块

在这里插入图片描述

图5 AMS1117转3.3V

(3)编码器

作用:实时检测电机速度
编码器1——PA0/PA1——TIM2
编码器2——PB6/PB7——TIM4
在这里插入图片描述

图6 编码器引脚(TIM2,TIM4)

(4)电机驱动芯片TB6612FNG

作用:驱动电机正常运行
PWM1——PA8
PWM2——PA11
电机1——PB12/PB13
电机2——PB14/PB15
在这里插入图片描述

图7 TB6612FNG(TIM3)

(5)陀螺仪MPU6050

作用:检测倾斜角
MPU6050中断引脚——PB5
MPU6050所用I2C——PB3/PB4
在这里插入图片描述

图8 陀螺仪MPU6050(I2C)

四、实物展示

在这里插入图片描述

图9 平衡小车实物图

在这里插入图片描述

图10 平衡小车实物图

在这里插入图片描述

图11 平衡小车实物图

  以上就是硬件结构的讲解,接下来的文章将对软件的编程和算法设计进行详解。平衡小车系列文章作者在持续更新中。文章中出现错误或者小伙伴对以上内容有所疑问,欢迎大家在评论区留言,小政看到后会尽快回复大家!
【平衡小车制作】(二)电机驱动(超详解)https://blog.csdn.net/weixin_44270218/article/details/113276624

  • 188
    点赞
  • 1338
    收藏
    觉得还不错? 一键收藏
  • 打赏
    打赏
  • 57
    评论
一、平衡小车原理: 自平衡小车是利用车模自身动力使小车保持相对的平衡,是一个动态平衡的过程。维持车模平衡的动力来自车轮的运动,由两个直流电机驱动。对车模的控制可以分解为三个控制任务: 1、控制小车平衡:通过控制小车车轮正反转使小车保持直立平衡。 2、控制小车速度:通过控制小车的倾角实现小车前后运动和速度的控制,其实最终的仍是通过控制电机的转速实现。 3、控制小车方向:通过控制小车两个电机之间的转速差来实现转向控制。 分解为三个控制任务显得相对简单一点,但是在最终的控制过程中都归结为对一个控制量的控制,这样三个任务之间就会存在耦合,会相互干扰。三个任务中控制平衡是关键,所以对小车的速度和方向控制应该尽量的平滑。 二、硬件方案设计 小车的硬件分为三个部分,分别是主控部分、小车姿态获取部分以及电机驱动部分。主控板采用目前常用的arduino UNO,同时也可以使用其他arduino通用控制板做主控。 小车姿态获取可以有很多方案,使用最多的就是通过加速度计和陀螺仪获取小车姿态。理论上只需要两轴加速度计(垂直方向Z轴和沿小车运动方向X轴)和一个单轴陀螺仪(沿小车车轮轴方向,获取绕小车轮轴的角速度)。陀螺仪通过角度积分可以获得小车角度,但是经过积分会产生累计误差,并且会越来越大,X轴与Z轴加速度计的值也可以算出小车的倾角,但是加速度计的瞬时误差较大,所以结合陀螺仪和加速度计两者获得的角度做数据融合可得真实角度。我们使用一个集成了三轴加速度计和三轴陀螺仪的集成芯片MPU6050,这样极大的简化了我们的传感器电路。 小车通过两个直流电机驱动车轮运动来获得动力,直流电机的驱动电路设计关系到整个系统的稳定性,因为电机反转时会产生反向电动势会干扰到电源系统内其他设备的运行。我们选用L298P做电机驱动器,它内部包含4通道逻辑驱动电路,可同时驱动两个直流电机,输出电流可达2.5A。 三、软件设计之小车姿态获取---卡尔曼滤波 在开始之前应该对MPU6050进行设置,主要设置角速度以及加速度的量程,加速度量程有±2g、±4g±8g与±16g,角速度量程分别为±250、±500、±1000与±2000°/sec (dps),可准确的追踪快速动作与慢速动作。在使用之前先设置好量程以便后面的换算。我们小车轮轴与传感器Y轴平行,即绕Y轴旋转则有: 那竖直方向弧度计算公式为: angle = atan2(x, z) //结果以弧度表示并介于 -pi 到 pi 之间(不包括 -pi) 如果要换算成具体角度: angle = atan2(x, z) *(180/3.14) 陀螺仪获取角速度积分得到角度公式为:anglen = anglen-1 + gyronn*dt ,式中anglen 为第N次采样的角度值,anglen-1 为第N-1次的角度值,gyronn为两次采样值之间的角速度值,dt为两次采样之间的时间。然后将换算后的两个角度数据进行卡尔曼滤波融合,可获得小车真实角度,也可以采用更简单的互补滤波算法。 注意加速度计所得角度与陀螺仪积分角度的方向。 四、软件设计之小车姿态调整---PID参数整定 小车的姿态获取最终结果是一个角度,就是小车偏离平衡位置的倾角。通过以小车的这个倾角为变量进行PID控制,输出用于控制车轮转速的PWM值,那么相当于小车只有一个角度反馈环路,虽然能使小车平衡,但是增加了控制难度,所以通常会使用带测速的电机,再加入一个小车速度反馈环路,这样使得小车更容易控制。关于PID的有下面一个简单易懂的描述: 假设我们想把一个小球稳定在一个光滑的坡顶,这显然是一个不平衡的系统,稍有扰动小球就会滚下来。假设恰好平衡的位置坐标是L,我们可以测量到小球的位置是x,那么怎么给小球施加f(x)的力反馈,让它能够平衡呢? 最直观的想法就是f(x) =Kp*(L-x),简单的说就是你在左边我就向右推,你在右边我就向左推,这就是比例因子P; 现在考虑两种情况,同样是在x位置,小球静止和小球具有速度V这两种情况。很明显,如果V>0,我们只需要施加更小的力,因为小球自身的惯性会让它运动向平衡位置。所以可以修正f(x) = Kp*(L-x) – Kd*V。因为速度一般不容易测量,我们常常用位置的变化Δx除以测量的时间差Δt来计算速度,所以这就是微分因子D; 情况继续发生变化,上面考虑的是斜坡静止的情况,如果这个变态的斜坡是移动的怎么办呢?(例如两轮平衡机器人实际上是可以运动的,对于静止的磁悬浮来说,不需要考虑这个参数)这时候我们需要不断的累加并平均x值,来计算平衡位置的L,这个就是积分因子I; 当PID用在我们自平衡小车中时,我们使用角度PD环与速度PI环进行控制。 pwm=angle*k1+angle_dot*k2+range*k3+wheel_speed*k4; PID参数整定步奏如下: 1、将k1,k2,k3,k4均设为0; 2、逐步增大k1,使得小车刚好能够来回摆动。 3、再逐步增大k2,使得小车相对平稳,太大会使小车发生抖动; 4、增大k3,使得小车能够来回走动(不是摆动也不是抖动); 5、增大k4,使得小车能稳定自平衡。 具体参数调整过程比较繁琐,需要自己体会每个参数的作用。

“相关推荐”对你有帮助么?

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论 57
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包

打赏作者

鲁乎乎

你的鼓励将是我创作的最大动力

¥1 ¥2 ¥4 ¥6 ¥10 ¥20
扫码支付:¥1
获取中
扫码支付

您的余额不足,请更换扫码支付或充值

打赏作者

实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值