Danger-alarm/SOFTWARE-FreeRTOS/Source/ZE07CO.cpp

82 lines
2.1 KiB
C++
Raw Normal View History

#include "ZE07CO.hpp"
#include "common.hpp"
void ZE07CO_INIT()
{
// 初始化UART
uart_init(UART0, BAUD_RATE);
gpio_set_function(UART0_TX_PIN, GPIO_FUNC_UART);
gpio_set_function(UART0_RX_PIN, GPIO_FUNC_UART);
uart_set_hw_flow(UART0, false, false);
uart_set_format(UART0, DATA_BITS, STOP_BITS, PARITY);
}
// CO
static uint16_t ZE07CO(int ANSWER, int *ZE07_CO_DATA_IS_OK)
{
if (ANSWER == 1) {
// 应答模式
static uint8_t _ANSWER[9] = { 0xFF, 0x01, 0x78, 0x41, 0x00, 0x00, 0x00, 0x00, 0x46 };
uart_write_blocking(UART0, _ANSWER, 9);
sleep_ms(100);
}
if (ANSWER == 2) {
// 主动上传模式
static uint8_t _ANSWER[9] = { 0xFF, 0x01, 0x78, 0x40, 0x00, 0x00, 0x00, 0x00, 0x47 };
uart_write_blocking(UART0, _ANSWER, 9);
sleep_ms(100);
}
// 读取
uint8_t CO_DATA[9] = { 0 };
uart_read_blocking(UART0, CO_DATA, 9);
sleep_ms(100);
/*
for(int i=0; i<9; i++) {
printf("0X%X ", CO_DATA[i]);
}
printf("\n");
*/
// CO 浓度
uint16_t CO_CONC = (256 * CO_DATA[4]) + CO_DATA[5];
// 校验
uint8_t CHECKSUM = (0xFF - (CO_DATA[1] + CO_DATA[2] + CO_DATA[3] + CO_DATA[4] + CO_DATA[5] + CO_DATA[6] + CO_DATA[7])) + 1;
if (CO_DATA[8] == CHECKSUM && CO_DATA[1] == 0x04) {
//printf("CHECKSUM: %X = %X\n", CO_DATA[8], CHECKSUM);
//printf("CO Concentration: %d ppm\n", CO_CONC);
*ZE07_CO_DATA_IS_OK = 1;
} else {
*ZE07_CO_DATA_IS_OK = 0;
}
return CO_CONC;
}
void CO(void *pvParameters)
{
uint16_t CO_DATA = -1;
int ZE07_CO_DATA_IS_OK = 0;
_printTaskStackHighWaterMark("CO");
while(1)
{
ZE07CO_INIT();
CO_DATA = ZE07CO(2, &ZE07_CO_DATA_IS_OK);
if (CO_DATA != -1 && ZE07_CO_DATA_IS_OK == 1) {
printf("CO Concentration: %d ppm\n", CO_DATA);
}
//_printTaskStackHighWaterMark("CO");
watchdog_update(); // 喂狗
vTaskDelay(pdMS_TO_TICKS(3000)); // 非阻塞延时
}
return;
}