已經(jīng)有很多大佬介紹過(guò)了MPU6050的協(xié)議、數(shù)據(jù)處理方式、濾波算法,所以這部分就不再?gòu)?fù)述了,本篇主要是針對(duì)看不懂長(zhǎng)篇大論的小白的簡(jiǎn)易上手的方法。
首先呢還是得簡(jiǎn)單介紹下什么是陀螺儀:

MPU-60X0是世界上第一款集成 6 軸MotionTracking設(shè)備。它集成了3軸MEMS陀螺儀,3軸MEMS加速度計(jì),以及一個(gè)可擴(kuò)展的數(shù)字運(yùn)動(dòng)處理器 DMP( DigitalMotion Processor),可用I2C接口連接一個(gè)第三方的數(shù)字傳感器,比如磁力計(jì)。
那么本篇文章呢,主要介紹通過(guò)復(fù)制粘貼的代碼可以實(shí)現(xiàn)對(duì)當(dāng)前角度的讀?。ㄜ浖蘒IC),檢測(cè)三軸方向上的角度,如上圖,假如該陀螺儀平放在水平面上,從側(cè)面看為一個(gè)線段,現(xiàn)取一個(gè)頂點(diǎn)(圓點(diǎn)),讓另一邊繞該點(diǎn)旋轉(zhuǎn),形成一個(gè)角度的示意圖,如下圖,這樣便呈現(xiàn)了一個(gè)角度,我們的單片機(jī)通過(guò)協(xié)議和處理方法,將這個(gè)角度讀取出來(lái)(-90-90°),當(dāng)換一個(gè)平面時(shí),相同的繞圓點(diǎn)旋轉(zhuǎn)便可以出現(xiàn)Y軸,

當(dāng)如果我們想讀取Z軸時(shí)(不常用),選擇的方式是以該平面的中心為圓點(diǎn)進(jìn)行旋轉(zhuǎn),可以得到一個(gè)角度值,該值通過(guò)本篇方法處理后有一定的偏差,常用的為X和Y軸

