免費下載！
[!--downpath--]以下是一個基于三軸加速度傳感的算法來判定狀態(tài)的C代碼：```c######0x18#0x20#0x23#0x28#0x2A#0x2C#1.0//加速度變化閥值#100//取樣率（Hz）#10//窗口大?。▊€樣本）enumState{IDLE,,};intmain(void){intfd=();if(fd==-1){("toI2C.n");exit(1);}//配置傳感(fd,,0x77);//打開傳感并設(shè)置取樣率(fd,,0x08);//設(shè)置檢測范圍為+/-8g//初始化前個樣本的加速度值float[];float[];float[];for(inti=0;i<;i++){intx=(fd,);inty=(fd,);intz=(fd,);//將讀取到的原始數(shù)據(jù)轉(zhuǎn)換為實際加速度值[i]=(float)x/1024.0;[i]=(float)y/1024.0;[i]=(float)z/1024.0;(/);//等待一段時間，以達到取樣率}//初始化狀態(tài)enumStatestate=IDLE;while(1){//讀取最新的加速度值intx=(fd,);inty=(fd,);intz=(fd,);//將讀取到的原始數(shù)據(jù)轉(zhuǎn)換為實際加速度值float=(float)x/1024.0;float=(float)y/1024.0;float=(float)z/1024.0;//估算加速度變化值float=0;float=0;float=0;for(inti=0;i<;i++){+=abs(-[i]);+=abs(-[i]);+=abs(-[i]);}/=;/=;/=;//按照加速度變化值判別狀態(tài)(state){caseIDLE:if(>||>||>){state=;("State:n");}break;case:if(>||>||>){state=;}else{state=;("State:n");}break;case:if(>){state=IDLE;("State:IDLEn");}break;}//更新前個樣本的加速度值for(inti=-1;i>0;i--){[i]=[i-1];[i]=[i-1];[i]=[i-1];}[0]=;[0]=;[0]=;//等待一段時間，以達到取樣率(/);}0;}```該代碼使用了和上面類似的方法來讀取三軸加速度傳感的數(shù)據(jù)，并按照加速度變化的情況來判定狀態(tài)。
具體地，依照閥值來判定加速度是否變化，依照窗口大小來估算加速度變化值，之后按照加速度變化值的大小來判定狀態(tài)。假如加速度變化超過閥值且當(dāng)前狀態(tài)為IDLE，則步入狀態(tài)；假如加速度變化超過閥值且當(dāng)前狀態(tài)為，則保持狀態(tài)；假如加速度變化沒有超過閥值且當(dāng)前狀態(tài)為，則步入狀態(tài)；假如加速度變化超過閥值且當(dāng)前狀態(tài)為加速度三個基本公式圖片，則保持狀態(tài)；假如加速度在Z軸方向上超過閥值且當(dāng)前狀態(tài)為，則回到IDLE狀態(tài)。注意，須要依照具體的傳感機型和配置更改代碼中的地址和寄存器值加速度三個基本公式圖片，以及閥值、采樣率和窗口大小的大小。
