/*************************************************************
 *Copyright (c) 2005,北京精儀達盛科技有限公司研發部
 *All rights reserved
 *
 *文件名稱：fir.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 npass,h[51], x, y, xmid[51];
  int m=50;
  int n=256;	 
/*************************************************************/

/*******************函數、子程序聲明與定義********************/
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 firdes(int m, double npass)
  {
  	int t;
   	for (t=0; t<=m; t++)
  	{
  		h[t] = sin((t-m/2.0)*npass*pi)/(pi*(t-m/2.0));
  	}
  	if (t=m/2) h[t]=npass;
  }
/*************************************************************/

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

/**************************主程序*****************************/
void main(void)
{
    int xm,ym;
  	double fs,fstop,r,rm;
  	int i,j,p,k,s;
  	sys_ini();
  	adc_ini();
  	
  	k=0;  	  	
  	fs = 16000;
  	fstop = 2000;
  	npass = fstop/fs;
  	
  	for (i=0; i<=m; i++)
  	{
  		xmid[i]=0;
  	}

  for(;;)
  {	
  	firdes(m, npass);	
	for (s=0; s<=4; s++)
	{	
		read_ad();		
		for (i=0; i<=n-1; i++)
		{
		  xm = px[i];
		  x = xm/1023.0;			    	
   		  for (p=0; p<=m; p++)
    	  {
    	    xmid[m-p] = xmid[m-p-1];
    	  }
    	  xmid[0] = x;
          r = 0;
 		  rm= 0; 
		  for (j=0; j<=m; j++)
		  {	
	 	 	r  = xmid[j] * h[j];
			rm = rm + r;
    	  }
		  y = rm;
	   	  ym = (int)(1023.0 * y);
	   	  py[i] = ym;
	   	}
 		k=k;
	}		
  }
}
/***************************結束******************************/