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 = 1300;            // TLV5638设置值
unsigned char adcnt = 0;
unsigned int adcFinish = 0;
unsigned int adcValue = 0, advArr[ADCN] = { 0 };    // ADC采集的值,采集13次保存在数组里
unsigned int ta_flag = 0, dispFlag = 0;

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

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

    if(temp == '+')
    {
        point += 100;
        if(point >= 2000)
            point = 2000;
        IncPIDSetPoint(point);        //
        LCD_Set_Pos(0, 4);
        LCD_Show_Num(point);
    }
    else if(temp == '-')
    {
        point -= 100;
        if(point < 11)
            point = 10;
        IncPIDSetPoint(point);
        LCD_Set_Pos(0, 4);
        LCD_Show_Num(point);
    }
    else if(temp == '7')        //p设置
    {
        p += 0.01;
        IncPIDSet(p, i, d);
        LCD_Set_Pos(3, 0);
        LCD_Show_Deci2(p);
    }
    else if(temp == '1')
    {
        p -= 0.01;
        IncPIDSet(p, i, d);
        LCD_Set_Pos(3, 0);
        LCD_Show_Deci2(p);
    }
    else if(temp == '8')
    {
        i += 0.01;
        IncPIDSet(p, i, d);
        LCD_Set_Pos(3, 3);
        LCD_Show_Deci2(i);
    }
    else if(temp == '2')
    {
        i -= 0.01;
        IncPIDSet(p, i, d);
        LCD_Set_Pos(3, 3);
        LCD_Show_Deci2(i);
    }
    else if(temp == '9')
    {
        d += 0.01;
        IncPIDSet(p, i, d);
        LCD_Set_Pos(3, 6);
        LCD_Show_Deci2(d);
    }
    else if(temp == '3')
    {
        d -= 0.01;
        IncPIDSet(p, i, d);
        LCD_Set_Pos(3, 6);
        LCD_Show_Deci2(d);
    }
    else
    {
    }
    P2IFG &= ~BIT4;
}

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

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

    for (i = 0; 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 < 0)
        tempInc = 0;                    // 输出限制>=0V
    if(tempInc > 2000)
        tempInc = 2000;                    // 输出限制<=2V
    m = (unsigned int) tempInc;

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

    // 输出到虚拟示波器
    out2Osc[0] = point;
    out2Osc[1] = (unsigned int) adcValue;
    out2Osc[2] = m;
    out2Osc[3] = 0;
    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(10000);
    TA_Init();                        // 定时器初始化,10ms
    Uart_Init();                    // OSC用到串口

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

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

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

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

    // agc初始化
    tempInc = m;

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

        // 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 >= 150)
        {
            dispFlag = 0;

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

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

#pragma vector=TIMER0_A0_VECTOR
__interrupt void TIME0_A0_ISR(void)
{
    ta_flag = 1;            // 定时时间到
    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