74 lines
2.0 KiB
C++
74 lines
2.0 KiB
C++
|
#include "MHZ14B.hpp"
|
|||
|
|
#include "common.hpp"
|
|||
|
|
|
|||
|
|
|
|||
|
|
void MH_Z14B_INIT()
|
|||
|
|
{
|
|||
|
|
// 初始化UART
|
|||
|
|
uart_init(UART1, BAUD_RATE);
|
|||
|
|
gpio_set_function(UART1_TX_PIN, GPIO_FUNC_UART);
|
|||
|
|
gpio_set_function(UART1_RX_PIN, GPIO_FUNC_UART);
|
|||
|
|
uart_set_hw_flow(UART1, false, false);
|
|||
|
|
uart_set_format(UART1, DATA_BITS, STOP_BITS, PARITY);
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
// CO2
|
|||
|
|
static uint16_t MH_Z14B(int *MH_Z14B_DATA_IS_OK)
|
|||
|
|
{
|
|||
|
|
|
|||
|
|
|
|||
|
|
// 0x86 读气体浓度值
|
|||
|
|
uint8_t CMD[9] = { 0xFF, 0x01, 0x86, 0x00, 0x00, 0x00, 0x00, 0x00, 0x79 };
|
|||
|
|
uart_write_blocking(UART1, CMD, 9);
|
|||
|
|
sleep_ms(200);
|
|||
|
|
|
|||
|
|
// 读取
|
|||
|
|
uint8_t CO2_DATA[9] = { 0 };
|
|||
|
|
uart_read_blocking(UART1, CO2_DATA, 9);
|
|||
|
|
|
|||
|
|
// CO2 浓度
|
|||
|
|
uint16_t CO2_CONC = (256 * CO2_DATA[2]) + CO2_DATA[3];
|
|||
|
|
|
|||
|
|
// 校验
|
|||
|
|
uint8_t CHECKSUM = (0xFF - (CO2_DATA[1] + CO2_DATA[2] + CO2_DATA[3] + CO2_DATA[4] + CO2_DATA[5] + CO2_DATA[6] + CO2_DATA[7])) + 1;
|
|||
|
|
|
|||
|
|
if (CO2_DATA[8] == CHECKSUM && CO2_DATA[1] == 0x86) {
|
|||
|
|
//printf("CHECKSUM: %X = %X\n", CO2_DATA[8], CHECKSUM);
|
|||
|
|
//printf("CO2 Concentration: %d ppm\n", CO2_CONC);
|
|||
|
|
*MH_Z14B_DATA_IS_OK = 1;
|
|||
|
|
} else {
|
|||
|
|
// 校准传感器 零点 （ZERO）
|
|||
|
|
uint8_t ZERO[] = { 0XFF, 0X01, 0X87, 0X00, 0X00, 0X00, 0X00, 0X00, 0X78 };
|
|||
|
|
uart_write_blocking(UART1, ZERO, 9);
|
|||
|
|
sleep_ms(200);
|
|||
|
|
|
|||
|
|
// 校准传感器 跨度点 （SPAN）
|
|||
|
|
uint8_t SPAN[] = { 0XFF, 0X01, 0X88, 0X07, 0XD0, 0X00, 0X00, 0X00, 0XA0 };
|
|||
|
|
uart_write_blocking(UART1, SPAN, 9);
|
|||
|
|
sleep_ms(200);
|
|||
|
|
|
|||
|
|
*MH_Z14B_DATA_IS_OK = 0;
|
|||
|
|
printf("CO2 concentration reading failed!\n");
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
return CO2_CONC;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
void CO2(void *pvParameters)
|
|||
|
|
{
|
|||
|
|
uint16_t CO2_DATA = -1;
|
|||
|
|
int MH_Z14B_DATA_IS_OK = 0;
|
|||
|
|
MH_Z14B_INIT();
|
|||
|
|
_printTaskStackHighWaterMark("MH_Z14B");
|
|||
|
|
|
|||
|
|
while(1)
|
|||
|
|
{
|
|||
|
|
CO2_DATA = MH_Z14B(&MH_Z14B_DATA_IS_OK);
|
|||
|
|
if (CO2_DATA != -1 && MH_Z14B_DATA_IS_OK == 1) {
|
|||
|
|
printf("CO2 Concentration: %d ppm\n", CO2_DATA);
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
_printTaskStackHighWaterMark("MH_Z14B");
|
|||
|
|
vTaskDelay(pdMS_TO_TICKS(3000)); // 非阻塞延时
|
|||
|
|
}
|
|||
|
|
}
|