久久天天躁狠狠躁夜夜躁,国产精品入口福利,97久久精品人人爽人人爽蜜臀 ,中文字幕国产精品一区二区

   

當前位置首頁 > 實驗視頻

六軸運動傳感器的加速度、角速度和傾斜角度

更新時間:2025-01-01

下載地址

免費下載!

[!--downpath--]

資源介紹

一、簡介oUH物理好資源網(wǎng)(原物理ok網(wǎng))

根據(jù)六軸運動傳感的原始數(shù)據(jù),估算設備當前狀態(tài)的加速度、角速率和傾斜角度。本項目的主控芯片是(SDK:SDK17.0.2.),但算法通用,讀取原始數(shù)據(jù)的完整工程來自艾克姆,已上傳個人主頁。oUH物理好資源網(wǎng)(原物理ok網(wǎng))

二、初始化和寄存器配置oUH物理好資源網(wǎng)(原物理ok網(wǎng))

通常在喚起之前就會用MCU讀一下設備地址以監(jiān)測設備以及通訊是否正常:oUH物理好資源網(wǎng)(原物理ok網(wǎng))

// !< WHO_AM_I register identifies the device. Expected value is 0x68.
#define ADDRESS_WHO_AM_I          (0x75U) 
bool mpu6050_verify_product_id(void)
{
    uint8_t who_am_i;
    if (mpu6050_register_read(ADDRESS_WHO_AM_I, &who_am_i, 1))
    {
        if (who_am_i != MPU6050_WHO_AM_I)
        {
            return false;
        }
        else
        {
            return true;
        }
    }
    else
    {
        return false;
    }
}
oUH物理好資源網(wǎng)(原物理ok網(wǎng))

上述函數(shù)返回true后加速度的五個公式,才可以開始配置寄存器初始化:oUH物理好資源網(wǎng)(原物理ok網(wǎng))

#define MPU_PWR_MGMT1_REG		  0x6B	//電源管理寄存器1
#define MPU_SAMPLE_RATE_REG		  0x19	//采樣頻率分頻器
#define MPU_CFG_REG				  0x1A	//配置寄存器
#define MPU_INT_EN_REG			  0x38	//中斷使能寄存器
#define MPU_GYRO_CFG_REG		  0x1B	//陀螺儀配置寄存器
#define MPU_ACCEL_CFG_REG		  0x1C	//加速度計配置寄存器
//喚醒MPU6050
(void)mpu6050_register_write(MPU_PWR_MGMT1_REG , 0x00); 
  
//設置采樣率(Sample Rate = Gyroscope Output Rate / (1 + SMPLRT_DIV)):1KHz 
(void)mpu6050_register_write(MPU_SAMPLE_RATE_REG , 0x07);
//設置低通濾波器,截止頻率是1K,帶寬是5K 
(void)mpu6050_register_write(MPU_CFG_REG , 0x06); 
//關(guān)閉中斷							
(void)mpu6050_register_write(MPU_INT_EN_REG, 0x00); 	
//陀螺儀自檢及測量范圍,典型值:0x18(不自檢,2000deg/s)
(void)mpu6050_register_write(MPU_GYRO_CFG_REG , 0x18); 
//配置加速度傳感器量程 +-2G s,不自檢 
(void)mpu6050_register_write(MPU_ACCEL_CFG_REG,0x00); 
oUH物理好資源網(wǎng)(原物理ok網(wǎng))

三、加速度、角速率估算公式1.加速度oUH物理好資源網(wǎng)(原物理ok網(wǎng))

某個軸的加速度a=Range*G*ACC/32768.其中G是當?shù)刂亓铀俣龋珹CC是該軸的加速度原始數(shù)據(jù),Range是由配置加速度阻值時寫入的參數(shù)決定的,關(guān)系如下:oUH物理好資源網(wǎng)(原物理ok網(wǎng))

按照初始化時寫入的數(shù)據(jù),不自檢,=00=0,這兒Range=2:oUH物理好資源網(wǎng)(原物理ok網(wǎng))

//配置加速度傳感器量程 +-2G s,不自檢 
(void)mpu6050_register_write(MPU_ACCEL_CFG_REG,0x00); 
oUH物理好資源網(wǎng)(原物理ok網(wǎng))

2.角速率oUH物理好資源網(wǎng)(原物理ok網(wǎng))

某個軸的角速率g=Range*Gyro/32768.Gyro是這個軸的角速率原始數(shù)據(jù),Range是由配置角速率阻值時寫入的參數(shù)決定的,關(guān)系如下:oUH物理好資源網(wǎng)(原物理ok網(wǎng))

按照初始化時寫入的數(shù)據(jù),不自檢,=11=3,這兒Range=2000:oUH物理好資源網(wǎng)(原物理ok網(wǎng))

//陀螺儀自檢及測量范圍,典型值:0x18(不自檢,2000deg/s)
(void)mpu6050_register_write(MPU_GYRO_CFG_REG , 0x18);
oUH物理好資源網(wǎng)(原物理ok網(wǎng))

四、傾斜角度公式oUH物理好資源網(wǎng)(原物理ok網(wǎng))

傾斜角度根據(jù)加速度原始數(shù)據(jù)估算,公式如下:oUH物理好資源網(wǎng)(原物理ok網(wǎng))

#define x                         0
#define z                         1
	
Angle[x] = atan2(AccValue.X, AccValue.Y)*180/3.14f;
Angle[z] = atan2(AccValue.Z, AccValue.Y)*180/3.14f;
oUH物理好資源網(wǎng)(原物理ok網(wǎng))

該公式適用的初始姿態(tài)是豎直的,也就是的Y軸豎直向下時是初始狀態(tài)加速度的五個公式,此時的角度為0。Angle[x]是x軸與豎直平面的傾角度數(shù),Angle[z]是z軸與水平平面的傾角度數(shù)。oUH物理好資源網(wǎng)(原物理ok網(wǎng))

參考:(16條消息)關(guān)于的數(shù)據(jù)獲取、分析與處理的博客-CSDN博客讀取oUH物理好資源網(wǎng)(原物理ok網(wǎng))

發(fā)表評論

最新列表

最熱列表

統(tǒng)計代碼放這里
主站蜘蛛池模板: 富川| 武宁县| 东乌珠穆沁旗| 府谷县| 治多县| 荣昌县| 昆明市| 尼勒克县| 五峰| 屏山县| 射阳县| 石城县| 嵊州市| 玛沁县| 炎陵县| 南投县| 宜良县| 鄂伦春自治旗| 固原市| 南昌县| 北海市| 汽车| 平安县| 五台县| 家居| 衡东县| 大同县| 景谷| 大邑县| 克东县| 林西县| 玉溪市| 宜州市| 姚安县| 巴林右旗| 建阳市| 工布江达县| 江陵县| 苍溪县| 巴塘县| 湘阴县|