基本信息

---

下载

   友情提示：（无需注册或充值，赞助后即可获取资源下载链接）

---

     嘿，亲！知识可是无价之宝呢，但咱这精心整理的资料也耗费了不少心血呀。小小地破费一下，绝对物超所值哦！如有下载和支付问题，请联系我们QQ(微信同号)：813200300

本次赞助数额为： 1 元　

支付宝支付

微信支付

   源码介绍

---

树莓派RP2040开发板，智能小车速度PID控制程序

硬件：树莓派 pico开发板，或微雪rp2040-pico-zero开发板，或esp8266，esp32（需要修改引脚）

智能小车底盘

功放模块

软件平台：micro python固件，thonny

#代码中self.target_speed=[30,30] 是目标速度

            
    def callback_recordtime(self,s):
        self.timecunt_oldold[0]=self.timecunt_old[0]      
        self.timecunt_old[0]=self.timecunt
        print("speed:",self.speed)
    def callback_recordtime2(self,s):
        self.timecunt_oldold[1]=self.timecunt_old[1]     
        self.timecunt_old[1]=self.timecunt
        print("speed:",self.speed)
        
    def cmt_speed(self):
        for i in range(2):
            t1=self.timecunt_old[i]-self.timecunt_oldold[i]
            t2=self.timecunt-self.timecunt_old[i]
            timecost=max(t1,t2)
            if timecost<1:
                timecost=1               
            self.speed[i]=1000/timecost
            if timecost>1000:
                self.speed[i]=0
            if self.timecunt_oldold[i]<1:
                self.speed[i]=0
    
    def cmt_current(self):
        out=[0,0]
        for i in range(2):
            self.speed_error[i]=(self.target_speed[i]- self.speed[i])
            self.speed_error_I[i]=self.speed_error_I[i] self.speed_error[i]
            self.speed_error_D[i]=self.speed_error[i]-self.speed_error_old[i]
            
            pout=self.kp*self.speed_error[i]
            iout=self.ki*self.speed_error_I[i]
            dout=self.kd*self.speed_error_D[i]
            
            self.speed_error_old[i]=self.speed_error[i]
            
            out[i]=pout iout dout
        self.pwm1.duty_u16(int(out[0])) 
        self.pwm2.duty_u16(int(out[1])) 
    def showRGBLED(self):
        vR=int(self.brightness self.brightness*sin(0.01*self.timecunt))
        vG=int(self.brightness self.brightness*sin(0.01*self.timecunt 2.0944))
        vB=int(self.brightness self.brightness*sin(0.01*self.timecunt 2.0944 2.0944))
        self.np.set_pixel(0,vR,vG,vB)
        self.np.show()