标题: 基于51单片机控制直流电机转速的程序,模拟量转为数字量 [打印本页]

作者: Lzc@@    时间: 2021-2-6 13:09
标题: 基于51单片机控制直流电机转速的程序,模拟量转为数字量
/**************************************************************/
/*    文件名: AD0809.c                                        */
/*    功能描述: AD采样实验,结果通过串口送PC显示(脱机运行)    */
/*              结果送内部数据区30H,共16个(SoftIce调试)      */
/**************************************************************/
#include <reg51.h>
//#include "SST89x5x4.h"
#include "Absacc.h"

#define T_value     (unsigned char)0xFE                // T周期值
#define T1_value    (unsigned char)0x20                // T周期中高电平周期T1值
#define TH0_value   (unsigned char)0xFE                // 定时器T0计数值(高)10
#define TL0_value   (unsigned char)0x9B                // 定时器T0计数值(低)

unsigned char   V_Set;

float Kp=0;
float Ki=0;
float Sum= 0 ;

#define STARTAD    XBYTE[0x7F00]
#define ADRESULT   XBYTE[0x7F08]

sbit ADBUSY  = P3^3;

void Delay()
{
        unsigned char i;
        for(i=0; i<100; i++);
}

unsigned char AD0809(void)
{
        unsigned char result;
        STARTAD = 0;                        //启动AD
        while(ADBUSY == 1);                //等待转换结束
        Delay();
        result = ADRESULT;
        return result;                        //返回转换结果
}


sbit DRV = P1^7;
unsigned char T_Count;                        // 延时次数
//unsigned char ADV;                //变量
//unsigned char Tx;


void init_tim0()                                // 定时器0初始化,定时基数
{
        TMOD = 0x01;
        TH0 = TH0_value;
        TL0 = TL0_value;
        TR0 = 1;       
        ET0 = 1;
        EA = 1;
}
void init_tim1()                                // 定时器1初始化,定时基数
{
        TMOD |= 0x50;
        TH1 = 0;
        TL1 = 0;
        TR1 = 1;
//        ET0 = 1;
}


void int_tim0() interrupt 1
{
         
        TH0 = TH0_value;
        TL0 = TL0_value;
    T_Count++;
}

float PID_Control (float get)          //PID控制算法
{
        float err ;
        err         = V_Set -  get;       
        Sum +=  err;       
        return (Kp*err + Ki * Sum   )  ;
       

}

void main(void)
{


        short V_get,OUT;
        Kp =1;
        Ki =1;
        DRV = 1;
        V_Set=0;
        init_tim0();
        init_tim1();        
        T_Count = 0;
//        Tx = ADV;
        while(1)
        {
//
                
//                Delay();
                V_get = TH1<<8|TL1;
            V_Set = AD0809();       
                OUT= PID_Control(V_get);
                  if(T_Count<V_Set)
                {
                        DRV =0;
//                        Tx = T_value - Tx;         
//                        T_Count = Tx;
             }
                else {  DRV =1;}
        if(T_Count==0xFE)
                {T_Count=0x00;}
        }


}







欢迎光临 (http://www.51hei.com/bbs/) Powered by Discuz! X3.1