欧美A级中文完在线看完整版,97在线视频免费公开观看,伊人网在线视频观看

#include <reg52.h>
#include "i2c.h"
#include "delay.h"
#include "1602.h"
#include <stdio.h>
#include <math.h>
#define AddWr 0x90 //寫數(shù)據(jù)地址
#define AddRd 0x91 //讀數(shù)據(jù)地址
#define wait_speak 1
#define speaked 0
sbit PWM=P1^2;
sbit led=P1^6;
sbit target_up=P3^0;
sbit target_down=P3^1;
sbit beep=P1^5;
float target=40.0;
float Kp=0.05,Ki=0.4,Kd=0.15;
unsigned int value,timer1;
char flag=wait_speak;
unsigned char confirtime=0;
extern bit ack;
unsigned char ReadADC(unsigned char Chl);
float pid(float input);
void control();
void Timer1Init();
void Timer0Init();
void change_target();
void beep_1s();
void display();
bit WriteDAC(unsigned char dat);
void delay100us(int i) //誤差 0us
{
unsigned char a,b;
while(i--)
for(b=1;b>0;b--)
for(a=47;a>0;a--);
}
/*------------------------------------------------
主程序
------------------------------------------------*/
main()
{
LCD_Init(); //初始化液晶
DelayMs(20); //延時(shí)有助于穩(wěn)定
LCD_Clear(); //清屏
Timer1Init();
value=0;
led=0;
while (1) //主循環(huán)
{
control();
change_target();
}
}
/*------------------------------------------------
讀AD轉(zhuǎn)值程序
輸入?yún)?shù) Chl 表示需要轉(zhuǎn)換的通道，范圍從0-3
返回值范圍0-255
------------------------------------------------*/
unsigned char ReadADC(unsigned char Chl)
{
unsigned char Val;
Start_I2c(); //啟動(dòng)總線
SendByte(AddWr); //發(fā)送器件地址
if(ack==0)return(0);
SendByte(0x40|Chl); //發(fā)送器件子地址
if(ack==0)return(0);
Start_I2c();
SendByte(AddWr+1);
if(ack==0)return(0);
Val=RcvByte();
NoAck_I2c(); //發(fā)送非應(yīng)位
Stop_I2c(); //結(jié)束總線
return(Val);
}
float pid(float input)
{
static float error2,error1,error3,t,Velocity;
error1 = target-input ;
Velocity+=(Kp*(error1-error2))+Ki*error1+Kd*(error1-2*error2+error3);
t=error2;
error2= error1 ;
error3 = t;
return Velocity;
}
//電壓分辨率0.0196V
//滿電壓3.9V所以角度分辨率0.0196/3.9*360=1.8度所以增大角度分辨率要嘛增加滿量程電壓3.9V要嘛減小其對(duì)應(yīng)的角度，其實(shí)就都是增大電壓
void control()
{
unsigned char num=0,i;
int sum_num=0;
unsigned char temp[7];//定義顯示區(qū)域臨時(shí)存儲(chǔ)數(shù)組
float Voltage,angle; //定義浮點(diǎn)變量
float temp_value;
for(i=0;i<5;i++)
{
sum_num+=ReadADC(0);
}
num=sum_num/5;
sum_num=0;
Voltage=(float)num;
angle=(Voltage-16);//*1.41-23.91);
//angle=-(((Voltage-4.96)/0.0136)+341.73);
//pid計(jì)算
temp_value=(int)pid(angle);
if(temp_value<0)
value=0;
else if(temp_value>=100)
value=100;
else
value=(int)temp_value;
if(flag==wait_speak&&abs(angle-target)<=5)
confirtime++;
if(abs(angle-target)>=20) //如果角度差大于20度將嗡鳴器設(shè)置為待激活狀態(tài)
flag=wait_speak;
if(confirtime==10&&(flag==wait_speak))
{
//beep_1s();
sprintf(temp,"Achieve the goal:");//格式輸出電壓值，%3.2f 表示浮點(diǎn)輸出，共3位數(shù)，小數(shù)點(diǎn)后2位
LCD_Write_String(0,1,temp);
delay100us(10000);
LCD_Clear(); //清屏
flag=speaked;
confirtime=0;
}
sprintf(temp,"DQJD:%3.2f ", angle);
LCD_Write_String(0,0,temp);
sprintf(temp,"SDJD:%d",(int)target);
LCD_Write_String(0,1,temp);
//sprintf(temp,"PWM:%d", value);
//LCD_Write_String(10,1,temp);
}
//定時(shí)器1服務(wù)函數(shù)
void Time1(void) interrupt 3
{
TH1 = 0x0FF;
TL1 = 0x9C;
timer1++;
if(timer1>100) //PWM周期為100*100us
{
timer1=0;
}
if(timer1 <value)
{
PWM=1;
}
else
{
PWM=0;
}
}
//定時(shí)器1初始化函數(shù)
void Timer1Init()
{
TMOD|=0X10;//選擇為定時(shí)器1模式，工作方式1，僅用TR1打開啟動(dòng)。
TH1 = 0x0FF;
TL1 = 0x9C;
ET1=1;//打開定時(shí)器1中斷允許
EA=1;//打開總中斷
TR1=1;//打開定時(shí)器
}
void change_target()
{
unsigned char temp[7];//定義顯示區(qū)域臨時(shí)存儲(chǔ)數(shù)組
if(target_up==0)
{
delay100us(100);
if(target_up==0)
{ flag=wait_speak;
while(target_up==0)
{
if(target<=80)
target=45;
sprintf(temp,"Target:%d",(int)target);//格式輸出電壓值，%3.2f 表示浮點(diǎn)輸出，共3位數(shù)，小數(shù)點(diǎn)后2位
LCD_Write_String(0,1,temp);
delay100us(1000);
}
}
}
if(target_down==0)
{
delay100us(100);
if(target_down==0)
{ flag=wait_speak;
while(target_down==0)
{
if(target>=10)
target=0;
sprintf(temp,"Target:%d",(int)target);//格式輸出電壓值，%3.2f 表示浮點(diǎn)輸出，共3位數(shù)，小數(shù)點(diǎn)后2位
LCD_Write_String(0,1,temp);
//delay10us(1000);
}
}
}
}
void display()
{
// unsigned char temp[7];//定義顯示區(qū)域臨時(shí)存儲(chǔ)數(shù)組
// sprintf(temp,"Reality: %3.2f ", angle);//格式輸出電壓值，%3.2f 表示浮點(diǎn)輸出，共3位數(shù)，小數(shù)點(diǎn)后2位
// LCD_Write_String(0,0,temp);
// sprintf(temp,"Target:%d",(int)target);//格式輸出電壓值，%3.2f 表示浮點(diǎn)輸出，共3位數(shù)，小數(shù)點(diǎn)后2位
// LCD_Write_String(0,1,temp);
// sprintf(temp,"PWM:%d", value);//格式輸出電壓值，%3.2f 表示浮點(diǎn)輸出，共3位數(shù)，小數(shù)點(diǎn)后2位
// LCD_Write_String(9,1,temp);
}
void beep_1s()
{
unsigned char i;
for(i=0;i<=200;i++)
{
delay100us(1);
beep=~beep;
}
}

復(fù)制代碼

欧美极品高清xxxxhd,国产日产欧美最新,无码AV国产东京热AV无码,国产精品人与动性XXX,国产传媒亚洲综合一区二区,四库影院永久国产精品,毛片免费免费高清视频,福利所导航夜趣136