使用lsm6dsl的sensor hub模式去驱动lis2mdl，读取出来的数据一直没有变化是为什么？

我分别驱动lsm6dsl和lis2mdl时，数据是正常的，但是现在我们产品的方案是使用lsm6dsl的sensor hub模式去驱动lis2mdl，并获取软硬校准之后的数据，但是我按照”an5040-LSM6DSL：始终开启的3D 加速度计和3D 陀螺仪.pdf“的sensor hub的例子去驱动的时候，读取出来的数据一直没有变化，三组数据都没有变化，包括 OUT_MAG_RAW_X_L、SENSORHUB1_REG、 SENSORHUB13_REG这三个寄存器的数据，都没有变化，可以帮我看着是什么问题吗？下面是我的代码

版本1：

```
uint8_t Demo_Config(void)
```


* {
  uint8_t writeData = 0x80;
  lsm6dsl_func_src1_t readData = {0};

  //1.使能对嵌入功能寄存器的访问（A 区）
  lsm6dsl_write_reg(LSM6DSL_FUNC_CFG_ACCESS,  writeData, 1);

  //2.LIS2MDL 从设备地址 = 0011110b
  writeData = 0x1EU;
  lsm6dsl_write_reg(LSM6DSL_SLV0_ADD,  writeData, 1);

  //3.60h 为待写入的 LIS2MDL 寄存器
  writeData = 0x60;
  lsm6dsl_write_reg(LSM6DSL_SLV0_SUBADD,  writeData, 1);

  //4. 8Ch 为写入到 LIS2MDL 的寄存器 60h 的值, Continue 模式 ODR = 100 Hz
  writeData = 0x8c;
  lsm6dsl_write_reg(LSM6DSL_DATAWRITE_SRC_MODE_SUB_SLV0,  writeData, 1);

  //5.将 Aux_sens_on 位设置为不等于 00b
  writeData = 0x10;
  lsm6dsl_write_reg(LSM6DSL_SLAVE0_CONFIG,  writeData, 1);

  //6.使能 write_once 位
  writeData = 0x20;
  lsm6dsl_write_reg(LSM6DSL_SLAVE1_CONFIG,  writeData, 1);

  //7.禁用对嵌入功能寄存器的访问（A 区）
  writeData = 0x00;
  lsm6dsl_write_reg(LSM6DSL_FUNC_CFG_ACCESS,  writeData, 1);

  //8.使能嵌入功能
  writeData = 0x04;
  lsm6dsl_write_reg(LSM6DSL_CTRL10_C,  writeData, 1);

  do{
  //9.使能 SDx/SCx 线上的内部上拉  传感器集合（sensor hub）触发信号为 XL 数据准备就绪
  writeData = 0x09;
  lsm6dsl_write_reg(LSM6DSL_MASTER_CONFIG,  writeData, 1);

  //10.开启加速度计（以获取触发信号）
  writeData = 0x80;
  lsm6dsl_write_reg(LSM6DSL_CTRL1_XL,  writeData, 1);

  //11.等待传感器集合通信结束
  //12.SENSORHUB_END_OP = 0，转到 9
  lsm6dsl_read_reg(LSM6DSL_FUNC_SRC1, (uint8_t *) readData, 1);
  } while(!readData.sensorhub_end_op);

  //13.禁用嵌入功能
  writeData = 0x00;
  lsm6dsl_write_reg(LSM6DSL_CTRL10_C,  writeData, 1);

  //14.禁用辅助 I2C 主线
  writeData = 0x00;
  lsm6dsl_write_reg(LSM6DSL_MASTER_CONFIG,  writeData, 1);

  //15.关闭加速度计
  writeData = 0x00;
  lsm6dsl_write_reg(LSM6DSL_CTRL1_XL,  writeData, 1);

  //16.使能对嵌入功能寄存器的访问（A 区）
  writeData = 0x80;
  lsm6dsl_write_reg(LSM6DSL_FUNC_CFG_ACCESS,  writeData, 1);

  //17.LIS2MDL 从设备地址 = 0011110b
  writeData = 0x1EU;
  lsm6dsl_write_reg(LSM6DSL_SLV0_ADD,  writeData, 1);

  //18. 68h 为待读取的第一个 LIS2MDL 输出寄存器
  writeData = 0x68;
  lsm6dsl_write_reg(LSM6DSL_SLV0_SUBADD,  writeData, 1);

  //19. 无抽取;连接了 1 个外部传感器
  writeData = 0x06;
  lsm6dsl_write_reg(LSM6DSL_SLAVE0_CONFIG,  writeData, 1);

  //20~34
  uint8_t mag_off[6] = {0x20, 0xFF, 0x54, 0x00, 0xB4, 0xFF};
  uint8_t mag_si[9] = {0x0A, 0x01, 0x00, 0x01, 0x08, 0x81, 0x00, 0x81, 0x0A};
  lsm6dsl_write_reg(LSM6DSL_MAG_OFFX_L, mag_off, 6);
  lsm6dsl_write_reg(LSM6DSL_MAG_SI_XX, mag_si, 9);

  //35.禁用对嵌入功能寄存器的访问（A 区）
  writeData = 0x00;
  lsm6dsl_write_reg(LSM6DSL_FUNC_CFG_ACCESS,  writeData, 1);

  //36.使能嵌入功能
  writeData = 0x04;
  lsm6dsl_write_reg(LSM6DSL_CTRL10_C,  writeData, 1);

  //37.使能 SDx/SCx 线上的内部上拉
  writeData = 0x0b;
  lsm6dsl_write_reg(LSM6DSL_MASTER_CONFIG,  writeData, 1);

  //38.使能软磁校准
  writeData = 0x04;
  lsm6dsl_write_reg(LSM6DSL_CTRL9_XL,  writeData, 1);

  //39.开启加速度计（以获取触发信号）
  writeData = 0x80;
  lsm6dsl_write_reg(LSM6DSL_CTRL1_XL,  writeData, 1);
  }

