久久久久久久999_99精品久久精品一区二区爱城_成人欧美一区二区三区在线播放_国产精品日本一区二区不卡视频_国产午夜视频_欧美精品在线观看免费

 找回密碼
 立即注冊

QQ登錄

只需一步，快速開始

搜索
查看: 4332|回復: 0
打印 上一主題 下一主題
收起左側

ADXL重力加速度傳感器實現計步器程序(利用MSP430F135實現)

[復制鏈接]
跳轉到指定樓層
樓主
ADXL重力加速度傳感器實現計步器程序,利用MSP430F135實現,代碼功能完整。
可用按鍵控制。


單片機源程序如下:

  2. //存儲器沒有文件系統，一次采集，一次上載

  4. #include "delay.h"
  5. #include "Key.h"
  6. #include  <msp430x13x.h>
  7. #include <string.h>
  8. #include <math.h>
  9. #include <stdio.h>
  10. #include"ADC12.h"
  11. #include "hzlib.h"
  12. #include "LCD.h"
  13. #include "SD2608.h"

  15. #define MEM_IN 0x02                        //P3.1
  16. #define MEM_OUT 0x04                       //P3.2
  17. #define SCLK 0x08                          //P3.3
  18. #define ATRDY 0x40                         //AT45DB161 RDY/BUSY          P2.6
  19. #define ATCS 0x80                          //AT45DB161 AT/CS             P2.7
  20. #define TIME_MS 10000                        //采樣頻率為100



  24. #define X_CHANNEL 0
  25. #define Y_CHANNEL 1
  26. #define Z_CHANNEL 2
  27. //#define TIMEWINDOW_MIN 8                //時間窗，×0.02s＝0.2s
  28. //#define TIMEWINDOW_MAX 30               //時間窗，×0.02s＝0.8s
  29. #define REGULATION      8              //認為找到穩定規律所需要的步數


  32. unsigned char       itemp,jtemp,temp;               
  33. unsigned char       TIMEWINDOW_MIN =11;        //時間窗，×0.02s＝0.2
  34. unsigned char       TIMEWINDOW_MAX =30        ;       //時間窗，×0.02s＝0.8s

  36. unsigned int  Adresult;               
  37. unsigned char _bad_flag[3];                                                                                                                                                       
  38. unsigned char  sampling_counter;                                                               
  39. unsigned int _adresult[3];                                                                       
  40. unsigned int _max[3]={0,0,0};
  41. unsigned int _min[3]={5000,5000,5000};
  42. unsigned int _dc[3]={500,500,500};
  43. unsigned int _vpp[3]={30,30,30};       
  44. unsigned int  _precision[3]={5,5,5};       
  45. unsigned int _old_fixed[3];
  46. unsigned int _new_fixed[3];
  47. unsigned long int STEPS;       
  48. unsigned long int STEPS_Temp;       
  49. unsigned  int _array0[3]={1,1,1};
  50. unsigned  int _array1[3]={1,1,1};
  51. unsigned  int _array2[3]={0,0,0};
  52. unsigned  int _array3[3]={0,0,0};
  53. unsigned  int _array4[3]={0,0,0};
  54. unsigned  int  ADXYZ[3] ;


  57. unsigned long int totalxyz[3];
  58. unsigned int averagexyz[3];
  59. unsigned char avxyz;
  60. unsigned char counter;
  61. unsigned char counterx=0;
  62. unsigned char countery=0;
  63. unsigned char counterz=0;


  66. unsigned char Interval=0;                //記錄時間間隔數
  67. unsigned char TempSteps=0;                //記步緩存
  68. unsigned char InvalidSteps=0;        //無效步緩存
  69. unsigned char ReReg=1;                       
  70.                                                                                
  71.                                                                                 //        1-已經開始，但是還沒有找到規律
  72.                                                                                 //        0-已經找到規律
  73. unsigned char high_or_low=0,k=0;
  74. unsigned char recieve;
  75. unsigned char date[7];
  76. unsigned char wdata[7]={0,0,128,0,1,1,0};








  85. void fnClkInit(void)
  86. {
  87.   unsigned int a;
  88.   WDTCTL = WDTPW +WDTHOLD;                                //關閉看門狗
  89.    BCSCTL1|=XTS;                                           //XT1口為高頻  XTS=1,ACLK = LFXT1
  90.   do
  91.     {
  92.      IFG1&=~OFIFG;                                        //清除振蕩器失效標志
  93.      for (a=0xFF;a>0;a--);                                //延時 等待XT1口起振
  94.      }
  95.    while ((IFG1&OFIFG)!=0);                                //判斷XT1口是否起振
  96.          BCSCTL2 |= SELM_3;                          //選擇LFXT1CLK為MCLK時鐘源
  97.          BCSCTL1 |= XT2OFF+DIVA0+DIVA1;                   //禁止XT2口 ACLK 8分頻
  98. }  
  99.                     
  100. /*******************定時器初始化定時5MS*******************/
  101. void TimerBInit(void)
  102. {
  103.        TBCTL   = TBSSEL_1 + TBCLR ;               //ACLK為定時器時鐘   
  104.        TBCCTL0 = CCIE;                                      //開定時器中斷
  105.        TBCCR0  = TIME_MS;                                      //5MS
  106.        //TBCTL  |= MC0;                                       //增計數模式
  107. }



  111. void main(void)
  112. {
  113.    fnClkInit();
  114.    TimerBInit();
  115.    //usart_Init();
  116.    Init_ADC();
  117.    Init_keyPort();
  118.    vdLCD_Init();
  119.    vdDisp_Main();
  120.    clock();
  121.      _EINT();
  122. while(1)
  123.    {
  124.     Iskey ();
  125.      vdDisp_bushu(STEPS);
  126.    }
  127. }


  130. #pragma vector=TIMERB0_VECTOR
  131. __interrupt void Timer_B (void)
  132. {
  133.    ADC12CTL0 &= ~ENC;

  135.   if(recieve==0x04)
  136.    {
  137.      //----------------------------------------------ADC采樣----------------------//
  138.        ADXYZ[0] =ADC12MEM0;//AX
  139.        ADXYZ[1]=ADC12MEM1;//AY
  140.        ADXYZ[2]=ADC12MEM2;//AZ
  141.        //----------------------------------------------開機求平均值判斷放置位置----------------------//
  142.        if(avxyz==0)
  143.        {  
  144.            counter=counter+1;
  145.            totalxyz[0]=totalxyz[0]+ADXYZ[0];
  146.            totalxyz[1]=totalxyz[1]+ADXYZ[1];
  147.            totalxyz[2]=totalxyz[2]+ADXYZ[2];
  148.            if(counter>=40)
  149.            {
  150.               counter=0;
  151.               counterx=0;
  152.               countery=0;
  153.               counterz=0;
  154.               averagexyz[0]= (int)(totalxyz[0]/40);
  155.               averagexyz[1]= (int)(totalxyz[1]/40);
  156.               averagexyz[2]= (int)(totalxyz[2]/40);
  157.               totalxyz[0]=0;
  158.               totalxyz[1]=0;
  159.               totalxyz[2]=0;
  160.               avxyz=1;
  161.       //----------------------------------------------x方向為垂直位置----------------------//
  162.               if (( averagexyz[0]>= averagexyz[1])&&( averagexyz[0]>= averagexyz[2])&& (averagexyz[0]>3500))
  163.               {
  164.                 counterx=1;
  165.                 countery=0;
  166.                 counterz=0;
  167.               }
  168.               else if (( averagexyz[0]<= averagexyz[1])&&( averagexyz[0]<= averagexyz[2])&& (averagexyz[0]<1800))
  169.               {
  170.                 counterx=1;
  171.                 countery=0;
  172.                 counterz=0;
  173.               }
  174.                //----------------------------------------------y方向為垂直位置----------------------//
  175.              else if (( averagexyz[1]>= averagexyz[0])&&( averagexyz[1]>= averagexyz[2])&& (averagexyz[1]>3500))
  176.               {
  177.                 counterx=0;
  178.                 countery=1;
  179.                 counterz=0;
  180.               }
  181.               else if(( averagexyz[1]<= averagexyz[0])&&( averagexyz[1]<= averagexyz[2])&& (averagexyz[1]<1800))
  182.               {
  183.                 counterx=0;
  184.                 countery=1;
  185.                 counterz=0;
  186.               }
  187.                //----------------------------------------------z方向為垂直位置----------------------//
  188.               else if (( averagexyz[2]>= averagexyz[0])&&( averagexyz[2]>= averagexyz[1])&& (averagexyz[2]>3500))
  189.               {
  190.                 counterx=0;
  191.                 countery=0;
  192.                 counterz=1;
  193.               }
  194.               else if (( averagexyz[2]<= averagexyz[0])&&( averagexyz[2]<= averagexyz[1])&& (averagexyz[2]<1800))
  195.               {
  196.                 counterx=0;
  197.                 countery=0;
  198.                 counterz=1;
  199.               }
  200.               //----------------------------------------------未能確定方向重現找----------------------//
  201.               else
  202.               {
  203.                 avxyz=0;
  204.               }
  205.            }
  206.            
  207.        }
  208.         //----------------------------------------------加速度濾波----------------------//
  209.        if(avxyz==1)
  210.        {
  211.                 for(jtemp=X_CHANNEL;jtemp<=Z_CHANNEL;jtemp++)
  212.                 {
  213.                         _array4[jtemp]=_array3[jtemp];
  214.                         _array3[jtemp]=_array2[jtemp];
  215.                         _array2[jtemp]=_array1[jtemp];
  216.                         _array1[jtemp]=_array0[jtemp];
  217.                        
  218.                        _array0[jtemp]= ADXYZ[jtemp];
  219.                        _adresult[jtemp]=_array0[jtemp]+_array1[jtemp]+_array2[jtemp]+_array3[jtemp]+_array4[jtemp];
  220.                        _adresult[jtemp]=_adresult[jtemp]/5;
  221.                
  222.                         if (_adresult[jtemp]>_max[jtemp])               {_max[jtemp]=_adresult[jtemp];}
  223.                         if (_adresult[jtemp]<_min[jtemp])               {_min[jtemp]=_adresult[jtemp];}
  224.                 }
  225.                
  226.               sampling_counter=sampling_counter+1;
  227.         Interval=Interval+1;
  228.        
  229.                 //----------------------------------計算動態門限和動態精度-----------------------//
  230.         if (sampling_counter==50)
  231.           {               
  232.           sampling_counter=0;
  233.                                
  234.           for(jtemp=X_CHANNEL;jtemp<=Z_CHANNEL;jtemp++)
  235.                 {
  236.                 _vpp[jtemp]=_max[jtemp]-_min[jtemp];
  237.                                    _dc[jtemp]=_min[jtemp]+_vpp[jtemp]/2;
  238.                                _max[jtemp]=0;
  239.                                    _min[jtemp]=5000;
  240.                                 _bad_flag[jtemp]=0;

  242.                                 if (_vpp[jtemp]>=1000)
  243.                                      {
  244.                                         TIMEWINDOW_MIN =20;
  245.                                         TIMEWINDOW_MAX =60;
  246.                                         _precision[jtemp]=40;
  247.                                       }
  248.                                     else if ((_vpp[jtemp]>=400)&& (_vpp[jtemp]<1000))            
  249.                                       {
  250.                                         TIMEWINDOW_MIN =25;
  251.                                         TIMEWINDOW_MAX =70;
  252.                                         _precision[jtemp]=20;
  253.                                        }
  254.                                   else if ((_vpp[jtemp]>=200) && (_vpp[jtemp]<400))  
  255.                                      {
  256.                                        TIMEWINDOW_MIN =35;
  257.                                        TIMEWINDOW_MAX =80;
  258.                                         _precision[jtemp]=10;
  259.                                      }  
  260.                        
  261.                                 else
  262.                                    {
  263.                                        _precision[jtemp]=2;
  264.                                  _bad_flag[jtemp]=1;
  265.                                      }

  267.                         }
  268.               }
  269.                
  270.                 //--------------------------線性移位寄存器--------------------------------------//

  272.                 for(jtemp=X_CHANNEL;jtemp<=Z_CHANNEL;jtemp++)
  273.                 {
  274.                         _old_fixed[jtemp]=_new_fixed[jtemp];

  276.                    if (_adresult[jtemp]>=_new_fixed[jtemp])                        
  277.                       {   
  278.                          if((_adresult[jtemp]-_new_fixed[jtemp])>=_precision[jtemp])                  
  279.                         _new_fixed[jtemp]=_adresult[jtemp];
  280.                       }
  281.                   if (_adresult[jtemp]<_new_fixed[jtemp])
  282.                              {   
  283.                            if((_new_fixed[jtemp]-_adresult[jtemp])>=_precision[jtemp])                  
  284.                         _new_fixed[jtemp]=_adresult[jtemp];
  285.                       }
  286.                 }

  288.                 //------------------------- 動態門限判決 ----------------------------------
  289.       
  290.                 if(counterx==1)
  291.                 {
  292.                   if ((_old_fixed[X_CHANNEL]>=_dc[X_CHANNEL])&&(_new_fixed[X_CHANNEL]<_dc[X_CHANNEL])&&(_bad_flag[X_CHANNEL]==0))        
  293.                    {
  294.                                    if((Interval>=TIMEWINDOW_MIN)&&(Interval<=TIMEWINDOW_MAX))        //如果時間間隔在有效的時間窗內
  295.                                         {
  296.                                           if(ReReg==1)                                        //如果還沒有找到規律
  297.                                            {            
  298.                                                 TempSteps++;                                        //記步緩存加1
  299.                                               if(TempSteps>=REGULATION)                               //如果記步緩存達到所要求的規律數
  300.                                              {
  301.                                                   ReReg=0;                                //已經找到規律
  302.                                                   STEPS=STEPS+TempSteps;        //更新顯示
  303.                                                   TempSteps=0;
  304.                                                }
  305.                                               Interval=0;
  306.                                             }
  307.                                          else if(ReReg==0)                                //如果已經找到規律，直接更新顯示
  308.                                           {
  309.                                               STEPS++;
  310.                                               TempSteps=0;
  311.                                               Interval=0;
  312.                                             }
  313.                                        }  
  314.                
  315.                                    else if(Interval>TIMEWINDOW_MAX)        //如果時間間隔大于時間窗上限，記步已經間斷，重新尋找規律
  316.                                    {
  317.                                          
  318.                                             InvalidSteps=0;       
  319.                                             ReReg=1;
  320.                                             TempSteps=1;
  321.                                             Interval=0;
  322.                                             
  323.                                             
  324.                        
  325.                                           }
  326.                                      
  327.                                
  328.                        }
  329.                 }
  330.         
  331.         if(countery==1)
  332.         {
  333.           if ((_old_fixed[Y_CHANNEL]>=_dc[Y_CHANNEL])&&(_new_fixed[Y_CHANNEL]<_dc[Y_CHANNEL])&&(_bad_flag[Y_CHANNEL]==0))        
  334.               {
  335.                
  336.                        if((Interval>=TIMEWINDOW_MIN)&&(Interval<=TIMEWINDOW_MAX))        //如果時間間隔在有效的時間窗內
  337.                                         {
  338.                                           if(ReReg==1)                                        //如果還沒有找到規律
  339.                                            {            
  340.                                                 TempSteps++;                                        //記步緩存加1
  341.                                               if(TempSteps>=REGULATION)                               //如果記步緩存達到所要求的規律數
  342.                                              {
  343.                                                   ReReg=0;                                //已經找到規律
  344.                                                   STEPS=STEPS+TempSteps;        //更新顯示
  345.                                                   TempSteps=0;
  346.                                                }
  347.                                               Interval=0;
  348.                                             }
  349.                                          else if(ReReg==0)                                //如果已經找到規律，直接更新顯示
  350.                                           {
  351.                                               STEPS++;
  352.                                               TempSteps=0;
  353.                                               Interval=0;
  354.                                             }
  355.                                        }  
  356.                
  357.                                    else if(Interval>TIMEWINDOW_MAX)        //如果時間間隔大于時間窗上限，記步已經間斷，重新尋找規律
  358.                                    {
  359.                                             InvalidSteps=0;       
  360.                                             ReReg=1;
  361.                                             TempSteps=1;
  362.                                             Interval=0;
  363.                                             
  364.                        
  365.                                       }
  366.                                      
  367.                                
  368.                         }
  369.                 }
  370.         if(counterz==1)
  371.         {
  372.           if ((_old_fixed[Z_CHANNEL]>=_dc[Z_CHANNEL])&&(_new_fixed[Z_CHANNEL]<_dc[Z_CHANNEL])&&(_bad_flag[Z_CHANNEL]==0))        
  373.                {
  374.                        
  375.                                    if((Interval>=TIMEWINDOW_MIN)&&(Interval<=TIMEWINDOW_MAX))        //如果時間間隔在有效的時間窗內
  376.                                         {
  377.                                           if(ReReg==1)                                        //如果還沒有找到規律
  378.                                            {            
  379.                                                 TempSteps++;                                        //記步緩存加1
  380. ……………………

  382. …………限于本文篇幅 余下代碼請從51黑下載附件…………
復制代碼

所有資料51hei提供下載:
ADXL重力加速度傳感器實現計步器程序(利用MSP430F135實現).zip (120.55 KB, 下載次數: 35)





分享到:  QQ好友和群QQ好友和群 QQ空間QQ空間 騰訊微博騰訊微博 騰訊朋友騰訊朋友
收藏收藏3 分享淘帖 頂頂 踩踩
回復

使用道具 舉報

您需要登錄后才可以回帖 登錄 | 立即注冊

本版積分規則

手機版|小黑屋|51黑電子論壇 |51黑電子論壇6群 QQ 管理員QQ:125739409;技術交流QQ群281945664

Powered by 單片機教程網

快速回復 返回頂部 返回列表
主站蜘蛛池模板： 日本三级电影在线免费观看 | 日韩av在线一区 | 成人亚洲网站 | 国产精品国产精品国产专区不蜜 | 91精品久久久久久久久中文字幕 | 日本aⅴ中文字幕 | 亚州一区二区三区 | 91精品久久久久久久久中文字幕 | 欧美中文字幕在线 | 亚洲一区二区三区在线视频 | 国产一区 在线视频 | 精品欧美一区二区精品久久久 | 蜜桃视频在线观看www社区 | 亚洲精品福利视频 | 男女黄网站 | 狠狠干av | 免费av一区二区三区 | 伊人色综合久久久天天蜜桃 | 91成人在线 | 中国美女撒尿txxxxx视频 | 日韩久久久一区二区 | 日韩免费一级 | 亚洲免费影院 | 精品久久久久香蕉网 | 人人九九精 | 天天操天天插天天干 | 亚洲精品片 | 2019天天干夜夜操 | 一区二区三区欧美在线观看 | 欧美成人精品一区二区男人看 | 亚洲精品在线免费播放 | 国产综合在线视频 | 中文字幕免费 | 国户精品久久久久久久久久久不卡 | 999久久久久久久久 国产欧美在线观看 | 亚洲精品自拍视频 | 日韩一区二区久久 | 欧美一区二区在线看 | 久久黄色 | 国产精品污www一区二区三区 | av永久免费 |