Secure STM32
AI Embedded
Software Engineer

1  #include "tgs5141-p00.h"
2  #include <string.h>
3  #include <stdio.h>
4  
5  
6  static float TGS5141_ApplyFilter(TGS5141_t *sensor, float new_value);
7  static void TGS5141_UpdateAlarmStatus(TGS5141_t *sensor);
8  
9  /**
10  * @brief Initialize the TGS5141 CO sensor
11  */
12  TGS5141_Status_t TGS5141_Init(TGS5141_t *sensor)
13  {
14  if (sensor == NULL) {
15  return TGS5141_ERROR_INVALID_PARAM;
16  }
17  
18  
19  sensor->huart = NULL;
20  
21  
22  sensor->raw_adc_value = 0;
23  sensor->voltage_mv = 0.0f;
24  sensor->co_ppm = 0.0f;
25  sensor->co_ppm_filtered = 0.0f;
26  
27  
28  memset(sensor->filter_buffer, 0, sizeof(sensor->filter_buffer));
29  sensor->filter_index = 0;
30  sensor->filter_count = 0;
31  
32  
33  TGS5141_SetDefaultConfig(sensor);
34  
35  
36  sensor->last_status = TGS5141_OK;
37  sensor->alarm_config.alarm_enabled = false;
38  sensor->current_alarm = TGS5141_ALARM_NONE;
39  
40  return TGS5141_OK;
41  }
42  
43  /**
44  * @brief Read CO concentration in PPM
45  */
46  TGS5141_Status_t TGS5141_ReadCO_PPM(TGS5141_t *sensor, float *co_ppm)
47  {
48  float voltage;
49  TGS5141_Status_t status;
50  
51  if (sensor == NULL || co_ppm == NULL) {
52  return TGS5141_ERROR_INVALID_PARAM;
53  }
54  
55  status = TGS5141_ReadVoltage(sensor, &voltage);
56  if (status != TGS5141_OK) {
57  return status;
58  }
59  
60  
61  sensor->co_ppm = TGS5141_ConvertVoltageToPPM(sensor, voltage);
62  *co_ppm = sensor->co_ppm;
63  
64  
65  if (!TGS5141_IsInRange(sensor, sensor->co_ppm)) {
66  sensor->last_status = TGS5141_ERROR_OUT_OF_RANGE;
67  return TGS5141_ERROR_OUT_OF_RANGE;
68  }
69  
70  return TGS5141_OK;
71  }
72  
73  /**
74  * @brief Apply moving average filter
75  */
76  static float TGS5141_ApplyFilter(TGS5141_t *sensor, float new_value)
77  {
78  float sum = 0.0f;
79  
80  
81  sensor->filter_buffer[sensor->filter_index] = new_value;
82  sensor->filter_index = (sensor->filter_index + 1) % sensor->sample_count;
83  
84  if (sensor->filter_count < sensor->sample_count) {
85  sensor->filter_count++;
86  }
87  
88  
89  for (uint8_t i = 0; i < sensor->filter_count; i++) {
90  sum += sensor->filter_buffer[i];
91  }
92  
93  return sum / sensor->filter_count;
94  }1  #include "tgs5141-p00.h"
2  #include <string.h>
3  #include <stdio.h>