correlation.c

两个随机信号相关DSP实现及在故障距离判别运用,是现代信号处理理论教学的实验部分,利于理解随机过程相关的实际意义

/*
;***********************************************************************
;*				  						 北京达盛科技有限公司
;*                                     	    研    发    部
;*
;*                                 	http://www.techshine.com
;*
 *文件名称：correlation.c
 *文件标示：
 *摘    要：本文件内容为tms320lf2407 dsp相关运算实验程序     
 *          
 *
 *当前版本：1.0
 *作    者：王飞
 *完成日期：2005年2月17日
 *
 *取代版本：
 *原作者  ：
 *完成日期：
 *************************************************************/

/************************文件预处理***************************/
#include <math.h>
#include "exp4_2407.h"
#define PI  3.1415927
#define Length  128            /*input array x,y length*/
#define Lengthcor  2*Length-1  /*ouput array r length*/
/*************************************************************/

/********************全局变量定义与初始化*********************/
int i,k,j,mode;
double sum_real, t_real, temp_real;
double x_real[Length],y_real[Length];
double r_real[Lengthcor]; 
/*************************************************************/

/*******************函数、子程序声明与定义********************/
void sys_ini()               //系统初始化子程序
{
 /*关总中断*/
  asm(" setc INTM");         
 /*抑制符号位扩展*/
  asm(" clrc SXM");          
 /*累加器中结果正常溢出*/
  asm(" clrc OVM");          
 /*禁止看门狗*/
  * WDCR=0x00E8;             
 /*配置时钟锁相为4倍频CLKOUT=4*10M=40M,使能ADC时钟*/
  * SCSR1=0x0081;    
 /*io、ram、program都设为0等待读写*/
  WSGR=0x0000;                         
 /*清除所有中断标志,"写1清0"*/ 
  * IFR=0xFFFF; 
 /*使能cpu中断1*/
  * IMR=0x0000;                          
}   

void adc_ini()                  //ADC初始化子程序
{    
    /*仿真器挂起时,完成最后一次ad,
      高中断优先级,双排序模式,禁用其他模式*/
     * ADCTRL1=0x25C0;          
    /*禁用中断模式，清中断标志*/
     * ADCTRL2=0x0202;          
    /*启用排序器1，最大转换数为1*/
     * MAXCONV=0x0001;          
    /*选择模拟输入通道为4,5通道*/
     * CHSELSEQ1=0x0054;        
}

void read_ad()                  //读AD结果子程序
{
     int a;
    /*软件启动eoc1--ad转换器*/
     * ADCTRL2|=0x2000;         
     for(a=0;a<256;a++)
     {       
      /*读出ad结果*/
       x_real[a]=(* RESULT0>>6);
       y_real[a]=(* RESULT1>>6);    
     }
     return;
}
/*************************************************************/

/*****************中断服务子程序声明与定义********************/
interrupt void nothing()     //哑中断子程序
{
  return;         
}
/*************************************************************/

/**************************主程序*****************************/
void main(void)
{
   sys_ini();
   adc_ini();
   
   k=0;
   sum_real=0;
   t_real=0;
   temp_real=0;
   
/* 
	when mode=1, result is biased estimate;
   	when mode=0, result is unbiased estimate
*/                               
   
   mode=1;
   
   for(i=0; i<Length-1; i++)   /*Initialize*/
   {
      x_real[i]=0;
      y_real[i]=0;
      r_real[i]=0;
   }

   for(i=0; i<=Length-1; i++)  /*Input x,y*/
   {
      x_real[i]=sin(2*PI*i/(Length-1));
      y_real[i]=cos(2*PI*i/(Length-1));
   }
   
    read_ad();
   
   for(k=0; k<=Length-1; k++)  /* Caculation */
   {
   	  sum_real=0;
   	  
   	  for(j=0; j<=Length-1-k; j++)
      {
         t_real=x_real[j+k]*y_real[j];
         sum_real=sum_real+t_real;
      }
      
      if(mode==0)
      {
         r_real[Length-1-k]=sum_real/(Length-k);
      }

      else
      {
         r_real[Length-1-k]=sum_real/Length;
      }
   }
   
   for(k=0; k<=Length-1; k++)  
   {
      sum_real=0;

      for(j=0; j<=Length-1-k; j++)
      {
         t_real=x_real[j]*y_real[j+k];
         sum_real=sum_real+t_real;
      }

      if(mode==0)
      {
         r_real[Length-1+k]=sum_real/(Length-k);
      }

      else
      {
         r_real[Length-1+k]=sum_real/Length;
      }
   }
   
   i++;

   for (;;)
   {
     i=0;
   }
}
/***************************结束******************************/