ADXL345是怎么來計算步數和判斷運動狀態的?

ID:890746 · 發表于 2021-6-7 21:38

ADXL345模塊做計步器，找到了一段程序但是看不太懂，有大佬教教我，ADXL345是怎么來計算步數和判斷運動狀態的啊......
#include<reg52.h>
#include<stdio.h>
#include "delay.h"
#include "math.h"
#include "adxl345.h"
#include "1602.h"

sbit led=P1^4;       //引腳定義

unsigned char ReadAdxl345;                //定時讀取adxl345
char dis0[16];                //串口數據顯示
xdata char dis1[16];                //串口數據顯示
xdata char dis2[16];                //串口數據顯示
unsigned long time_20ms=0;          //定時器計數
unsigned char ReportFlag=0;          //數據上報標志

unsigned int BuShu=0;       //累計步數
float JuLi=0;                      //累計距離
float KaLuLi=0;                      //累計卡路里
unsigned char statFlag = 0;//狀態
void Init_Timer0(void);                //函數聲明
void SendStr(unsigned char *s，unsigned char length);
void UART_Init(void);
void SendByte(unsigned char dat);
void BuShuCheck(void);

void main (void)
{
      Init_Timer0();       //定時器0初始化
      UART_Init();

      LCD_Init();          //初始化液晶
      DelayMs(20);       //延時有助于穩定
      LCD_Clear();

      Init_ADXL345();       //清屏
      if(Single_Read_ADXL345(0X00)==0xe5)       //讀出的數據為0XE5，表示正確
      {
            DelayMs(5);
      }
      else
      {
            DelayMs(3);
      }
      led=1;
      while (1)       //主循環
      {
         if(ReadAdxl345==1) //定時讀取adxl345數據
         {
                     BuShuCheck();                      //檢測步數

                     sprintf(dis1，"B:%04d J:%4.1fm "，BuShu/2，JuLi);       //打印
                     LCD_Write_String(0，0，dis1);//顯示
                     sprintf(dis2，"%7.2fcal "，KaLuLi);                //打印
                     LCD_Write_String(0，1，dis2);//顯示

                     if(statFlag == 0)//站著狀態
                     {LCD_Write_String(11，1，"Stand");}
                     else if(statFlag == 1)////躺著狀態
                     {LCD_Write_String(11，1，"Lie  ");}
                     else if(statFlag == 2)//跑著狀態
                     {LCD_Write_String(11，1，"Run  ");}
                     else if(statFlag == 3)//走著狀態
                     {LCD_Write_String(11，1，"Walk ");}
            }

            if(ReportFlag==1)       //2s
            {
                     ReportFlag=0;
                     sprintf(dis0，"*B:%04d"，BuShu/2);       //上報步數
                     SendStr(dis0，7);
                     sprintf(dis0，"J:%04.1fm"，JuLi);                      //上報距離
                     SendStr(dis0，7);
                     sprintf(dis0，"K:%07.2fcal"，KaLuLi);                //上報卡路里
                     SendStr(dis0，12);

                     if(statFlag == 0)//站著狀態
                     {SendStr("Stand#"，6);}
                     else if(statFlag == 1)////躺著狀態
                     {SendStr("Lie  #"，6);}
                     else if(statFlag == 2)//跑著狀態
                     {SendStr("Run  #"，6);}
                     else if(statFlag == 3)//走著狀態
                     {SendStr("Walk #"，6);}
                     SendStr("\r\n"，2);
            }
      }
}

void BuShuCheck(void)
{
      static unsigned char ErrorNum=0;          //變量定義
      static unsigned char NormalNum=0;

      static unsigned char CheckNum=0;          //變量定義
      static unsigned char shuNum=0;
      static unsigned char ceNum=0;
      static unsigned int remBuShu=0;
      ReadAdxl345=0;
      ReadData_x();
      CheckNum++;//檢測次數
      if((temp_X<650)||(abs(temp_Y)>400))    //查看正常次數
      {
            led=0;                      //呼吸燈
            ErrorNum++;       //記錄次數
            shuNum++;//豎直狀態++
      }
      else
      {NormalNum++; ceNum++;led=1;} //呼吸燈//側著狀態++

      if((NormalNum!=0)&&(ErrorNum!=0))       //                      從角度判斷走了一步
      {
            ErrorNum=0;
            NormalNum=0;
            BuShu++;
            JuLi=(float)(BuShu/2)*0.45;       //計算距離
            KaLuLi=JuLi*70*0.832;                //卡路里計算走路距離*體重*系數
      }

      if(CheckNum>=20)
      {

            if((ceNum!=0)&&(shuNum==0))
            {
                     statFlag = 0;//站著狀態
            }
            else if((ceNum==0)&&(shuNum!=0))
            {
                     statFlag = 1;//躺著狀態
            }
            else if((ceNum!=0)&&(shuNum!=0))
            {
                     if((BuShu - remBuShu)>=6)//跑著一個周期大于3步
                     {statFlag = 2;}//跑著狀態
                     else
                     {statFlag = 3;}//走著狀態
                     remBuShu = BuShu;//記錄上次步數
            }
            CheckNum=0;
            ceNum=0;             //清空計數
            shuNum=0;
      }
}
void Init_Timer0(void)
{
      TMOD |= 0x01;       //使用模式1，16位定時器，使用"|"符號可以在使用多個定時器時不受影響
      TH0=(65536-20000)/256;                //重新賦值 20ms
      TL0=(65536-20000)%256;
      EA=1;          //總中斷打開
      ET0=1;          //定時器中斷打開
      TR0=1;          //定時器開關打開
}

void Timer0_isr(void) interrupt 1
{
      TH0=(65536-20000)/256;                //重新賦值 20ms
      TL0=(65536-20000)%256;

      time_20ms++;
      if(time_20ms%5==0)
      {
            ReadAdxl345=1;
      }
      if(time_20ms%50==0)
      {
            ReportFlag=1;
      }
}

帳號		自動登錄	找回密碼
密碼			立即注冊

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

ADXL345是怎么來計算步數和判斷運動狀態的?