- 1、本文档共8页,可阅读全部内容。
- 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 C8051F020.H#include string.h#include math.h//void PIDInit(PID *PP);/*定义结构体和公用体*/#define N 8typedef struct PID{unsigned int setpoint; /*设定值*/unsigned int proportion; /*比例系数*/unsigned int integral; /*积分系数*/unsigned int derivative; /*微分系数 */unsigned int lasterror; /*前一拍误差*/unsigned int preerror; /*前两拍误差*/ }PID; union stu{unsigned int value;unsigned char num[2]; }laser;
union dat{ unsigned char dd[2]; unsigned int number; }collect;
/*函数声明部分*/unsigned int PIDcal(PID *pp,int thiserror); void PIDInit(PID *PP); void PortInit(void); unsigned int get_ad(void); unsigned int filter_valve(void); void Delayms(void);
/*主函数部分*/ void main(void) {
PID vPID; /*定义结构体变量名*/unsigned int verror;unsigned int Error;unsigned int tempi;unsigned char LASERH,LASERL; /*误差的高低字节变量*/
WDTCN=0xde; WDTCN=0xad;//portinit();PIDInit(vPID);vPID.proportion=10; /*设置PID比例系数为10*/ vPID.integral=10; /*设定PID积分系数 为10*/vPID.derivative=10; /*设定PID微分系数为10*/vPID.setpoint=50; /*根据实际情况设定*/
IE= 0x80;
while(1){verror=filter_valve(); /*得到AD的滤波输出值 */Error=vPID.setpoint-verror; /*得到误差值*/tempi=PIDcal(vPID,Error); /*调用PID算法函数 得到误差增量*/
laser.value+=tempi; LASERH=laser.num[0]; /*value与num[2]为共同体,变量名为laser*/LASERL=laser.num[1]; /*存放高低字节*/} }
/*PID算法函数,返回误差增量*/unsigned int PIDcal(PID *pp,int thisError){unsigned int pError,dError,iError;unsigned int templ; pError=thisError-pp-lasterror; iError=thisError; dError=thisError-2*(pp-lasterror)+pp-preerror; templ=pp-proportion*pError+pp-integral*iError+pp-derivative*dError; /*增量计算*/
pp-preerror=pp-lasterror; /*存放误差用于下次运算*/ pp-lasterror=thisError;
return ((int)(templ8)); }
/*测量值*/
/*float measure(void) 已知A B 角为锐角{ /* COSA=1/7 SIN(A+B)=14分之5倍根号3 *//*long float value; /*求COSB*//*float A,B;A=acos(1/7);B=asin((5/14)*sqrt(3))-A;if((0Api/2)(0Bpi/2)) return cos(B); } */
/*得到ADC转换值*/ unsigned int get_ad(void){ while(AD0INT==0); { AD0INT=0;
文档评论(0)