Optimization of RP2040 C/C++SDK combined with FreeRTOS

2025-07-29 19:13:39 +08:00 · 2024-06-04 15:45:40 +08:00
parent 92c0ee6bd8
commit 16014ec70b
10 changed files with 267 additions and 11 deletions
--- a/SOFTWARE-FreeRTOS/Source/ZE07CO.cpp
+++ b/SOFTWARE-FreeRTOS/Source/ZE07CO.cpp
@@ -0,0 +1,81 @@
+#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;
+}