上面簡(jiǎn)單介紹了X、Y、Z軸讀取后的數(shù)據(jù)分別代碼什么內(nèi)容,下面來(lái)講解針對(duì)STM32平臺(tái)的代碼移植過(guò)程,本篇使用的方式為軟件IIC(通過(guò)IO的讀和寫來(lái)實(shí)現(xiàn)數(shù)據(jù)讀取,方便移植)
首先我們打開該工程的OLED_I2C.H文件(本文最下面附鏈,以STM32F1為例)
#define OLED_I2C I2C1
#define OLED_I2C_CLK RCC_APB1Periph_I2C1
#define OLED_I2C_CLK_INIT RCC_APB1PeriphClockCmd
#define OLED_I2C_SCL_PIN GPIO_Pin_6
#define OLED_I2C_SCL_GPIO_PORT GPIOB
#define OLED_I2C_SCL_GPIO_CLK RCC_AHB1Periph_GPIOB
#define OLED_I2C_SCL_SOURCE GPIO_PinSource6
#define OLED_I2C_SCL_AF GPIO_AF_I2C1
#define OLED_I2C_SDA_PIN GPIO_Pin_7
#define OLED_I2C_SDA_GPIO_PORT GPIOB
#define OLED_I2C_SDA_GPIO_CLK RCC_AHB1Periph_GPIOB
#define OLED_I2C_SDA_SOURCE GPIO_PinSource7
#define OLED_I2C_SDA_AF GPIO_AF_I2C1
void I2C_Configuration(void);
void I2C_WriteByte(uint8_t addr,uint8_t data);
void WriteCmd(unsigned char I2C_Command);
void WriteDat(unsigned char I2C_Data);
void OLED_Init(void);
void OLED_SetPos(unsigned char x, unsigned char y);
void OLED_Fill(unsigned char fill_Data);
void OLED_CLS(void);
void OLED_ON(void);
void OLED_OFF(void);
void OLED_ShowStr(unsigned char x, unsigned char y, unsigned char ch[], unsigned char TextSize);
void OLED_ShowCN(unsigned char x, unsigned char y, unsigned char N);
void OLED_DrawBMP(unsigned char x0,unsigned char y0,unsigned char x1,unsigned char y1,unsigned char BMP[]);
該頭文件部分對(duì)使用到的引腳進(jìn)行了聲明,例如該工程中使用到的SCL引腳為PB6,SDA引腳為PB7,同時(shí)我們看一下OLED_I2C.C中是如何使用這些內(nèi)容的
void I2C_Configuration(void)
{
I2C_InitTypeDef I2C_InitStructure;
GPIO_InitTypeDef GPIO_InitStructure;
OLED_I2C_CLK_INIT(OLED_I2C_CLK,ENABLE);
RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOB,ENABLE);
GPIO_InitStructure.GPIO_Pin = OLED_I2C_SCL_PIN;
GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
GPIO_InitStructure.GPIO_Mode = GPIO_Mode_AF_OD; // 開漏輸出
GPIO_Init(OLED_I2C_SCL_GPIO_PORT, &GPIO_InitStructure);
GPIO_InitStructure.GPIO_Pin = OLED_I2C_SDA_PIN;
GPIO_Init(OLED_I2C_SDA_GPIO_PORT, &GPIO_InitStructure);
I2C_InitStructure.I2C_Mode = I2C_Mode_I2C;
I2C_InitStructure.I2C_DutyCycle = I2C_DutyCycle_2;/* 高電平數(shù)據(jù)穩(wěn)定,低電平數(shù)據(jù)變化 SCL 時(shí)鐘線的占空比 */
I2C_InitStructure.I2C_OwnAddress1 = OLED_ADDRESS;//OLED的I2C地址
I2C_InitStructure.I2C_Ack = I2C_Ack_Enable;
I2C_InitStructure.I2C_AcknowledgedAddress = I2C_AcknowledgedAddress_7bit;/* I2C的尋址模式 */
I2C_InitStructure.I2C_ClockSpeed = I2C_Speed;
I2C_Init(I2C1, &I2C_InitStructure); /* I2C1 初始化 */
I2C_Cmd(I2C1, ENABLE); /* 使能 I2C1 */
}
發(fā)現(xiàn)在該C文件中使用到初始化的部分都是通過(guò)#define的值進(jìn)行調(diào)用的,所以??! 在本工程中只需要改動(dòng)OLED_I2C.H種的內(nèi)容就可以完全實(shí)現(xiàn)移植,兼容任何STM32的標(biāo)準(zhǔn)庫(kù)
說(shuō)完了移植代碼,下面看一下如何獲取數(shù)據(jù):
首先在main()函數(shù)里面需要有兩個(gè)初始化,
//I2C初始化
i2c_GPIO_Config();
//MPU6050初始化
MPU6050_Init();
while(MPU6050ReadID() == 0);
通過(guò)這兩個(gè)初始化和再次校驗(yàn),MPU6050的初始化就成功了,現(xiàn)在我們進(jìn)入數(shù)據(jù)讀取環(huán)節(jié)
/**
* @brief 讀取MPU6050的加速度數(shù)據(jù)
* @param
* @retval
*/
void MPU6050ReadAcc(short *accData)
{
u8 buf[6];
MPU6050_ReadData(MPU6050_ACC_OUT, buf, 6);
accData[0] = (buf[0] << 8) | buf[1];
accData[1] = (buf[2] << 8) | buf[3];
accData[2] = (buf[4] << 8) | buf[5];
}
/**
* @brief 讀取MPU6050的角加速度數(shù)據(jù)
* @param
* @retval
*/
void MPU6050ReadGyro(short *gyroData)
{
u8 buf[6];
MPU6050_ReadData(MPU6050_GYRO_OUT,buf,6);
gyroData[0] = (buf[0] << 8) | buf[1];
gyroData[1] = (buf[2] << 8) | buf[3];
gyroData[2] = (buf[4] << 8) | buf[5];
}
/**
* @brief 讀取MPU6050的原始溫度數(shù)據(jù)
* @param
* @retval
*/
void MPU6050ReadTemp(short *tempData)
{
u8 buf[2];
MPU6050_ReadData(MPU6050_RA_TEMP_OUT_H,buf,2); //讀取溫度值
*tempData = (buf[0] << 8) | buf[1];
}
所有的讀取數(shù)據(jù)都是通過(guò)這三個(gè)函數(shù)實(shí)現(xiàn)的,經(jīng)過(guò)上面的初始化后可以直接在主函數(shù)中進(jìn)行使用,我們這里用到的主要是MPU6050ReadGyro()函數(shù),函數(shù)內(nèi)封裝有數(shù)據(jù)轉(zhuǎn)換,可以直接得到角度值,此時(shí)我們先新建一個(gè)變量
新建一個(gè)成員為3的數(shù)組,方便一次性獲取X、Y、Z軸的數(shù)據(jù),使用方式為:
MPU6050ReadGyro(Gyro);
JD1[0]=abs(Gyro[0])/100+'0';
JD1[1]=abs(Gyro[0])/10%10+'0';
JD1[2]=abs(Gyro[0])%10+'0';
該語(yǔ)句是將X軸的角度數(shù)據(jù)轉(zhuǎn)換為字符串?dāng)?shù)據(jù),方便新手下面通過(guò)串口輸出數(shù)值進(jìn)行轉(zhuǎn)換
編輯:黃飛
-
陀螺儀
+關(guān)注
關(guān)注
44文章
847瀏覽量
100016 -
ST
+關(guān)注
關(guān)注
32文章
1176瀏覽量
130500 -
STM32
+關(guān)注
關(guān)注
2293文章
11032瀏覽量
364885 -
濾波算法
+關(guān)注
關(guān)注
2文章
90瀏覽量
13971 -
MPU6050
+關(guān)注
關(guān)注
39文章
310瀏覽量
73107
發(fā)布評(píng)論請(qǐng)先 登錄
我為什么要用陀螺儀MPU6050的理由,你有嗎?
什么是陀螺儀
陀螺儀MPU6050的相關(guān)資料推薦
基于戰(zhàn)艦V3的MPU6050六軸陀螺儀實(shí)驗(yàn)的相關(guān)資料分享
三軸陀螺儀MPU6050的測(cè)試程序免費(fèi)下載

使用MSP430單片機(jī)應(yīng)用MPU6050陀螺儀的程序免費(fèi)下載
MPU6050陀螺儀傳感器的電路原理圖免費(fèi)下載

MPU6050陀螺儀傳感器的資料合集免費(fèi)下載

MPU6050六軸陀螺儀傳感器實(shí)驗(yàn)的資料合集免費(fèi)下載

模塊介紹之六軸陀螺儀MPU6050篇(STM32基本使用)

【平衡小車制作】(四)陀螺儀MPU6050(超詳解)

STM32F407ZE開發(fā)板MPU6050陀螺儀的應(yīng)用

帶MPU6050的Arduino陀螺儀游戲

評(píng)論