back_up.c

磁流变阻尼器控制器的源程序

//加定时器已完成 现在的采样频率为32Hz
//主体部分已经完成，Ka已经计算正确，给P2端口赋值能正确显示，但通过Ka给P2传递
//增益时,P2输出亦正确，调整PI算法已调整，振级表是使用自己编写的一个,P0输出
//正确了（实施办法是将P0赋值位置提前就解决了）
#include<stdio.h>
#include<aduc842.h>
#include<math.h>

#define KP 0.5//暂定Kp=5
#define KI 0.5//暂定Ki=5

sfr templ=0x86;
sfr temph=0x85;

void DELAY(int length);
void adc_chan(int chan);// 选择通道
void adc_ini();
void adc_start();
void config();
void uart_ini();
void dac_ini();
void port_ini();
void TIC_ini();
void TIC_start();
void readval();//读取AD转换值并转为10进制数子函数
void pi();//PI算法子程序
float Lookuptab(unsigned char voltab);//查表子程序

int		K;	
int   Ka;
int   tempval;
float code Table[6]={1.0,2.0,3.0,4.0,5.0,6.0};//自己暂定的振级表，可以根据实际值修改
float UDA;//UDA为DAC0输出
float UIK=0;//UI的初值设为0 
float MK;
float RK;
float EK;
float UPK;
float UK;


void adc_int() interrupt 6  //ADC转换完,进入中断
{
	I2CCON=0x0C8;//灯灭
	DELAY(2000);
    DELAY(2000);
    DELAY(2000);
	I2CCON=0x048;//灯亮  
	temph=ADCDATAH;
	templ=ADCDATAL;//转换值暂存到temp中
	ADCI = 0;//可要可不要，如果不进入ADC中断，则须用户手动清零
	return;
}


void TIC_int () interrupt 10
{
	TIMECON=0x00;
    I2CCON=0x048;
	DELAY(2000);
	printf("TIC finished\n");//去掉warning请注释此句
	IEIP2 = 0x00;//关TIC中断
}


void adc_chan(int chan)
{
ADCCON2 = chan;
}



void adc_ini()
{
ADCCON1 = 0x02C;            // 暂停AD
EA	    = 0;				// 中断不使能
EADC	= 0;				// ADC中断不使能

}

void adc_start()
{
ADCCON1 = 0x0AC;            // 启动AD,使用内部参考电压
//EA	    = 1;				// 中断使能
EADC	= 1;				// ADC中断使能
}

void config()
{
CFG842 = 0x40;      //暂定
PLLCON = 0x03;		//工作频率＝2.097152 MHz


}

void uart_ini()		//串口初始化
{
T3CON = 0x083;
T3FD  = 0x02D;
SCON  = 0x052;
}

void dac_ini()
{
DACCON = 0x0D;//DAC0 12位异步 0-Cref=5v
//DACCON = 0x2D;//DAC0 12位异步 0-Vdd
}

void port_ini()//根据需要设置AD7520增益值
{
P0&=0x00;//
P2|=0x00;
//P2|=0x64;//0110,0100
//P2|=0xC4;//1110,0101
}

void TIC_ini()		//定时器初始化
{
TIMECON = 0x00;
INTVAL = 0x00;
HTHSEC=0x00;
}

void TIC_start()		//定时器开始计时,中断间隔为4*(1/128)=31.25ms,注意要在TCEN为低的时候给
{						//INTVAL和HTHSEC赋值,再开TIC中断,全局中断,最后置TCEN开始计时
TIMECON = 0x0A;//0000,1010
INTVAL = 0x04;
HTHSEC=0x00;
IEIP2 = 0xA4;//TIC中断使能
EA = 1;
TIMECON|=0x01;//启动TIC	
} 


void readval()
{
tempval=(int)temph*256;//强制转换为整形数
tempval+=(int)templ;//此时计算的是十进制的AD结果，比如若temph:templ=03ff,则对应于1023

}

float Lookuptab(unsigned char voltab)
 {
 return Table[voltab];
 }

void pi()
{
	MK=(float)tempval*5/4096;//必须强制转换为浮点数,否则结果不对
	UDA=5;//UDA为方便计算设置的一个变量
	//UK=UDA;//调试时先可直接把Uk=5v来计算，等到完成后在应用下面的PI算法
	DELAY(2000);
	DELAY(2000);
	 if(0<MK&MK<=1)  {RK=Lookuptab(0);}
else if(1<MK&MK<=2)  {RK=Lookuptab(1);}
else if(2<MK&MK<=3)  {RK=Lookuptab(2);}
else if(3<MK&MK<=4)  {RK=Lookuptab(3);}
else if(4<MK&MK<=5)  {RK=Lookuptab(4);}
     else            {RK=Lookuptab(5);}//这段程序目的是查表确定振动的给定参考值以便与采集来的数据比较
	
	DELAY(2000);
	EK=RK-MK;
	UPK=KP*EK;
	UIK=KI*EK+UIK;
	UK=UPK+UIK;
	DELAY(2000); 
	K=(UK/UDA*1024);//现将（）内表达式的值取整，此值处理后即为送往AD7520的增益值,
	Ka=K>>2;//因为电路板上低两位已拉高,所以只需要高8位
	Ka&=0x00FF;//只用了低八位
}


void main(void)//主程序开始
{	
	
	config();
	adc_ini();
	adc_chan(0);
	uart_ini();
	dac_ini();
	DELAY(2000);
	port_ini();
	
	DELAY(2000);
	TIC_ini();
	DELAY(2000);
	P0&=0x00;//如果要调整P0口增益值，则打开此句
 	printf("P0=%02BX\n",P0);
	DELAY(2000);
	P0|=0xFF;//第一级AD7520增益先设为不放大，即放大倍数为（1023/1024）
	DELAY(2000);
	printf("P0=%02BX\n",P0);
	//printf("UIK=%f\n",UIK);
	DAC0H=0x0F;
    DAC0L=0xFF;//AC0输出恒值5v
	//i=0;
	//adc_start();
	//SCONV = 1;				        //启动AD转换
	while(1){					//连续进行AD转换
	
	TIC_start();
	adc_start();
	SCONV = 1;				//开始一次转换
	DELAY(17000);			//调延迟，等待转换完毕
	if (ADCI == 0)			//中断处理完毕标志，进行输出
	{
	DELAY(2000);
	printf("temph=%02BX,templ=%02BX\n",temph,templ);//串口输出转换值
	printf("UIK=%f\n",UIK);
	readval();
	DELAY(2000);
	pi();
	printf("MK=%f\n",MK);
	printf("RK=%f\n",RK);
	printf("EK=%f\n",EK);
	printf("UPK=%f\n",UPK);
	printf("UIK=%f\n",UIK);
	printf("UK=%f\n",UK);
	DELAY(2000);
    printf("K=%04X\n",K);
	printf("Ka=%04X\n",Ka);
	DELAY(2000);
	P2&=0x00;//继续将端口初值设为0，便于调试,也使下一次P2能得到正确赋值
	DELAY(2000);
	printf("P2=%02BX\n",P2);//归零后应该显示00
	DELAY(2000);
	P2|=0x0064;//0110,0100
	//P2|=Ka;//正式给端口赋值，产生AD7520增益
	//P2^=Ka;//正式给端口赋值，产生AD7520增益
	DELAY(2000);
	printf("P2=%02BX\n\n",P2);//显示P2口置位是否正确
	DELAY(1000);
 	//adc_start();
	//SCONV = 1;
	}
			}
}

void DELAY(int length)//延迟函数
{
while (length >=0)
    length--;
}