以下是一個基于三軸加速度傳感的算法來判定狀態的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);//打開傳感并設置取樣率(fd,,0x08);//設置檢測范圍為+/-8g//初始化前個樣本的加速度值float[];float[];float[];for(inti=0;i<;i++){intx=(fd,);inty=(fd,);intz=(fd,);//將讀取到的原始數據轉換為實際加速度值[i]=(float)x/1024.0;[i]=(float)y/1024.0;[i]=(float)z/1024.0;(/);//等待一段時間，以達到取樣率}//初始化狀態enumStatestate=IDLE;while(1){//讀取最新的加速度值intx=(fd,);inty=(fd,);intz=(fd,);//將讀取到的原始數據轉換為實際加速度值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]);}/=;/=;/=;//按照加速度變化值判別狀態(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;}```該代碼使用了和上面類似的方法來讀取三軸加速度傳感的數據，并按照加速度變化的情況來判定狀態。
具體地，依照閥值來判定加速度是否變化，依照窗口大小來估算加速度變化值，之后按照加速度變化值的大小來判定狀態。假如加速度變化超過閥值且當前狀態為IDLE，則步入狀態；假如加速度變化超過閥值且當前狀態為，則保持狀態；假如加速度變化沒有超過閥值且當前狀態為，則步入狀態；假如加速度變化超過閥值且當前狀態為加速度三個基本公式圖片，則保持狀態；假如加速度在Z軸方向上超過閥值且當前狀態為，則回到IDLE狀態。注意，須要依照具體的傳感機型和配置更改代碼中的地址和寄存器值加速度三個基本公式圖片，以及閥值、采樣率和窗口大小的大小。