【STEVAL-STWINKT1B测评】2.驱动振动传感器（IIS3DWB）

void iis3dwb_read_data_polling()

{

  stmdev_ctx_t dev_ctx;

  /* Initialize mems driver interface */

  dev_ctx.write_reg = platform_write;

  dev_ctx.read_reg = platform_read;

  dev_ctx.mdelay = platform_delay;

  dev_ctx.handle = &hspi3;

  /* Init test platform */

 // platform_init();

  /* Wait sensor boot time */

  platform_delay(BOOT_TIME);

  /* Check device ID */

  iis3dwb_device_id_get(&dev_ctx, &whoamI);



  if (whoamI != IIS3DWB_ID)

    while (1);



  /* Restore default configuration */

  iis3dwb_reset_set(&dev_ctx, PROPERTY_ENABLE);



  do {

    iis3dwb_reset_get(&dev_ctx, &rst);

  } while (rst);



  /* Enable Block Data Update */

  iis3dwb_block_data_update_set(&dev_ctx, PROPERTY_ENABLE);

  /* Set Output Data Rate */

  iis3dwb_xl_data_rate_set(&dev_ctx, IIS3DWB_XL_ODR_26k7Hz);

  /* Set full scale */

  iis3dwb_xl_full_scale_set(&dev_ctx, IIS3DWB_2g);

  /* Configure filtering chain(No aux interface)

   * Accelerometer low pass filter path

   */

  iis3dwb_xl_filt_path_on_out_set(&dev_ctx, IIS3DWB_LP_ODR_DIV_100);





  /* Read samples in polling mode (no int) */

  while (1) {

    uint8_t reg;

    /* Read output only if new xl value is available */

    iis3dwb_xl_flag_data_ready_get(&dev_ctx, ®);



    if (reg) {

      /* Read acceleration field data */

      memset(data_raw_acceleration, 0x00, 3 * sizeof(int16_t));

      iis3dwb_acceleration_raw_get(&dev_ctx, data_raw_acceleration);

      acceleration_mg[0] =

        iis3dwb_from_fs2g_to_mg(data_raw_acceleration[0]);

      acceleration_mg[1] =

        iis3dwb_from_fs2g_to_mg(data_raw_acceleration[1]);

      acceleration_mg[2] =

        iis3dwb_from_fs2g_to_mg(data_raw_acceleration[2]);

      //sprintf((char *)tx_buffer,"Acceleration [mg]:%4.2f\t%4.2f\t%4.2f\r\n",acceleration_mg[0], acceleration_mg[1], acceleration_mg[2]);

      tx_com(tx_buffer, strlen((char const *)tx_buffer));

    }



    iis3dwb_temp_flag_data_ready_get(&dev_ctx, ®);



    if (reg) {

      /* Read temperature data */

      memset(&data_raw_temperature, 0x00, sizeof(int16_t));

      iis3dwb_temperature_raw_get(&dev_ctx, &data_raw_temperature);

      temperature_degC = iis3dwb_from_lsb_to_celsius(data_raw_temperature);

      //sprintf((char *)tx_buffer, "Temperature [degC]:%6.2f\r\n", temperature_degC);

      tx_com(tx_buffer, strlen((char const *)tx_buffer));

    }

  }

}



/*

 * [url=home.php?mod=space&uid=247401]@brief[/url]  Write generic device register (platform dependent)

 *

 * @param  handle    customizable argument. In this examples is used in

 *                   order to select the correct sensor bus handler.

 * @param  reg       register to write

 * @param  bufp      pointer to data to write in register reg

 * @param  len       number of consecutive register to write

 *

 */

 int32_t platform_write(void *handle, uint8_t reg, const uint8_t *bufp,

                              uint16_t len)

{





    HAL_GPIO_WritePin(GPIOE,GPIO_PIN_14, GPIO_PIN_RESET);

    HAL_SPI_Transmit(handle, ®, 1, 1000);

    HAL_SPI_Transmit(handle, (uint8_t*) bufp, len, 1000);

    HAL_GPIO_WritePin(GPIOE,GPIO_PIN_14,GPIO_PIN_SET);

  return 0;

}



/*

 * [url=home.php?mod=space&uid=247401]@brief[/url]  Read generic device register (platform dependent)

 *

 * @param  handle    customizable argument. In this examples is used in

 *                   order to select the correct sensor bus handler.

 * @param  reg       register to read

 * @param  bufp      pointer to buffer that store the data read

 * @param  len       number of consecutive register to read

 *

 */

int32_t platform_read(void *handle, uint8_t reg, uint8_t *bufp,

                             uint16_t len)

{



    reg |= 0x80;

    HAL_GPIO_WritePin(GPIOE,GPIO_PIN_14, GPIO_PIN_RESET);

    HAL_SPI_Transmit(handle, ®, 1, 1000);

    HAL_SPI_Receive(handle, bufp, len, 1000);

    HAL_GPIO_WritePin(GPIOE,GPIO_PIN_14, GPIO_PIN_SET);



  return 0;

}



/*

 * [url=home.php?mod=space&uid=247401]@brief[/url]  Send buffer to console (platform dependent)

 *

 * @param  tx_buffer     buffer to transmit

 * @param  len           number of byte to send

 *

 */

void tx_com(uint8_t *tx_buffer, uint16_t len)

{



  CDC_Transmit_FS(tx_buffer, len);



}



/*

 * @brief  platform specific delay (platform dependent)

 *

 * @param  ms        delay in ms

 *

 */

void platform_delay(uint32_t ms)

{

  HAL_Delay(ms);

}



/*

 * @brief  platform specific initialization (platform dependent)

 */

void platform_init(void)

{

}