久久99热狠狠色精品一区,亚洲精品乱码久久久久久蜜桃,久久久久久人妻无码

GSensor的角度計(jì)算

目前負(fù)責(zé)關(guān)于GSensor的模式識(shí)別，這里貼出自己的研究成果，供自己備忘。

ACCEL_DIRECTION CGSensorModule::CalDirection(smb380acc_t& a_xyz,const unsigned char nAccelRange, double* pdbAngle)

{

ACCEL_DIRECTION adNew = AD_UNKNOWN;

double dbAngle = 0;

// expressions: tan(angle) = a_xyz.x / a_xyz.y

// angle is start from AD_LAYRIGHT

// notice: 1. a_xyz.x and a_xyz.y should not be small together, so we need to give a liminal value

// 2. the a_xyz.z should be enough small to ensure the G-Sensor is vertical,

// the degree is 45, means abs(a_xyz.z) should not larger than nAccelRange*sin(45)

if((abs(a_xyz.x) < nAccelRange/10)

&& (abs(a_xyz.y) < nAccelRange/10)

|| abs(a_xyz.z) > (nAccelRange*0.707))

{

dbAngle = nAccelRange;

return AD_UNKNOWN;

}

float fTanValue = float(a_xyz.y)/float(a_xyz.x);

dbAngle = atan(fTanValue);

// AD_LAYRIGHT or AD_LAYLEFT

if(fTanValue>-1 && fTanValue<1)

{

if(a_xyz.x>0)

{

adNew = AD_LAYRIGHT;

}

else

{

dbAngle += PI;

adNew = AD_LAYLEFT;

}

else

{

if(a_xyz.y>0)

{

if (dbAngle<0)

dbAngle += PI;

adNew = AD_LAYUP;

}

else

{

if (dbAngle>0)

dbAngle -= PI;

adNew = AD_LAYDOWN;

}

if(dbAngle<0)

dbAngle+=(PI*2);

if(pdbAngle != NULL)

*pdbAngle = dbAngle;

return adNew;

}

BOOL CGSensorModule::GetDirection(ACCEL_DIRECTION& adNew, double* pdbAngle)

{

CHECK_GSENSOR_HANDLE();

smb380acc_t a_xyz;

unsigned char nRange;

if(!GetAccelXYZT(a_xyz))

{

return FALSE;

}

if(!GetRange(nRange))

{

return FALSE;

}

adNew = CalDirection(a_xyz,MAX_ACCELRANGE/(2<<nRange),pdbAngle);

return TRUE;

}

posted on 2008-05-26 11:37 迷宮の未來(lái) 閱讀(4040) 評(píng)論(4) 編輯收藏引用

評(píng)論

# re: GSensor的角度計(jì)算 2009-01-08 14:04 elle

G-Sensor的型號(hào)是多少？回復(fù) 更多評(píng)論

只有注冊(cè)用戶(hù)登錄后才能發(fā)表評(píng)論。
【推薦】100%開(kāi)源！大型工業(yè)跨平臺(tái)軟件C++源碼提供，建模，組態(tài)！



網(wǎng)站導(dǎo)航: 博客園 IT新聞 BlogJava 博問(wèn) Chat2DB 管理

# re: GSensor的角度計(jì)算 2009-01-08 14:04 elle

# re: GSensor的角度計(jì)算 2009-04-13 09:23 游客

# re: GSensor的角度計(jì)算 2009-06-10 11:02 ytm

# re: GSensor的角度計(jì)算 2009-06-29 09:42 調(diào)試gsensor

GSensor的角度計(jì)算

評(píng)論

導(dǎo)航

統(tǒng)計(jì)

常用鏈接

留言簿(10)

隨筆檔案

文章檔案

最新隨筆

搜索

積分與排名

最新隨筆

最新評(píng)論

閱讀排行榜

評(píng)論排行榜