电机PID调试
电机PID调试
一、直流电机原理与TB6612
1.1 电机原理
1.2 减速器作用
如上：
假设电机本身
电机转速：10000rpm（每分钟转10000转）
关节扭矩：1kg；
那么如果加入减速器（减速比为20）：
则电机输出就会变为：
电机转速：500rpm
关节扭矩：16kg（实际上会有损耗，我们这里设定为 80% ）
显然，减速器起到两个作用：
1.降低电机转速；
2.增加电机扭矩；
1.3 电机实物接线图
只需要电机正负加载电压后就可以实现电机转动。
1.4 电机控制芯片
电机控制芯片：TB6612
通常我们使用单片机来给电机调速，但是由于单片机IO口输出的带负载能力是比较弱的，所以一般会通过电机功率放大器件去增大电压；
常用的驱动芯片：
L298N电机驱动板模块。
控制芯片的接线：
VM：直流电机相近的电压，例如电机需要接12v电压时候，可以通过一个3s电池进行相连；
VCC，GND：内部逻辑电压；
STBY：是IO口使能端，高电平有效；
红框，篮框：是两路独立电机控制端；
| 接口 | Value |
|---|---|
| AO1 | 接电机正负极，反接只影响电机的正反转 |
| AO2 | 对应AO1 |
| PWMA | 控制PWM波，实现0-100%的占空比控制 |
| AIN1 | 正反转控制 |
| AIN2 | 对应AIN1 |
二、编码器使用以及测速原理
2.1 编码器原理
一般装两组霍尔或者光电，会得到AB两相脉冲信号；
根据单位时间的脉冲个数可以得到速度；根据相位差可以对方向进行判断；
2.1 编码器接线
红线，接电源一般是5v；
2.1 编码器软件四倍
四倍频主要是测量AB相的上升和下降沿（就是所有跳变个数 ）；
原来单个脉冲的上升沿个数只有3个，现在所有跳变相加为12个；相当于四倍频；
stm32在编码器模式下，其TIM1-TIM4的通道1（CH1），通道2（CH2）都可以进行硬件四倍频计数，在配置一下相关寄存器；
但是有些低端单片机，如51等，没有硬件计数，只能通过软件计数（中断等）；
三、离散化PID入门
用离散化的差分方程代替连续的微分方程。
四、位置PID控制基础
4.1 原理分析
位置闭环控制就是根据编码器的脉冲累加测量电的位置信息,并与目标值进行比较,得到控制偏差,然后通过对偏差的比例、积分、微分进行控制,使偏差趋向于零的过程
4.1 控制原理图
反馈值（测量值）- 设定值（目标值）= 控制偏差；
控制偏差给到控制器；
从而将偏差给到电机，在经过编码器获得反馈；
实现闭环；