第五届飞思卡尔智能车电磁组获奖程序.docVIP

下载本文档

21
0
约9.4千字
约 15页
2017-08-10 发布于河南
举报
版权申诉

第五届飞思卡尔智能车电磁组获奖程序.doc

1、本文档共15页，可阅读全部内容。
2、原创力文档（book118）网站文档一经付费（服务费），不意味着购买了该文档的版权，仅供个人/单位学习、研究之用，不得用于商业用途，未经授权，严禁复制、发行、汇编、翻译或者网络传播等，侵权必究。
3、本站所有内容均由合作方或网友上传，本站不对文档的完整性、权威性及其观点立场正确性做任何保证或承诺！文档内容仅供研究参考，付费前请自行鉴别。如您付费，意味着您自己接受本站规则且自行承担风险，本站不退款、不进行额外附加服务；查看《如何避免下载的几个坑》。如果您已付费下载过本站文档，您可以点击这里二次下载。
4、如文档侵犯商业秘密、侵犯著作权、侵犯人身权等，请点击“版权申诉”（推荐），也可以打举报电话：400-050-0827(电话支持时间：9:00-18:30)。
5、该文档为VIP文档，如果想要下载，成为VIP会员后，下载免费。
6、成为VIP后，下载本文档将扣除1次下载权益。下载后，不支持退款、换文档。如有疑问请联系我们。
7、成为VIP后，您将拥有八大权益，权益包括：VIP文档下载权益、阅读免打扰、文档格式转换、高级专利检索、专属身份标志、高级客服、多端互通、版权登记。
8、VIP文档为合作方或网友上传，每下载1次，网站将根据用户上传文档的质量评分、类型等，对文档贡献者给予高额补贴、流量扶持。如果你也想贡献VIP文档。上传文档

#include hidef.h /* common defines and macros */ #include derivative.h /* derivative-specific definitions */ #include stdio.h #include MC9S12XS128.h #include stdlib.h #include math.h #pragma LINK_INFO DERIVATIVE mc9s12xs128 #define K 1 #define N 3 unsigned int i=0,j=0,m=0,n=0; unsigned char str[]={0}; signed int b=0,c=0,d=0,e=0,f=0,g=0,spe=0,r=0,l,x3,y,z,x1,x2,x4; int time; int zd=0,flag; int pp; ///////////////////////////////////// //// 电机 PID 定义 ///////////////////////////////////// int SetPoint=0; //设定目标 Desired Value int FeedBack=0; float KKp=1.5; //比例常数 Proportional Const float KKi=0; float KKd=0.6; //微分常数 Derivative Const signed int EE0=0; //当前误差 signed int EE1=0; //Error[-1] signed int EE2=0; //Error[-2] signed int EError0=0,EError1=0; signed int iiIncpid=0; int sp=0; /////////////////////////////// /// 舵机 PID 定义 ////////////////////////////// float Kp=3; //比例常数 Proportional Const float Ki=1; float Kd=4.2; //微分常数 Derivative Const signed int E0=0 ; //当前误差 signed int E1=0; //Error[-1] signed int E2=0; //Error[-2] signed int Error0=0,Error1=0; signed int iIncpid=0; ///////////////////////////////////// ///////////////////////////////////// //// 电机 PID ///////////////////////////////////// //////////////////////////////////// unsigned int Getspeed(int cch1,int cch2 ) { EE0=cch1-cch2; //增量计算 EError0=EE0-EE1; EError1=EE1-EE2; iiIncpid=(int)(KKi*EError0+KKp*EE0+KKd*(EError0-EError1)); EE1=EE0; EE2=EE1; //存储误差，用于下次计算 sp+=iiIncpid; if(sp210) sp=210; if(sp0) sp=0; return sp; } void sudu(int SetPoint) { pp=Getspeed(SetPoint,FeedBack); PWMDTY2=pp; } ////////////////////////////// /////////////////////////////// /// 舵机 PID ////////////////////////////// ////////////////////////////////////// int Pcrtl(int ch1,int ch2 ) { E0=ch1-0; //增量计算 Error0=E0-E1; Error1=E1-E2;