PID学习

参考:
Python代码实现PID控制

import matplotlib.pyplot as plt


class Pid():
  def __init__(self, exp_val, kp, ki, kd):
        self.KP = kp
        self.KI = ki
        self.KD = kd
        self.exp_val = exp_val
        self.now_val = 0
        self.sum_err = 0
        self.now_err = 0
        self.last_err = 0

  def cmd_pid(self):
        self.last_err = self.now_err
        self.now_err = self.exp_val - self.now_val
        self.sum_err += self.now_err
        # 这一块是严格按照公式来写的
        self.now_val = self.KP * (self.exp_val - self.now_val) \
                        + self.KI * self.sum_err + self.KD * (self.now_err - self.last_err)
                        
        print (self.last_err,self.now_err)
        return self.now_val


pid_val = []
#对pid进行初始化,目标值是1000 ,p=0.1 ,i=0.15, d=0.1
my_Pid = Pid(1000, 0.2, 0.2, 0.2)
# 然后循环100次把数存进数组中去
for i in range(0, 100):
    pid_val.append(my_Pid.cmd_pid())
plt.plot(pid_val)
plt.show()

评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

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

余额充值