版本2：

``

int32_t SensorHub_Init(void)
{
// 1. 将 80h 写入 FUNC_CFG_ACCESS // 使能对嵌入功能寄存器的访问（A 区）
// 2. 将 3Ch 写入 SLV0_ADD // LIS2MDL 从设备地址 = 0011110b
//    使能写操作（rw_0=0）
// 3. 将 60h 写入 SLV0_SUBADD // 60h 为待写入的 LIS2MDL 寄存器
// 4. 将 8Ch 写入 DATAWRITE_SRC_MODE_SUB_SLV0 // 8Ch 为写入到 LIS2MDL 的寄存器 60h 的值
//    以将其配置为 Continue 模式，
//    ODR = 100 Hz，温度补偿使能

uint8_t w_data = 0;

lsm6dsl_sh_cfg_write_t sh_cfg_write;
sh_cfg_write.slv0_add = 0x3C;
sh_cfg_write.slv0_subadd = 0x60;
sh_cfg_write.slv0_data = 0x8C;

if (lsm6dsl_sh_cfg_write( sh_cfg_write) != LSM6DSL_OK)
{
return LSM6DSL_ERROR;
}

// 5. 将 10h 写入 SLAVE0_CONFIG // 将 Aux_sens_on 位设置为不等于 00b
if (lsm6dsl_sh_num_of_dev_connected_set(LSM6DSL_SLV_0_1) != LSM6DSL_OK)
{
return LSM6DSL_ERROR;
}

// 6. 将 20h 写入 SLAVE1_CONFIG // 使能 write_once 位
// 7. 将 00h 写入 FUNC_CFG_ACCESS // 禁用对嵌入功能寄存器的访问（A 区）
if (lsm6dsl_sh_write_mode_set(LSM6DSL_ONLY_FIRST_CYCLE) != LSM6DSL_OK)
{
return LSM6DSL_ERROR;
}

// 8. 将 04h 写入 CTRL10_C // 使能嵌入功能
if (lsm6dsl_func_en_set(1) != LSM6DSL_OK) // lsm6dsl_func_en_set lsm6dsl_pedo_sens_set
{
return LSM6DSL_ERROR;
}

// 9. 将 09h 写入 MASTER_CONFIG // 使能 SDx/SCx 线上的内部上拉
//    传感器集合（sensor hub）触发信号为 XL 数据准备就绪
//    使能辅助 I2C 主线
if (lsm6dsl_sh_pin_mode_set(LSM6DSL_INTERNAL_PULL_UP) != LSM6DSL_OK)
{
return LSM6DSL_ERROR;
}
if (lsm6dsl_sh_master_set(1) != LSM6DSL_OK)
{
return LSM6DSL_ERROR;
}

// 10. 将 80h 写入 CTRL1_XL // 开启加速度计（以获取触发信号）
if (lsm6dsl_xl_data_rate_set(LSM6DSL_XL_ODR_1k66Hz) != LSM6DSL_OK)
{
return LSM6DSL_ERROR;
}

lsm6dsl_func_src1_t func_src1 = {0};
func_src1.sensorhub_end_op = 0;
do
{
// 11. 读取 FUNC_SRC1 // 等待传感器集合通信结束
// 12. 如果 SENSORHUB_END_OP = 0，转到 9
if (lsm6dsl_read_reg(LSM6DSL_FUNC_SRC1, (uint8_t *) func_src1, 1) != LSM6DSL_OK)
{
return LSM6DSL_ERROR;
}
} while (func_src1.sensorhub_end_op == 0);

// 13. 将 00h 写入 CTRL10_C // 禁用嵌入功能
w_data = 0;
if (lsm6dsl_write_reg(LSM6DSL_CTRL10_C,  w_data, 1) != LSM6DSL_OK)
{
return LSM6DSL_ERROR;
}
// 14. 将 00h 写入 MASTER_CONFIG // 禁用辅助 I2C 主线
if (lsm6dsl_write_reg(LSM6DSL_MASTER_CONFIG,  w_data, 1) != LSM6DSL_OK)
{
return LSM6DSL_ERROR;
}
// 15. 将 00h 写入 CTRL1_XL // 关闭加速度计
if (lsm6dsl_write_reg(LSM6DSL_CTRL1_XL,  w_data, 1) != LSM6DSL_OK)
{
return LSM6DSL_ERROR;
}

// 16. 将 80h 写入 FUNC_CFG_ACCESS // 使能对嵌入功能寄存器的访问（A 区）
//     使能读操作（rw_0=1）
// 18. 将 68h 写入 SLV0_SUBADD     // 68h 为待读取的第一个 LIS2MDL 输出寄存器
// 19. 将 06h 写入 SLAVE0_CONFIG   // 无抽取
//                                 // 连接了 1 个外部传感器
//                                 // 读取的寄存器数 = 6
if (lsm6dsl_mem_bank_set(LSM6DSL_BANK_A) != LSM6DSL_OK)
{
return LSM6DSL_ERROR;
}

w_data = 0x3D;
if (lsm6dsl_write_reg(LSM6DSL_SLV0_ADD,  w_data, 1) != LSM6DSL_OK)
{
return LSM6DSL_ERROR;
}
w_data = 0x68;
if (lsm6dsl_write_reg(LSM6DSL_SLV0_SUBADD,  w_data, 1) != LSM6DSL_OK)
{
return LSM6DSL_ERROR;
}
w_data = 0x06;
if (lsm6dsl_write_reg(LSM6DSL_SLAVE0_CONFIG,  w_data, 1) != LSM6DSL_OK)
{
return LSM6DSL_ERROR;
}

// 20. 将 FFh 写入 MAG_OFFX_H // X 偏移值初始化
// 21. 将 20h 写入 MAG_OFFX_L // X 偏移值初始化
// 22. 将 00h 写入 MAG_OFFY_H // Y 偏移值初始化
// 23. 将 54h 写入 MAG_OFFY_L // Y 偏移值初始化
// 24. 将 FFh 写入 MAG_OFFZ_H // Z 偏移值初始化
// 25. 将 B4h 写入 MAG_OFFZ_L // Z 偏移值初始化
// 26. 将 0Ah 写入 MAG_SI_XX  // XX 软磁参数
// 27. 将 01h 写入 MAG_SI_XY  // XY 软磁参数
// 28. 将 00h 写入 MAG_SI_XZ  // XZ 软磁参数
// 29. 将 01h 写入 MAG_SI_YX  // YX 软磁参数
// 30. 将 08h 写入 MAG_SI_YY  // YY 软磁参数
// 31. 将 81h 写入 MAG_SI_YZ  // YZ 软磁参数
// 32. 将 00h 写入 MAG_SI_ZX  // ZX 软磁参数
// 33. 将 81h 写入 MAG_SI_ZY  // ZY 软磁参数
// 34. 将 0Ah 写入 MAG_SI_ZZ  // ZZ 软磁参数
// 35. 将 00h 写入 FUNC_CFG_ACCESS // 禁用对嵌入功能寄存器的访问（A 区）

uint8_t mag_off[6] = {0x20, 0xFF, 0x54, 0x00, 0xB4, 0xFF};
uint8_t mag_si[9] = {0x0A, 0x01, 0x00, 0x01, 0x08, 0x81, 0x00, 0x81, 0x0A};

if (lsm6dsl_write_reg(LSM6DSL_MAG_OFFX_H, mag_off, 6) != LSM6DSL_OK)
{
return LSM6DSL_ERROR;
}
if (lsm6dsl_write_reg(LSM6DSL_MAG_SI_XX, mag_si, 9) != LSM6DSL_OK)
{
return LSM6DSL_ERROR;
}

if (lsm6dsl_mem_bank_set(LSM6DSL_USER_BANK) != LSM6DSL_OK)
{
return LSM6DSL_ERROR;
}

// 36. 将 04h 写入 CTRL10_C // 使能嵌入功能
if (lsm6dsl_func_en_set(1) != LSM6DSL_OK)
{
return LSM6DSL_ERROR;
}

// 37. 将 0Bh 写入 MASTER_CONFIG // 使能 SDx/SCx 线上的内部上拉
//     传感器集合（sensor hub）触发信号为 XL 数据准备就绪
//     使能硬磁校准
//     使能辅助 I2C 主线
w_data = 0x0B;
if (lsm6dsl_write_reg(LSM6DSL_MASTER_CONFIG,  w_data, 1) != LSM6DSL_OK)
{
return LSM6DSL_ERROR;
}

// 38. 将 04h 写入 CTRL9_XL // 使能软磁校准
w_data = 0x04;
if (lsm6dsl_write_reg(LSM6DSL_CTRL9_XL,  w_data, 1) != LSM6DSL_OK)
{
return LSM6DSL_ERROR;
}
// 39. 将 80h 写入 CTRL1_XL // 开启加速度计（以获取触发信号）
if (lsm6dsl_xl_data_rate_set(LSM6DSL_XL_ODR_1k66Hz) != LSM6DSL_OK)
{
return LSM6DSL_ERROR;
}

return LSM6DSL_OK;
}

经过初始化之后，读取出来的数据并没有什么变化