這是我對陀螺儀數值得一些處理。數值讀取出來后要怎么用才能根據角度對直流電機進行加速??
菜鳥,求詳細一點(額,我再網上找不到)
//****************************************
//整數轉字符串
//****************************************
void lcd_printf(uchar *s,int temp_data)
{
if(temp_data<0)
{
temp_data=-temp_data;
*s='-';
}
else *s=' ';
*++s =temp_data/100+0x30;
temp_data=temp_data%100; //取余運算
*++s =temp_data/10+0x30;
temp_data=temp_data%10; //取余運算
*++s =temp_data+0x30;
}
void Display10BitData(int value) //這是一種讓陀螺儀取得的數值以十進制形式顯示在液晶屏上的方法?/
{
value/=64; //轉換為10位數據
lcd_printf(dis, value); //轉換數據顯示
lcd_set(dis);
}
void xianshi()
{
send_command(0x91); Display10BitData(Acc_X); //顯示X軸加速度
send_command(0x89); Display10BitData(Acc_Y);
send_command(0x99); Display10BitData(Acc_Z);
send_command(0x94); Display10BitData(Gyr_X); //顯示X軸角速度
send_command(0x8c); Display10BitData(Gyr_Y);
send_command(0x9c); Display10BitData(Gyr_Z);
}
|