/*************************************************************
 *Copyright (c) 2005,北京精儀達盛科技有限公司研發部
 *All rights reserved
 *
 *文件名稱：iir.c
 *文件標示：
 *摘    要：本文件內容為tms320lf2407 dsp 無限沖擊響應濾波器試驗     
 *          程序
 *
 *當前版本：1.0
 *作    者：王飛
 *完成日期：2005年2月17日
 *
 *取代版本：
 *原作者  ：
 *完成日期：
 *************************************************************/

/************************文件預處理***************************/
#include <math.h>
#include "exp3_2407.h"
#define pi 3.1415927
/*************************************************************/

/********************全局變量定義與初始化*********************/
  int px[256];
  int py[256];
  double fs,nlpass,nlstop,nhpass,nhstop,a[3],b[3],x,y;
/*************************************************************/

/*******************函數、子程序聲明與定義********************/
void sys_ini()               //系統初始化子程序
{
 /*關總中斷*/
  asm(" setc INTM");         
 /*抑制符號位擴展*/
  asm(" clrc SXM");          
 /*累加器中結果正常溢出*/
  asm(" clrc OVM");          
 /*禁止看門狗*/
  * WDCR=0x00E8;             
 /*配置時鐘鎖相為4倍頻CLKOUT=4*10M=40M，使能AD模塊*/
  * SCSR1=0x0081;    
 /*io、ram、program都設為0等待讀寫*/
  WSGR=0x0600;                         
 /*清除所有中斷標志,"寫1清0"*/ 
  * IFR=0xFFFF;                          
}   

void adc_ini()                  //ADC初始化子程序
{    
    /*仿真器掛起時,完成最后一次ad,
      高中斷優先級,雙排序模式,禁用其他模式*/
     * ADCTRL1=0x25C0;          
    /*禁用中斷模式，清中斷標志*/
     * ADCTRL2=0x0202;          
    /*啟用排序器1，最大轉換數為1*/
     * MAXCONV=0x0000;          
    /*選擇模擬輸入通道為4通道*/
     * CHSELSEQ1=0x0004;        
}

void read_ad()                  //讀AD結果子程序
{
     int a;
    /*軟件啟動eoc1--ad轉換器*/
     * ADCTRL2|=0x2000;         
     for(a=0;a<256;a++)
     {       
      /*讀出ad結果*/
       px[a]=(* RESULT0>>6);    
     }
     return;
}

void biir2lpdes(double fs, double nlpass, double nlstop, double a[], double b[])  
  {
    int i,u,v;
	double wp,omp,gsa,t;
    wp=nlpass*2*pi;
	omp=tan(wp/2.0);
	gsa=omp*omp;
	for (i=0; i<=2; i++)
	  {
		u=i%2;
		v=i-1;
		a[i]=gsa*pow(2,u)-sqrt(2)*omp*v+pow(-2,u);
	  }
	
	for (i=0; i<=2; i++)
	  {	u=i%2;
		b[i]=gsa*pow(2,u);
	  }
	t=a[0];
	for (i=0; i<=2; i++)
	  {	a[i]=a[i]/t;
		b[i]=b[i]/t;
	  }
  }
/*************************************************************/

/*****************中斷服務子程序聲明與定義********************/
interrupt void nothing()     //啞中斷子程序
{
  return;         
}
/*************************************************************/

/**************************主程序*****************************/
void main(void)
{
	int j,k=0;
	int n,x_ad,y_da;
	double w2,w1,w0;
	w2=w1=w0=0.0;
		
  	sys_ini();
  	adc_ini();

	for (;;)
	{		
		fs=16000;
		
		/*  IIR LP  filter  */
		
		nlpass = 0.02;
		nlstop = 0.22;
		
		biir2lpdes(fs,nlpass,nlstop,a,b);
        for (j=0; j<=4; j++)
	    {
		  read_ad();		    			
		  for (n=0; n<=255; n++)
	  	  { 
			x_ad = px[n];
			x = x_ad/1023.0;		
			w2=x-a[1]*w1-a[2]*w0;
      	    y=b[0]*w2+b[1]*w1+b[2]*w0;
      	    w0=w1;
      	    w1=w2;
      	    y_da=(int)(y*1023.0);
      	    py[n] = y_da;
      	  }	
		  k=k;
	    } 
	}
}
/***************************結束******************************/