找回密码
 立即注册

QQ登录

只需一步,快速开始

搜索
查看: 8304|回复: 1
打印 上一主题 下一主题
收起左侧

PID算法实现小车循迹

[复制链接]
跳转到指定楼层
楼主
ID:367418 发表于 2018-7-8 20:04 | 只看该作者 回帖奖励 |倒序浏览 |阅读模式
typedef struct PIDValue
{
   int8 KP;
   int8 KI;
   int8 KD;
   int8 F;
   int8 BITMOV;
   int EK[3];

   int UK;函数出口
   int RK;设定值
   int CK;实际值
   int UK_REAL;

}pid_str;
//PIDValueStr? PID;
void??? pid_exe(pid_str *PID)? ;
#endif
?
//pid.c
/*PID = PID->UK_REAL + PID->KP*[E(k)-E(k-1)]+PID->KI*E(k)+PID->KD*[E(k)-2E(k-1)+E(k-2)];(增量型PID算式)
函数入口: PID->RK(设定值),PID->CK(实际值),PID->KP,PID->KI,PID->KD
函数出口: U(K)*/
#include"defines.h"
#include"pid.h"
#define MAXOUT 0xff
//#define MAXGAP 100
?
void pid_exe(pid_str*PID)
{
    PID->EK[2]=PID->EK[1];
    PID->EK[1]=PID->EK[0];
    PID->EK[0]=PID->RK-PID->CK;
    PID->UK_REAL=PID->UK_REAL
        +PID->KP*(PID->EK[0]-PID->EK[1])//微分一次后积分即原数
        +(float)PID->KI*PID->EK[0]/PID->F//直接积分
        +(float)PID->KD*(PID->EK[0]-2*PID->EK[1]+PID->EK[2])*PID->F;//二阶微分后积分即一阶微分
   if((PID->UK_REAL>>PID->BITMOV)>=MAXOUT)
   {
   PID->UK=MAXOUT;
   }else if(PID->UK_REAL>>PID->BITMOV<=-MAXOUT)
   {
    PID->UK=-MAXOUT;
    }else
    {
     PID->UK=PID->UK_REAL>>PID->BITMOV;
    }
   
}
分享到:  QQ好友和群QQ好友和群 QQ空间QQ空间 腾讯微博腾讯微博 腾讯朋友腾讯朋友
收藏收藏1 分享淘帖 顶 踩
回复

使用道具 举报

沙发
ID:226204 发表于 2018-10-23 16:24 | 只看该作者
想请问一下你的实际值是怎么来的? 传感器用的什么?
回复

使用道具 举报

您需要登录后才可以回帖 登录 | 立即注册

本版积分规则

手机版|小黑屋|51黑电子论坛 |51黑电子论坛6群 QQ 管理员QQ:125739409;技术交流QQ群281945664

Powered by 单片机教程网

快速回复 返回顶部 返回列表