增量式PID算法控制小车速度

首先声明一下，你的是多变量输入和输出，运用简单的单回路控衫镇野制系统估计效果不太好。

如果你确实要用PID，下面是建议：

1，直线运动，两个输出是一样的，所以公用一个函数，（若有直线纠正的话，你懂怎么办的）。由于你的电机还有传感器，小车的速度实时性不会很好，当然，要看你的控制精度了。直线行走，控制速度的设置（若要恒速的话）：首先，ID设为0，P从0开始快速加大，直到得或喊到满意的加速的（要快，因为你用的增量式本身就有I的效果）。在增量式PID里，I稍微小点没事，D的系数大概等于2I就行。若不需要恒速：PID就不必要了，直接输出占空比。

2，转弯。若是弯道直径小，转弯速度快，首先明确告诉你，不能用上面的PID输出了，这样你的小车坑定不知道漂移到哪里去了，所以另外需要一个函数控制输出。建议这样：判断要转弯了，靠弯道的轮子要快速变为速度0，另一个轮子必须快速响应，这样PID参数只有P起了主要作用，所以慢慢调P，由0增大，满意为止旅返。

另外的建议： 不用PID，用模糊控制算法，响应速度回提高很多。

希望有用、

一、什么是PID:

PID即：Proportional（比例）、Integral（积分）、Differential（微分）的缩写。顾名思义，PID控制算法是结合比例、积分和微分三种环节于一体的控制算法，它是连续系统中技术最为成熟、应用最为广泛的一种控制算法，该控制算法出现虚枣于20世纪30至40年代，适用于对被控对象模型了解不清楚的场合。 ---百度百科

二、PID是否难学：

在工业应用中PID及其衍生算法是应用最广泛的算法之一，是当之无愧的万能算法，如果能够熟练掌握PID算法的设计与实现过程，对于一般的研发人员来讲，应该是足够应对一般研发问题了，而难能可贵的是，在我所接触的控制算法当中，PID控制算法又是最简单，最能体现反馈思想的控制算法，可谓经典中的经典。经典的未必是复杂的，经典的东西常常是简单的，而且是最简单的，想想牛顿的力学三大定律吧，想想爱因斯坦的质能方程吧，何等的简单！简单的不是原始的，简单的也不是落后的，差纯拆简单到了美的程度。 ---【1】

三、PID算法的C语言源码：

PID 控制算法可以分为位置式 PID 和裤郑增量式 PID 控制算法

详细见参考【1】【2】

参考：

【1】PID算法

【2】简易PID算法的快速扫盲（超详细+过程推导+C语言程序）

PID的增量型公式：

PID=Uk+KP*【E(k)-E(k-1)】+KI*E(k)+KD*【E(k)-2E(k-1)+E(k-2)】

PID算法具体分两种：一种是位置式的 ，一种是增量式的。

位置式PID的输出与过去的所有状态有关，计算时要对e（每一次的控制误差）进行累加，这个计算量非常大，而明显没有必要。而且小车的PID控制器的输出并不是绝对数值，而是一个△，代表增多少，减多少。换句话说，通过增量PID算法，每次输出是PWM要增加多少或者减小多少，而不是PWM的实际值。所以明白增量式PID就行了。

PID控制原理：

本系统通过摆杆（辊）反馈的位置信号实现同步控制。收线控制采用实时计算的实际卷径值，通过卷径的变化修正PID前馈量，可以使整个系统准确、稳定运行。

PID系统特点：

1、主驱动电机速度可以通吵宽过电位器来控制，把S350设置为SVC开环矢量控制，将模拟输出端子FM设定为运行频率，从而给定收卷用变频器的主速度。

2、收卷用S350变频器的主速度来自放卷（主驱动）的模拟输出端口。摆杆电位器模拟量

信号通过CI通道作为PID的反馈量。S350的频率源采用主频率Ⅵ和禅樱辅助频率源PID叠加的方式。通过调整运行过程PID参数，可以获得稳定的收放卷效果。

3、本系统启用逻辑控贺碰丛制和卷径计算功能，能使系统在任意卷径下平稳启动，同时两组PID参数可确保生产全程摆杆控制效果稳定。

---