sensor.c 1.4 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152
  1. #include "sensor.h"
  2. /**
  3. * Sensor
  4. */
  5. void sensor_Init(void) {
  6. int8_t rsltSensor;
  7. Flag.BME280 = 0;
  8. SensorDev.dev_id = (BME280_I2C_ADDR_PRIM << 1);
  9. SensorDev.intf = BME280_I2C_INTF;
  10. SensorDev.read = user_i2c_read;
  11. SensorDev.write = user_i2c_write;
  12. SensorDev.delay_ms = tdelay_ms;
  13. rsltSensor = bme280_init(&SensorDev);
  14. if (rsltSensor == BME280_OK) {
  15. Flag.BME280 = 1;
  16. /* BME280 Recommended mode of operation: Indoor navigation */
  17. SensorDev.settings.osr_h = BME280_OVERSAMPLING_1X;
  18. SensorDev.settings.osr_p = BME280_OVERSAMPLING_16X;
  19. SensorDev.settings.osr_t = BME280_OVERSAMPLING_2X;
  20. SensorDev.settings.filter = BME280_FILTER_COEFF_16;
  21. rsltSensor = bme280_set_sensor_settings((BME280_OSR_PRESS_SEL | BME280_OSR_TEMP_SEL | BME280_OSR_HUM_SEL | BME280_FILTER_SEL), &SensorDev);
  22. RTOS_SetTask(sensor_StartMeasure, 103, 1000);
  23. RTOS_SetTask(sensor_GetData, 603, 1000);
  24. }
  25. }
  26. void sensor_StartMeasure(void) {
  27. bme280_set_sensor_mode(BME280_FORCED_MODE, &SensorDev);
  28. }
  29. void sensor_GetData(void) {
  30. bme280_get_sensor_data(BME280_ALL, &SensorData, &SensorDev);
  31. int32_t tmp;
  32. tmp = SensorData.humidity + 512;
  33. Humidity = (int8_t)(tmp / 1024);
  34. tmp = SensorData.temperature + 50;
  35. Temperature = (int8_t)(tmp / 100);
  36. /* in 32-bit arithmetics pressure in Pa */
  37. tmp = SensorData.pressure * 1000;
  38. tmp += 66661;
  39. tmp /= 133322;
  40. /* pressure in mmHg */
  41. Pressure = (uint16_t)tmp;
  42. }