pid.c

来自「本设计以ATMEL公司生产的AT90S8515作为控制核心」· C语言 代码 · 共 23 行

// PID.c
// 8/7/2005 written by MrLiu
//

#include <io8515v.h>
#include "PID.h"
#include "main.h" 
#define PID_EE_VALUE_MAX   100

void PID(int ee)
{
 	long	newDAC;
	int		flag=1;
	
	if(ee>PID_EE_VALUE_MAX) ee=PID_EE_VALUE_MAX;
	if(ee<-PID_EE_VALUE_MAX) ee=-PID_EE_VALUE_MAX;
	newDAC=(long)DAC-((long)ee<<2);
	if (newDAC>65535) DAC=65535;
	else if (newDAC<0) DAC=0;
	else DAC=newDAC&0x0ffff;
}