start working with timers
This commit is contained in:
parent
ecb1e00198
commit
2548813231
3 changed files with 143 additions and 46 deletions
71
pms5003.c
71
pms5003.c
|
|
@ -20,14 +20,16 @@ https://shop.pimoroni.com/products/pms5003-particulate-matter-sensor-with-cable
|
|||
https://github.com/raspberrypi/pico-examples/blob/master/uart/hello_uart/hello_uart.c
|
||||
*/
|
||||
|
||||
#define MAX_READINGS 100
|
||||
|
||||
static bool read = false;
|
||||
static uint16_t reading_i = 0;
|
||||
static pms5003_reading readings[MAX_READINGS];
|
||||
|
||||
static uint8_t rx_buf[32] = {0};
|
||||
static uint8_t rx_i = 0;
|
||||
|
||||
static float last_pm1_reading = 0;
|
||||
static float last_pm2_5_reading = 0;
|
||||
static float last_pm10_reading = 0;
|
||||
|
||||
static void extract_pm_values_from_rx_buf() {
|
||||
static pms5003_reading extract_pm_values_from_rx_buf() {
|
||||
uint8_t pm1_low = rx_buf[9];
|
||||
uint8_t pm1_high = rx_buf[10];
|
||||
uint16_t pm1 = ((uint16_t)pm1_high << 8) | pm1_low;
|
||||
|
|
@ -40,13 +42,15 @@ static void extract_pm_values_from_rx_buf() {
|
|||
uint8_t pm10_high = rx_buf[14];
|
||||
uint16_t pm10 = ((uint16_t)pm10_high << 8) | pm10_low;
|
||||
|
||||
last_pm1_reading = (float)pm1;
|
||||
last_pm2_5_reading = (float)pm2_5;
|
||||
last_pm10_reading = (float)pm10;
|
||||
pms5003_reading reading = {
|
||||
.pm1 = (float)pm1, .pm2_5 = (float)pm2_5, .pm10 = (float)pm10};
|
||||
|
||||
return reading;
|
||||
}
|
||||
|
||||
static void on_uart_rx() {
|
||||
while (uart_is_readable(uart1)) {
|
||||
// TODO: make the uart1 dynamic
|
||||
while (read && reading_i < MAX_READINGS && uart_is_readable(uart1)) {
|
||||
uint8_t ch = uart_getc(uart1);
|
||||
// start of a message
|
||||
if (ch == 0x42) {
|
||||
|
|
@ -57,7 +61,8 @@ static void on_uart_rx() {
|
|||
rx_i++;
|
||||
// end of message
|
||||
if (rx_i == 31) {
|
||||
extract_pm_values_from_rx_buf();
|
||||
readings[reading_i] = extract_pm_values_from_rx_buf();
|
||||
reading_i++;
|
||||
}
|
||||
|
||||
// guard
|
||||
|
|
@ -78,11 +83,13 @@ void pms5003_init(pms5003_config *new_config, uart_inst_t *uart, uint8_t tx_pin,
|
|||
irq_set_enabled(UART1_IRQ, true);
|
||||
uart_set_irq_enables(uart, true, false);
|
||||
|
||||
// high level or suspending is normal working status, while low level is sleeping mode.
|
||||
// high level or suspending is normal working status, while low level is
|
||||
// sleeping mode.
|
||||
gpio_init(enable_pin);
|
||||
gpio_set_dir(enable_pin, GPIO_OUT);
|
||||
gpio_put(enable_pin, 0);
|
||||
|
||||
// TODO: add hourly reset?
|
||||
// low resets
|
||||
// gpio_init(reset_pin);
|
||||
// gpio_set_dir(reset_pin, GPIO_OUT);
|
||||
|
|
@ -94,13 +101,37 @@ void pms5003_init(pms5003_config *new_config, uart_inst_t *uart, uint8_t tx_pin,
|
|||
new_config->reset_pin = reset_pin;
|
||||
}
|
||||
|
||||
/**
|
||||
Reads should happen min of 30sec after waking the sensor
|
||||
*/
|
||||
pms5003_reading pms5003_read(pms5003_config *config) {
|
||||
pms5003_reading reading;
|
||||
reading.pm1 = last_pm1_reading;
|
||||
reading.pm2_5 = last_pm2_5_reading;
|
||||
reading.pm10 = last_pm10_reading;
|
||||
return reading;
|
||||
static pms5003_reading compute_avarage_reading() {
|
||||
extern uint16_t reading_i;
|
||||
extern pms5003_reading readings[MAX_READINGS];
|
||||
|
||||
float pm1_sum = 0;
|
||||
float pm2_5_sum = 0;
|
||||
float pm10_sum = 0;
|
||||
|
||||
for (int i = 0; i < reading_i; i++) {
|
||||
pm1_sum += readings[i].pm1;
|
||||
pm2_5_sum += readings[i].pm2_5;
|
||||
pm10_sum += readings[i].pm10;
|
||||
}
|
||||
pms5003_reading average_reading = {.pm1 = pm1_sum / reading_i,
|
||||
.pm2_5 = pm2_5_sum / reading_i,
|
||||
.pm10 = pm10_sum / reading_i};
|
||||
return average_reading;
|
||||
}
|
||||
|
||||
void pms5003_warmup(pms5003_config *config) { gpio_put(config->enable_pin, 1); }
|
||||
|
||||
void pms5003_start_reading(pms5003_config *config) {
|
||||
reading_i = 0;
|
||||
read = true;
|
||||
}
|
||||
|
||||
pms5003_reading pms5003_finish_reading(pms5003_config *config) {
|
||||
printf("readings_i: %d\n", reading_i);
|
||||
read = false;
|
||||
gpio_put(config->enable_pin, 0);
|
||||
pms5003_reading average_reading = compute_avarage_reading();
|
||||
reading_i = 0;
|
||||
return average_reading;
|
||||
}
|
||||
|
|
|
|||
Loading…
Add table
Add a link
Reference in a new issue