MPU9250九轴传感器,在程序中,怎么初始化航向角(yaw)为0

2019-07-20 06:14发布

@原子哥,@各位大神。我想问一下,在阿波罗开发板、实验34 MPU9250九轴传感器实验里,初始化mpu_dmp_init()是怎样初始化航向角(yaw)为0的?
我想通过一个按键来初始化航向角为0可以吗?
谢谢!


[mw_shl_code=c,true]int main(void)
{

  /* USER CODE BEGIN 1 */

  /* USER CODE END 1 */

  /* MCU Configuration----------------------------------------------------------*/

  /* Reset of all peripherals, Initializes the Flash interface and the Systick. */
  HAL_Init();

  /* Configure the system clock */
  SystemClock_Config();

  /* Initialize all configured peripherals */
  MX_GPIO_Init();

  /* USER CODE BEGIN 2 */
        delay_init(180);        //初始化延时函数
        while(mpu_dmp_init()){}
  /* USER CODE END 2 */

  /* Infinite loop */
  while (1)
  {
                if(mpu_mpl_get_data(&pitch,&roll,&yaw)==0){
                        //temp=MPU_Get_Temperature();               //得到温度值
                        MPU_Get_Accelerometer(&aacx,&aacy,&aacz);        //得到加速度传感器数据
                        MPU_Get_Gyroscope(&gyrox,&gyroy,&gyroz);        //得到陀螺仪数据
                }
  }

}[/mw_shl_code]

[mw_shl_code=c,true]//mpu6050,dmp初始化
//返回值:0,正常
//    其他,失败
u8 mpu_dmp_init(void)
{
        u8 res=0;
    struct int_param_s int_param;
    unsigned char accel_fsr;
    unsigned short gyro_rate, gyro_fsr;
    unsigned short compass_fsr;
   
        IIC_Init();                         //初始化IIC总线
        if(mpu_init(&int_param)==0)        //初始化MPU9250
        {         
        res=inv_init_mpl();     //初始化MPL
        if(res)return 1;
        inv_enable_quaternion();
        inv_enable_9x_sensor_fusion();
        inv_enable_fast_nomot();
        inv_enable_gyro_tc();
        inv_enable_vector_compass_cal();
        inv_enable_magnetic_disturbance();
        inv_enable_eMPL_outputs();
        res=inv_start_mpl();    //开启MPL
        if(res)return 1;
                res=mpu_set_sensors(INV_XYZ_GYRO|INV_XYZ_ACCEL|INV_XYZ_COMPASS);//设置所需要的传感器
                if(res)return 2;
                res=mpu_configure_fifo(INV_XYZ_GYRO | INV_XYZ_ACCEL);   //设置FIFO
                if(res)return 3;
                res=mpu_set_sample_rate(DEFAULT_MPU_HZ);                    //设置采样率
                if(res)return 4;
        res=mpu_set_compass_sample_rate(1000/COMPASS_READ_MS);  //设置磁力计采样率
        if(res)return 5;
        mpu_get_sample_rate(&gyro_rate);
        mpu_get_gyro_fsr(&gyro_fsr);
        mpu_get_accel_fsr(&accel_fsr);
        mpu_get_compass_fsr(&compass_fsr);
        inv_set_gyro_sample_rate(1000000L/gyro_rate);
        inv_set_accel_sample_rate(1000000L/gyro_rate);
        inv_set_compass_sample_rate(COMPASS_READ_MS*1000L);
        inv_set_gyro_orientation_and_scale(
            inv_orientation_matrix_to_scalar(gyro_orientation),(long)gyro_fsr<<15);
        inv_set_accel_orientation_and_scale(
            inv_orientation_matrix_to_scalar(gyro_orientation),(long)accel_fsr<<15);
        inv_set_compass_orientation_and_scale(
            inv_orientation_matrix_to_scalar(comp_orientation),(long)compass_fsr<<15);
            
            
                res=dmp_load_motion_driver_firmware();                             //加载dmp固件
                if(res)return 6;
                res=dmp_set_orientation(inv_orientation_matrix_to_scalar(gyro_orientation));//设置陀螺仪方向
                if(res)return 7;
                res=dmp_enable_feature(DMP_FEATURE_6X_LP_QUAT|DMP_FEATURE_TAP|                    //设置dmp功能
                    DMP_FEATURE_ANDROID_ORIENT|DMP_FEATURE_SEND_RAW_ACCEL|DMP_FEATURE_SEND_CAL_GYRO|
                    DMP_FEATURE_GYRO_CAL);
                if(res)return 8;
                res=dmp_set_fifo_rate(DEFAULT_MPU_HZ);        //设置DMP输出速率(最大不超过200Hz)
                if(res)return 9;   
                res=run_self_test();                //自检
                if(res)return 10;   
                res=mpu_set_dmp_state(1);        //使能DMP
                if(res)return 11;     
        }
        return 0;
}[/mw_shl_code]



友情提示: 此问题已得到解决,问题已经关闭,关闭后问题禁止继续编辑,回答。
该问题目前已经被作者或者管理员关闭, 无法添加新回复
16条回答
airuoshahen
1楼-- · 2019-07-20 09:47
张眉拴 发表于 2017-5-9 11:18
不同方位初始化,yaw值都为0,如何确定东南西北方位;

兄弟,你这个问题解决了吗?我现在也遇到这个问题了,每次启动的时候yaw都是0附近变化,而其他的两个角都是没有什么问题的!
正点原子
2楼-- · 2019-07-20 11:30
在初始化完成后,就是0啊
耿耿于怀
3楼-- · 2019-07-20 16:37
 精彩回答 2  元偷偷看……
4日忌
4楼-- · 2019-07-20 19:47
耿耿于怀 发表于 2016-8-13 11:52
谢谢原子哥

请教楼主,可以发一下dmp初始化程序吗?我的初始化后,yaw每次都是不一样的,qq 2350240101.谢谢啦
4日忌
5楼-- · 2019-07-20 22:16
 精彩回答 2  元偷偷看……
春夜喜小雨
6楼-- · 2019-07-20 22:51
 精彩回答 2  元偷偷看……

一周热门 更多>