MSP430之自动增益程控放大main备份

占位符

 #include <msp430.h>
 #include "sys.h"
 #include "ps2.h"
 #include "12864.h"
 #include "adc.h"
 #include "tlv5638.h"
 #include "pid.h"
 #include "timera.h"
 #include "uart.h"
 #include "vosc.h"

 //#define _DISMAIN_

 #define ADCN 10        // ad采集次数

 // 在ps2.c里面定义
 extern unsigned char ps2_keyvalue;
 extern unsigned char ps2_flag;

 unsigned int m = ;            // TLV5638设置值
 unsigned char adcnt = ;
 unsigned int adcFinish = ;
 unsigned int adcValue = , advArr[ADCN] = {  };    // ADC采集的值,采集13次保存在数组里
 unsigned int ta_flag = , dispFlag = ;

 // pid参数
 unsigned int point = ;        // 目标值
 float p = 0.1, i = , d = 0.1;
 int inc = , tempInc;                    // 增量
 unsigned int out2Osc[] = {  };

 // 获取键盘输入
 void GetInput()
 {
     unsigned char temp;
     temp = PS2_AsiiConvert(ps2_keyvalue);

     if(temp == '+')
     {
         point += ;
         if(point >= )
             point = ;
         IncPIDSetPoint(point);        //
         LCD_Set_Pos(, );
         LCD_Show_Num(point);
     }
     else if(temp == '-')
     {
         point -= ;
         if(point < )
             point = ;
         IncPIDSetPoint(point);
         LCD_Set_Pos(, );
         LCD_Show_Num(point);
     }
     else if(temp == '')        //p设置
     {
         p += 0.01;
         IncPIDSet(p, i, d);
         LCD_Set_Pos(, );
         LCD_Show_Deci2(p);
     }
     else if(temp == '')
     {
         p -= 0.01;
         IncPIDSet(p, i, d);
         LCD_Set_Pos(, );
         LCD_Show_Deci2(p);
     }
     else if(temp == '')
     {
         i += 0.01;
         IncPIDSet(p, i, d);
         LCD_Set_Pos(, );
         LCD_Show_Deci2(i);
     }
     else if(temp == '')
     {
         i -= 0.01;
         IncPIDSet(p, i, d);
         LCD_Set_Pos(, );
         LCD_Show_Deci2(i);
     }
     else if(temp == '')
     {
         d += 0.01;
         IncPIDSet(p, i, d);
         LCD_Set_Pos(, );
         LCD_Show_Deci2(d);
     }
     else if(temp == '')
     {
         d -= 0.01;
         IncPIDSet(p, i, d);
         LCD_Set_Pos(, );
         LCD_Show_Deci2(d);
     }
     else
     {
     }
     P2IFG &= ~BIT4;
 }

 /*
  * 加权滤波
  */
 unsigned int filter(unsigned int arr[])
 {
     unsigned char i;

     /* 均值滤波 */
     unsigned int temp = ;

     for (i = ; i < ADCN; i++)
     {
         temp += arr[i];
     }
     temp = (unsigned int) (temp * 1.0 / ADCN);

     return temp;
 }

 /*
  * AGC自动调节
  */
 void AGC()
 {
     // 测试用
 //    P1OUT |= BIT6;

     adcValue = (unsigned long) (filter(advArr) * 2500.0f / 1024.0f);// * 1000.0f );    // / 1024.0f);
     // 计算增量
     inc = IncPIDCalc(adcValue);
     tempInc += inc;                        // 增量调节
     if(tempInc < )
         tempInc = ;                    // 输出限制>=0V
     if(tempInc > )
         tempInc = ;                    // 输出限制<=2V
     m = (unsigned int) tempInc;

     // 设置TLV值
     TLV_WriteData(0xd002);                // 写入通道A
     TLV_WriteData(Volt(m));

     // 输出到虚拟示波器
     out2Osc[] = point;
     out2Osc[] = (unsigned int) adcValue;
     out2Osc[] = m;
     out2Osc[] = ;
     VOSC_Out4Data(out2Osc);

 //    P1OUT &= ~BIT6;
 }

 #ifndef _DISMAIN_
 void main()
 {
     // 测试用
     P1DIR |= BIT6;
     P1OUT |= BIT6;
 //    P2DIR |= BIT5;
 //    P2OUT |= BIT5;

     System_Init();
     LCD_Init();
     PS2_Init();
     TLV_Init();                        // TLV5638控制电压
     ADC_Init2();                    // P1.310次采集
     __delay_cycles();
     TA_Init();                        // 定时器初始化,10ms
     Uart_Init();                    // OSC用到串口

     // PID初始化
     IncPIDInit(p, i, d, point);

     // UI
     LCD_Clear();
     LCD_Set_Pos(, );
     LCD_Show_String("PointV->");            // 目标值
     LCD_Set_Pos(, );
     LCD_Show_Num(point);
     LCD_Set_Pos(, );
     LCD_Show_String("mV");
     LCD_Set_Pos(, );
     LCD_Show_String("CurSet->");            // 当前设定值
     LCD_Set_Pos(, );
     LCD_Show_Num(m);
     LCD_Set_Pos(, );
     LCD_Show_String("mV");
     LCD_Set_Pos(, );
     LCD_Show_String("ADCapV->");            // 采集电压
     LCD_Set_Pos(, );
     LCD_Show_Num(adcValue);
     LCD_Set_Pos(, );
     LCD_Show_String("mV");

     // 显示pid参数
     LCD_Set_Pos(, );
     LCD_Show_Deci2(p);
     LCD_Set_Pos(, );
     LCD_Show_Deci2(i);
     LCD_Set_Pos(, );
     LCD_Show_Deci2(d);

     // 写入初始电压
     TLV_WriteData(0xd002);
     TLV_WriteData(Volt(m));
     LCD_Set_Pos(, );
     LCD_Show_Num(m);

     // agc初始化
     tempInc = m;

     _EINT();            // 使能中断，键盘、定时器
     while ()
     {
         // 键盘
         if(ps2_flag == )
         {
             GetInput();        // 获取按键，处理按键事件
             ps2_flag = ;
         }

         // ADC采集
 //        if(ta_flag == 1)
 //        {
 //            ta_flag = 0;
 //
 //            // AD采集
 //            ADC_Start2(advArr);
 //        }

         // AGC调节
 //        if(adcFinish == 1)            // 采集了N次
 //        {
 //            adcFinish = 0;
 //            AGC();
 //        }

 //        // 设置TLV值
 //        TLV_WriteData(0xd002);                // 写入通道A
 //        TLV_WriteData(Volt(m));

         // 显示延时
         if (dispFlag >= )
         {
             dispFlag = ;

             // 显示当前设定值
             LCD_Set_Pos(, );
             LCD_Show_Num(m);

             // 显示AD采集结果
             LCD_Set_Pos(, );
             LCD_Show_Num(adcValue);
         }
     }
 }

 #pragma vector=TIMER0_A0_VECTOR
 __interrupt void TIME0_A0_ISR(void)
 {
     ta_flag = ;            // 定时时间到
     dispFlag++;                // 用于显示延时

 //    P2OUT |= BIT5;            // 准备AGC
     ADC_Start2(advArr);        // AD采集

 //    _EINT();

     // 测试用
     P1OUT ^= BIT6;
 }

 #pragma vector = ADC10_VECTOR
 __interrupt void ADC10ISR(void)
 {
 //    adcFinish = 1;

     ADC10CTL0 &= ~(ENC + ADC10SC);    // 停止转换
     AGC();                            // 采集完成，AGC调节
 //    P2OUT &= ~BIT5;

 //    adcFinish = 0;
 }

 #endif