1. int Incremental_PI (int Encoder,int Target) //增量式PI算法控制速度闭环
    2. { //Encoder是编码器经过限幅后的速度,Target是目标速度
    3. float Kp=20,Ki=30; //参数不知道
    4. static int Bias,Pwm,Last_bias; //需要static,而且默认初始值为0
    5. Bias=Encoder-Target; //求出速度偏差,由测量值减去目标值。
    6. Pwm+=Kp*(Bias-Last_bias)+Ki*Bias; //使用增量 PI 控制器求出电机 PWM。
    7. Last_bias=Bias; //保存上一次偏差
    8. return Pwm; //增量输出
    9. }

    这是没用数组的