82 lines
2.1 KiB
C++
82 lines
2.1 KiB
C++
|
#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;
|
||
|
|
}
|