Symulator 4 czujnikow TPMS Schrader EG53MA4 (ESP32 + CC1101)
Firmware symulujacy 4 czujniki TPMS dla Opla Astry J Sedan 2016 (EU, protokol Schrader EG53MA4, 433.92 MHz, Manchester G.E.T. MC). Tryby NORMAL/LEARN/SINGLE, deep sleep, konsola szeregowa. Weryfikacja: rtl_433 + testy natywne + kompilacja ESP32. PROJEKT DIAGNOSTYCZNY/TESTOWY - symulator generuje sztuczne dane cisnienia i nie zastepuje prawdziwych czujnikow TPMS.
This commit is contained in:
commit
9b30351779
20 files changed
+2758
No files matched your search
@@ -0,0 +1,40 @@
|
||||
/*
|
||||
* app.h - API aplikacji (tryby pracy) uzywane przez konsole i maszyne stanow
|
||||
*/
|
||||
#ifndef TPMS_APP_H
|
||||
#define TPMS_APP_H
|
||||
|
||||
#include <stdint.h>
|
||||
|
||||
#ifdef __cplusplus
|
||||
extern "C" {
|
||||
#endif
|
||||
|
||||
enum {
|
||||
APP_MODE_NORMAL = 0, // rotacja wszystkich 4 kol + deep sleep
|
||||
APP_MODE_LEARN = 1, // nauka czujnikow w aucie, jedno kolo naraz
|
||||
APP_MODE_SINGLE = 2, // wymuszone nadawanie wskazanego ID
|
||||
};
|
||||
|
||||
uint8_t app_mode(void);
|
||||
uint8_t app_wheel(void); // aktywne kolo (w LEARN/SINGLE)
|
||||
|
||||
void app_set_mode(uint8_t mode, uint8_t wheel);
|
||||
void app_next_wheel(void);
|
||||
void app_send_burst_wheel(uint8_t wheel);
|
||||
void app_send_burst_all(void);
|
||||
|
||||
void app_print_info(void);
|
||||
void app_print_frame(uint8_t wheel);
|
||||
|
||||
uint32_t app_supply_mv(void);
|
||||
void app_set_interval(uint32_t seconds); // 0 = automatyczny (wg ACC)
|
||||
void app_set_flags(uint32_t flags);
|
||||
void app_request_sleep(void); // zaspij teraz (tryb NORMAL)
|
||||
void app_stay_awake(uint32_t ms); // przedluz okno konsoli
|
||||
|
||||
#ifdef __cplusplus
|
||||
}
|
||||
#endif
|
||||
|
||||
#endif /* TPMS_APP_H */
|
||||
+173
@@ -0,0 +1,173 @@
|
||||
/*
|
||||
* config.h - konfiguracja symulatora czujnikow TPMS Schrader EG53MA4
|
||||
* dla Opla Astry J Sedan 2016 (EU, TPMS bezposredni, czujniki Schrader).
|
||||
*
|
||||
* !!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!
|
||||
* ZASTRZEZENIE / DISCLAIMER:
|
||||
* Projekt wylacznie do celow diagnostycznych i testowych.
|
||||
* Symulator dostarcza SZTUCZNE dane cisnienia i temperatury i NIE
|
||||
* zastepuje prawdziwych czujnikow TPMS. Nie uzywaj tego urzadzenia do
|
||||
* jazdy po drogach publicznych - prawdziwy TPMS jest elementem
|
||||
* bezpieczenstwa czynnego pojazdu.
|
||||
* !!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!
|
||||
*
|
||||
* Protokol wg rtl_433 src/devices/schraeder.c (schrader_EG53MA4):
|
||||
* "Schrader TPMS EG53MA4, Saab, Opel, Vauxhall, Chevrolet"
|
||||
* (Opel OEM 13348393), weryfikacja: tools/tpms_frame.py, tools/gen_cu8.py.
|
||||
*/
|
||||
#ifndef TPMS_CONFIG_H
|
||||
#define TPMS_CONFIG_H
|
||||
|
||||
#define FW_VERSION "1.0.0"
|
||||
#define CONFIG_VERSION 4 // podnos przy zmianie formatu danych w RTC
|
||||
|
||||
/* ======================================================================
|
||||
* 1. ZASILANIE
|
||||
* POWER_12V - stale zasilanie z akumulatora 12 V przez buck/ LDO
|
||||
* o niskim pradzie spoczynkowym (np. TPS62740, Iq < 1 uA)
|
||||
* POWER_BATTERY - ogniwo 3.3-4.2 V (Li-SOCl2 / LiPo) bez przetwornicy
|
||||
* ====================================================================== */
|
||||
#define POWER_SUPPLY_MODE POWER_12V
|
||||
#define POWER_12V 1
|
||||
#define POWER_BATTERY 2
|
||||
|
||||
/* ======================================================================
|
||||
* 2. PINY (ESP32 DevKit + CC1101 po SPI)
|
||||
* Piny CC1101 zgodne z wymaganiami projektu:
|
||||
* SCK=18 MISO=19 MOSI=23 CS=5 GDO0=2
|
||||
* ====================================================================== */
|
||||
#define PIN_CC1101_SCK 18
|
||||
#define PIN_CC1101_MISO 19
|
||||
#define PIN_CC1101_MOSI 23
|
||||
#define PIN_CC1101_CS 5
|
||||
#define PIN_CC1101_GDO0 2
|
||||
|
||||
/* Przycisk sterowania trybami (wejscie budzace EXT0).
|
||||
* Dolaczenie do GND + rezystor podciagajacy 10k do 3V3 (aktywny niski). */
|
||||
#define PIN_BUTTON 26
|
||||
#define BTN_ACTIVE_LEVEL 0 // 0 = aktywny niski (przycisk -> GND)
|
||||
|
||||
/* LED statusowy (rezystor szeregowy 330R, aktywny wysoki). */
|
||||
#define PIN_LED 27
|
||||
|
||||
/* Opcjonalne wejscie aktywacji LF 125 kHz (cewka + prostownik + tranzystor).
|
||||
* Impuls wysoki = "programator przy kole" -> natychmiastowa transmisja.
|
||||
* -1 wylacza funkcje (role pelni przycisk "aktywuj kolo"). */
|
||||
#define PIN_LF_TRIGGER 25
|
||||
|
||||
/* Opcjonalny sygnal zaplonu / ACC (dzielnik 12 V -> 3.3 V). -1 = brak. */
|
||||
#define PIN_ACC 32
|
||||
|
||||
/* Pomiar napiecia zasilania: dzielnik R1(gora)/R2(dol) na pin ADC1.
|
||||
* Uwaga: GPIO34/35/32/33 = ADC1, mozliwe rowniez jako wejscia EXT. */
|
||||
#define PIN_VBAT_ADC 34
|
||||
#define VBAT_DIVIDER_R1 100000.0f // ohm, gora (do zasilania)
|
||||
#define VBAT_DIVIDER_R2 33000.0f // ohm, dol (do masy)
|
||||
#define VBAT_CAL 1.000f // mnoznik kalibracji (por. z multimetrem)
|
||||
#define VBAT_SAMPLES 16
|
||||
|
||||
/* ======================================================================
|
||||
* 3. CZUJNIKI - 4 identyfikatory (hex, po jednym na kolo)
|
||||
* Kolejnosc nauki w Astrze: przod lewy -> przod prawy -> tyl prawy -> tyl lewy
|
||||
* ID sa przykladowe (24-bit). Najlepiej przepisz ID ze starych czujnikow
|
||||
* (odczytaj je rtl_433: rtl_433 -f 433.92M) - auto wtedy "widzi" znajome ID.
|
||||
* ====================================================================== */
|
||||
#define WHEEL_FL 0
|
||||
#define WHEEL_FR 1
|
||||
#define WHEEL_RR 2
|
||||
#define WHEEL_RL 3
|
||||
#define WHEEL_COUNT 4
|
||||
|
||||
/* Kolejnosc nauki (kolejnosc pozycji w tablicy SENSOR[] ponizej = kolejnosc
|
||||
* learn; domyslnie FL -> FR -> RR -> RL). Kolejnosc mozesz zmienic po prostu
|
||||
* przestawiajac wpisy w tablicy SENSOR[] w main.cpp (lub zmieniajac ponizsze
|
||||
* makra kolejnosci w trybie learn). */
|
||||
#define LEARN_ORDER_0 WHEEL_FL
|
||||
#define LEARN_ORDER_1 WHEEL_FR
|
||||
#define LEARN_ORDER_2 WHEEL_RR
|
||||
#define LEARN_ORDER_3 WHEEL_RL
|
||||
|
||||
/* ID poszczegolnych kol (24 bity) */
|
||||
#define SENSOR_FL_ID 0x2FC871u
|
||||
#define SENSOR_FR_ID 0x2EAAF9u
|
||||
#define SENSOR_RR_ID 0x3495ACu
|
||||
#define SENSOR_RL_ID 0x2FC780u
|
||||
|
||||
/* Cisnienie startowe: DOMYSLNIE 2,6 bar = 260 kPa dla wszystkich kol.
|
||||
* Rozdzielczosc protokolu: 2,5 kPa/bit (0-637,5 kPa). */
|
||||
#define SENSOR_FL_PRESS_KPA 260.0f
|
||||
#define SENSOR_FR_PRESS_KPA 260.0f
|
||||
#define SENSOR_RR_PRESS_KPA 260.0f
|
||||
#define SENSOR_RL_PRESS_KPA 260.0f
|
||||
|
||||
/* Temperatura otoczenia (st. C) - konwertowana na st. F wg protokolu. */
|
||||
#define SENSOR_TEMP_C 23
|
||||
|
||||
/* ======================================================================
|
||||
* 4. PARAMETRY RF (Schrader EG53MA4)
|
||||
* - dane: Manchester G.E.T. MC, chip = 120 us (8.33 kBaud)
|
||||
* - nośna 433.92 MHz
|
||||
* - modulacja: ASK/OOK (domyślna - tak pracuje referencyjny EG53MA4 z
|
||||
* nagran rtl_433_tests i tak dekoderuje wbudowany Schrader-EG53MA4)
|
||||
* albo 2-FSK z dewiacja 47.6 kHz (wariant konfigurowalny - jesli Twoj
|
||||
* nadajnik/odbiornik auta pracuje FSK, przełacz MODE_FSK).
|
||||
* ====================================================================== */
|
||||
#define MODE_OOK 0
|
||||
#define MODE_FSK 1
|
||||
|
||||
#define TPMS_FREQUENCY_MHZ 433.92f
|
||||
#define TPMS_MODULATION MODE_OOK
|
||||
#define TPMS_DEVIATION_KHZ 47.6f // dla MODE_FSK
|
||||
#define TPMS_TX_POWER_DBM 10 // -30,-20,-15,-10,-6,0,5,7,10,11,12
|
||||
#define TPMS_CHIP_US 120 // czas trwania jednego chipa Manchester
|
||||
// (8.33 kBaud - zmierzone na nagraniach)
|
||||
|
||||
/* Ramka (dane z dekodera rtl_433 schrader_EG53MA4):
|
||||
* 40 bit sync + 4 bajty flags + 3 bajty ID + cisnienie + temperatura + CRC.
|
||||
* Suma kontrolna: suma 9 bajtow modulo 256 (add_bytes). */
|
||||
#define TPMS_FLAGS 0x4C900070u // flags ze zrzutow prawdziwych czujnikow
|
||||
#define TPMS_FLAGS_LOWBAT_MASK 0x00000008u // bit "rozladowana bateria"
|
||||
// (pozycja niepewna - dostosuj
|
||||
// jesli Twoj sterownik oczekuje
|
||||
// innego bitu)
|
||||
|
||||
/* ======================================================================
|
||||
* 5. HARMONOGRAM NADAWANIA / SEN
|
||||
* ====================================================================== */
|
||||
#define TX_BURST_FRAMES 3 // 3-6 ramek w burście (jak prawdziwy czujnik)
|
||||
#define TX_FRAME_GAP_MS 50 // odstep miedzy ramkami w burscie
|
||||
#define TX_INTERVAL_S 30 // interwal: kazde kolo co 30 s
|
||||
#define TX_INTERVAL_IGNITION_S 15 // krotki interwal przy zaplonie (ACC)
|
||||
#define TX_INTERVAL_PARKING_S 120 // interwal postojowy po zaniku ACC
|
||||
#define ACC_GRACE_MS (5UL*60UL*1000UL) // 5 min po zaniku ACC
|
||||
#define PARKING_SHUTDOWN 0 // 1 = po ACC_GRACE calkowite uspienie
|
||||
// (sen bez budzika, obudza przycisk/LF)
|
||||
#define BOOT_STAY_AWAKE_MS 3000 // okno na konsoli szeregowej po starcie
|
||||
|
||||
/* ======================================================================
|
||||
* 6. TRYB LEARN / SINGLE
|
||||
* ====================================================================== */
|
||||
#define LEARN_TX_PERIOD_MS 2000 // co ile ms wysylac bursta w learn
|
||||
#define LEARN_WINDOW_MS 60000 // okno czasowe na 1 czujnik (60 s)
|
||||
#define LEARN_WINDOW_EXPIRE_TO_NORMAL 1 // 1 = po uplywie okna powrot do
|
||||
// trybu normalnego (wg specyfikacji),
|
||||
// 0 = automatycznie kolejne kolo,
|
||||
// po ostatnim -> NORMAL
|
||||
#define LEARN_TOTAL_TIMEOUT_MS 900000 // bezpiecznik: 15 min i koniec learn
|
||||
#define SINGLE_TIMEOUT_MS 300000 // 0 = bez limitu
|
||||
|
||||
/* ======================================================================
|
||||
* 7. PROGI / DIAGNOSTYKA
|
||||
* ====================================================================== */
|
||||
#define LOWBATT_THRESHOLD_MV 11500 // dla POWER_12V (prog alarmu TPMS)
|
||||
// dla POWER_BATTERY ustaw np. 3200
|
||||
#define SERIAL_BAUD 115200
|
||||
|
||||
/* ======================================================================
|
||||
* 8. GESTY PRZYCISKU
|
||||
* ====================================================================== */
|
||||
#define BTN_DEBOUNCE_MS 30
|
||||
#define BTN_LONG_MS 1500 // >= 1.5 s = wejscie/wyjscie LEARN
|
||||
#define BTN_VERYLONG_MS 4000 // >= 4 s = wejscie/wyjscie SINGLE
|
||||
|
||||
#endif /* TPMS_CONFIG_H */
|
||||
+190
@@ -0,0 +1,190 @@
|
||||
/*
|
||||
* console.cpp - debugowa konsola szeregowa (bez String i bez malloc)
|
||||
*
|
||||
* Komendy:
|
||||
* help - lista komend
|
||||
* info - wersja, konfiguracja, stan, napiecie
|
||||
* hex [n|all] - hexdump ramki TPMS dla kola n (1-4) lub wszystkich
|
||||
* send [n|all] - wyslij burst ramki teraz
|
||||
* batt - pomiar napiecia zasilania
|
||||
* mode normal|learn|single [n] - zmiana trybu
|
||||
* next - kolejne kolo (learn/single)
|
||||
* interval <s> - reczy ustalony interwal (0 = auto wg ACC)
|
||||
* flags <hex> - slowo flags wyslane w ramce
|
||||
* sleep - deep sleep teraz
|
||||
* stay [s] - zostan w stanie czuwania jeszcze s sekund
|
||||
*/
|
||||
#include <Arduino.h>
|
||||
#include <string.h>
|
||||
#include <stdlib.h>
|
||||
|
||||
#include "config.h"
|
||||
#include "app.h"
|
||||
#include "console.h"
|
||||
|
||||
static char line[64];
|
||||
static uint8_t line_len = 0;
|
||||
|
||||
static void cmd_help(void)
|
||||
{
|
||||
Serial.println(F("Komendy:"));
|
||||
Serial.println(F(" help - ta pomoc"));
|
||||
Serial.println(F(" info - wersja/config/stan/napiecie"));
|
||||
Serial.println(F(" hex [n|all] - hexdump ramki kola n (1-4)"));
|
||||
Serial.println(F(" send [n|all] - nadaj burst teraz"));
|
||||
Serial.println(F(" batt - napiecie zasilania [mV]"));
|
||||
Serial.println(F(" mode normal|learn|single [n] - tryb pracy"));
|
||||
Serial.println(F(" next - kolejne kolo (learn/single)"));
|
||||
Serial.println(F(" interval <s> - interwal nadawania (0=auto)"));
|
||||
Serial.println(F(" flags <hex> - slowo flags w ramce"));
|
||||
Serial.println(F(" sleep - deep sleep teraz"));
|
||||
Serial.println(F(" stay [s] - czuwaj jeszcze s sekund"));
|
||||
}
|
||||
|
||||
static int parse_wheel(const char *arg, uint8_t *wheel)
|
||||
{
|
||||
if (arg == NULL) {
|
||||
return -1;
|
||||
}
|
||||
if (strcmp(arg, "all") == 0) {
|
||||
*wheel = 0xFF;
|
||||
return 0;
|
||||
}
|
||||
long n = strtol(arg, NULL, 10);
|
||||
if (n < 1 || n > WHEEL_COUNT) {
|
||||
return -1;
|
||||
}
|
||||
*wheel = (uint8_t)(n - 1);
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void handle_line(char *s)
|
||||
{
|
||||
char *cmd = strtok(s, " \t");
|
||||
if (cmd == NULL) {
|
||||
return;
|
||||
}
|
||||
char *arg1 = strtok(NULL, " \t");
|
||||
char *arg2 = strtok(NULL, " \t");
|
||||
|
||||
if (strcmp(cmd, "help") == 0) {
|
||||
cmd_help();
|
||||
}
|
||||
else if (strcmp(cmd, "info") == 0 || strcmp(cmd, "config") == 0) {
|
||||
app_print_info();
|
||||
}
|
||||
else if (strcmp(cmd, "hex") == 0) {
|
||||
uint8_t w;
|
||||
if (parse_wheel(arg1, &w) != 0) {
|
||||
w = 0xFF;
|
||||
}
|
||||
if (w == 0xFF) {
|
||||
for (uint8_t i = 0; i < WHEEL_COUNT; i++) {
|
||||
app_print_frame(i);
|
||||
}
|
||||
}
|
||||
else {
|
||||
app_print_frame(w);
|
||||
}
|
||||
}
|
||||
else if (strcmp(cmd, "send") == 0) {
|
||||
uint8_t w;
|
||||
if (parse_wheel(arg1, &w) != 0) {
|
||||
w = 0xFF;
|
||||
}
|
||||
if (w == 0xFF) {
|
||||
app_send_burst_all();
|
||||
}
|
||||
else {
|
||||
app_send_burst_wheel(w);
|
||||
}
|
||||
Serial.println(F("OK"));
|
||||
}
|
||||
else if (strcmp(cmd, "batt") == 0) {
|
||||
Serial.printf("Vcc = %u mV\n", (unsigned)app_supply_mv());
|
||||
}
|
||||
else if (strcmp(cmd, "next") == 0) {
|
||||
app_next_wheel();
|
||||
}
|
||||
else if (strcmp(cmd, "mode") == 0) {
|
||||
uint8_t w = 0;
|
||||
if (arg1 == NULL) {
|
||||
Serial.println(F("mode normal|learn|single [n]"));
|
||||
return;
|
||||
}
|
||||
if (strcmp(arg1, "normal") == 0) {
|
||||
app_set_mode(APP_MODE_NORMAL, 0);
|
||||
}
|
||||
else if (strcmp(arg1, "learn") == 0) {
|
||||
if (arg2 != NULL) {
|
||||
if (parse_wheel(arg2, &w) != 0) {
|
||||
w = 0;
|
||||
}
|
||||
}
|
||||
app_set_mode(APP_MODE_LEARN, w);
|
||||
}
|
||||
else if (strcmp(arg1, "single") == 0) {
|
||||
if (arg2 == NULL || parse_wheel(arg2, &w) != 0 || w == 0xFF) {
|
||||
Serial.println(F("single wymaga numeru kola 1-4"));
|
||||
return;
|
||||
}
|
||||
app_set_mode(APP_MODE_SINGLE, w);
|
||||
}
|
||||
else {
|
||||
Serial.println(F("mode normal|learn|single [n]"));
|
||||
return;
|
||||
}
|
||||
Serial.println(F("OK"));
|
||||
}
|
||||
else if (strcmp(cmd, "interval") == 0) {
|
||||
if (arg1 == NULL) {
|
||||
Serial.println(F("interval <s>"));
|
||||
return;
|
||||
}
|
||||
app_set_interval((uint32_t)strtoul(arg1, NULL, 10));
|
||||
Serial.println(F("OK"));
|
||||
}
|
||||
else if (strcmp(cmd, "flags") == 0) {
|
||||
if (arg1 == NULL) {
|
||||
Serial.println(F("flags <hex>"));
|
||||
return;
|
||||
}
|
||||
app_set_flags((uint32_t)strtoul(arg1, NULL, 16));
|
||||
Serial.println(F("OK"));
|
||||
}
|
||||
else if (strcmp(cmd, "sleep") == 0) {
|
||||
app_request_sleep();
|
||||
}
|
||||
else if (strcmp(cmd, "stay") == 0) {
|
||||
app_stay_awake(arg1 ? (uint32_t)strtoul(arg1, NULL, 10) * 1000u : 60000u);
|
||||
Serial.println(F("OK"));
|
||||
}
|
||||
else {
|
||||
Serial.println(F("Nieznana komenda - 'help'"));
|
||||
}
|
||||
}
|
||||
|
||||
void console_init(void)
|
||||
{
|
||||
line_len = 0;
|
||||
}
|
||||
|
||||
void console_poll(void)
|
||||
{
|
||||
while (Serial.available() > 0) {
|
||||
char c = (char)Serial.read();
|
||||
if (c == '\r' || c == '\n') {
|
||||
if (line_len > 0) {
|
||||
line[line_len] = '\0';
|
||||
handle_line(line);
|
||||
line_len = 0;
|
||||
}
|
||||
}
|
||||
else if (line_len < sizeof(line) - 1u) {
|
||||
line[line_len++] = c;
|
||||
}
|
||||
else {
|
||||
line_len = 0; // przepełnienie - porzuc linie
|
||||
}
|
||||
}
|
||||
}
|
||||
@@ -0,0 +1,18 @@
|
||||
/*
|
||||
* console.h - debugowa konsola szeregowa (bez String, stalobuforowa)
|
||||
*/
|
||||
#ifndef TPMS_CONSOLE_H
|
||||
#define TPMS_CONSOLE_H
|
||||
|
||||
#ifdef __cplusplus
|
||||
extern "C" {
|
||||
#endif
|
||||
|
||||
void console_init(void);
|
||||
void console_poll(void); // nieblokujaca obsluga linii - wywolywac w petli
|
||||
|
||||
#ifdef __cplusplus
|
||||
}
|
||||
#endif
|
||||
|
||||
#endif /* TPMS_CONSOLE_H */
|
||||
+476
@@ -0,0 +1,476 @@
|
||||
/*
|
||||
* main.cpp - symulator 4 czujnikow TPMS Schrader EG53MA4 (ESP32 + CC1101)
|
||||
* dla Opla Astry J Sedan 2016 (EU, 433 MHz, TPMS bezposredni).
|
||||
*
|
||||
* !!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!
|
||||
* ZASTRZEZENIE: projekt wylacznie diagnostyczny/testowy.
|
||||
* Symulator dostarcza SZTUCZNE dane cisnienia i temperatury i NIE
|
||||
* zastepuje prawdziwych czujnikow TPMS. Nie uzywac podczas jazdy.
|
||||
* !!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!
|
||||
*
|
||||
* Tryby pracy:
|
||||
* NORMAL - rotacja 4 kol, burst 3-5 ramek co TX_INTERVAL_S, deep sleep
|
||||
* miedzy transmisjami (budzik RTC + budzenie przyciskiem/LF)
|
||||
* LEARN - nauka czujnikow w aucie: jedno kolo naraz, kolejnosc
|
||||
* FL -> FR -> RR -> RL, przycisk = kolejne kolo, okno czasowe
|
||||
* SINGLE - wymuszone nadawanie jednego ID (testy/procedury serwisowe)
|
||||
*
|
||||
* Protokol: rtl_433 src/devices/schraeder.c (schrader_EG53MA4),
|
||||
* Manchester G.E.T. MC, chip 120 us, ASK/OOK 433.92 MHz (opcjonalnie 2-FSK).
|
||||
*/
|
||||
#include <Arduino.h>
|
||||
#include <esp_sleep.h>
|
||||
#include <driver/gpio.h>
|
||||
|
||||
#include "config.h"
|
||||
#include "tpms_frame.h"
|
||||
#include "radio.h"
|
||||
#include "power.h"
|
||||
#include "ui.h"
|
||||
#include "console.h"
|
||||
#include "app.h"
|
||||
|
||||
/* ------------------------------------------------------------------ */
|
||||
/* Dane czujnikow (mapowanie ID -> kolo) */
|
||||
/* ------------------------------------------------------------------ */
|
||||
#define KPA10(x) ((uint16_t)((x) * 10.0f + 0.5f))
|
||||
|
||||
static const tpms_sensor_t SENSOR[WHEEL_COUNT] = {
|
||||
{ SENSOR_FL_ID, KPA10(SENSOR_FL_PRESS_KPA), SENSOR_TEMP_C, "FL" },
|
||||
{ SENSOR_FR_ID, KPA10(SENSOR_FR_PRESS_KPA), SENSOR_TEMP_C, "FR" },
|
||||
{ SENSOR_RR_ID, KPA10(SENSOR_RR_PRESS_KPA), SENSOR_TEMP_C, "RR" },
|
||||
{ SENSOR_RL_ID, KPA10(SENSOR_RL_PRESS_KPA), SENSOR_TEMP_C, "RL" },
|
||||
};
|
||||
|
||||
/* Kolejnosc nauki (kolejnosc w tablicy SENSOR = FL, FR, RR, RL). */
|
||||
static const uint8_t LEARN_SEQ[WHEEL_COUNT] = {
|
||||
LEARN_ORDER_0, LEARN_ORDER_1, LEARN_ORDER_2, LEARN_ORDER_3,
|
||||
};
|
||||
|
||||
/* ------------------------------------------------------------------ */
|
||||
/* Stan w RTC (przetrwuje deep sleep) */
|
||||
/* ------------------------------------------------------------------ */
|
||||
#define RTC_MAGIC 0x54504D53u // 'TPMS'
|
||||
|
||||
RTC_DATA_ATTR static uint32_t rtc_magic;
|
||||
RTC_DATA_ATTR static uint8_t rtc_mode = APP_MODE_NORMAL;
|
||||
RTC_DATA_ATTR static uint8_t rtc_seq_idx = 0; // indeks w LEARN_SEQ
|
||||
RTC_DATA_ATTR static uint8_t rtc_rot_idx = 0; // rotacja w NORMAL
|
||||
RTC_DATA_ATTR static uint32_t rtc_wake_count = 0;
|
||||
RTC_DATA_ATTR static uint32_t rtc_interval_s = 0; // 0 = auto wg ACC
|
||||
RTC_DATA_ATTR static uint32_t rtc_flags = TPMS_FLAGS;
|
||||
RTC_DATA_ATTR static uint64_t rtc_last_acc_ms = 0;
|
||||
|
||||
/* Stan sesji (wazny tylko w biezaczym wybudzeniu) */
|
||||
static uint32_t stay_awake_until = 0;
|
||||
static uint32_t next_tx_ms = 0;
|
||||
static uint32_t learn_window_start = 0;
|
||||
static uint32_t learn_session_start = 0;
|
||||
static uint32_t single_start = 0;
|
||||
static bool request_sleep = false;
|
||||
static bool low_batt = false;
|
||||
static uint32_t supply_mv = 0;
|
||||
|
||||
/* ------------------------------------------------------------------ */
|
||||
/* Pomocnicze */
|
||||
/* ------------------------------------------------------------------ */
|
||||
static uint8_t active_wheel(void)
|
||||
{
|
||||
return LEARN_SEQ[rtc_seq_idx % WHEEL_COUNT];
|
||||
}
|
||||
|
||||
static void refresh_power(void)
|
||||
{
|
||||
supply_mv = power_read_mv();
|
||||
low_batt = power_low_battery(supply_mv);
|
||||
}
|
||||
|
||||
static void build_frame_for(uint8_t wheel, uint8_t out[TPMS_TX_BYTES])
|
||||
{
|
||||
const tpms_sensor_t *s = &SENSOR[wheel % WHEEL_COUNT];
|
||||
tpms_build_frame(out, s->id, s->press_kpa10, s->temp_c, rtc_flags, low_batt);
|
||||
}
|
||||
|
||||
void app_send_burst_wheel(uint8_t wheel)
|
||||
{
|
||||
uint8_t frame[TPMS_TX_BYTES];
|
||||
build_frame_for(wheel, frame);
|
||||
radio_send_burst(frame, TPMS_TX_BYTES, TX_BURST_FRAMES);
|
||||
Serial.printf("TX %s id=%06X %.1f kPa %d C flags=%08X%s\n",
|
||||
SENSOR[wheel % WHEEL_COUNT].name,
|
||||
(unsigned)SENSOR[wheel % WHEEL_COUNT].id,
|
||||
SENSOR[wheel % WHEEL_COUNT].press_kpa10 / 10.0f,
|
||||
(int)SENSOR[wheel % WHEEL_COUNT].temp_c,
|
||||
(unsigned)rtc_flags, low_batt ? " LOWBATT" : "");
|
||||
}
|
||||
|
||||
void app_send_burst_all(void)
|
||||
{
|
||||
for (uint8_t i = 0; i < WHEEL_COUNT; i++) {
|
||||
app_send_burst_wheel((uint8_t)((rtc_rot_idx + i) % WHEEL_COUNT));
|
||||
}
|
||||
rtc_rot_idx = (uint8_t)((rtc_rot_idx + 1) % WHEEL_COUNT);
|
||||
}
|
||||
|
||||
void app_print_frame(uint8_t wheel)
|
||||
{
|
||||
uint8_t frame[TPMS_TX_BYTES];
|
||||
uint8_t payload[TPMS_PAYLOAD_LEN];
|
||||
const tpms_sensor_t *s = &SENSOR[wheel % WHEEL_COUNT];
|
||||
build_frame_for(wheel, frame);
|
||||
tpms_build_payload(payload, s->id, s->press_kpa10, s->temp_c, rtc_flags, low_batt);
|
||||
|
||||
Serial.printf("%s frame:", s->name);
|
||||
for (uint8_t i = 0; i < TPMS_TX_BYTES; i++) {
|
||||
Serial.printf(" %02X", frame[i]);
|
||||
}
|
||||
Serial.printf("\n%s payload:", s->name);
|
||||
for (uint8_t i = 0; i < TPMS_PAYLOAD_LEN; i++) {
|
||||
Serial.printf(" %02X", payload[i]);
|
||||
}
|
||||
Serial.printf(" crc=%02X id=%06X press=%.1f kPa temp=%d F\n",
|
||||
payload[9], (unsigned)s->id,
|
||||
payload[7] * 2.5f, (int)payload[8]);
|
||||
}
|
||||
|
||||
void app_print_info(void)
|
||||
{
|
||||
Serial.printf("FW %s config v%d mode=%s wheel=%s\n",
|
||||
FW_VERSION, CONFIG_VERSION,
|
||||
rtc_mode == APP_MODE_NORMAL ? "NORMAL" :
|
||||
rtc_mode == APP_MODE_LEARN ? "LEARN" : "SINGLE",
|
||||
SENSOR[active_wheel()].name);
|
||||
for (uint8_t i = 0; i < WHEEL_COUNT; i++) {
|
||||
Serial.printf(" %s id=%06X press=%.1f kPa temp=%d C\n",
|
||||
SENSOR[i].name, (unsigned)SENSOR[i].id,
|
||||
SENSOR[i].press_kpa10 / 10.0f, (int)SENSOR[i].temp_c);
|
||||
}
|
||||
Serial.printf("flags=%08X mod=%s chip=%dus burst=%d interval=%us wake=%lu\n",
|
||||
(unsigned)rtc_flags,
|
||||
TPMS_MODULATION == MODE_FSK ? "FSK" : "OOK",
|
||||
TPMS_CHIP_US, TX_BURST_FRAMES,
|
||||
(unsigned)(rtc_interval_s ? rtc_interval_s : TX_INTERVAL_S),
|
||||
(unsigned long)rtc_wake_count);
|
||||
Serial.printf("Vcc=%u mV%s\n", (unsigned)supply_mv, low_batt ? " LOWBATT" : "");
|
||||
}
|
||||
|
||||
uint32_t app_supply_mv(void)
|
||||
{
|
||||
refresh_power();
|
||||
return supply_mv;
|
||||
}
|
||||
|
||||
void app_set_interval(uint32_t seconds)
|
||||
{
|
||||
rtc_interval_s = seconds;
|
||||
}
|
||||
|
||||
void app_set_flags(uint32_t flags)
|
||||
{
|
||||
rtc_flags = flags;
|
||||
}
|
||||
|
||||
void app_request_sleep(void)
|
||||
{
|
||||
request_sleep = true;
|
||||
}
|
||||
|
||||
void app_stay_awake(uint32_t ms)
|
||||
{
|
||||
uint32_t until = millis() + ms;
|
||||
if ((int32_t)(until - stay_awake_until) > 0) {
|
||||
stay_awake_until = until;
|
||||
}
|
||||
}
|
||||
|
||||
uint8_t app_mode(void)
|
||||
{
|
||||
return rtc_mode;
|
||||
}
|
||||
|
||||
uint8_t app_wheel(void)
|
||||
{
|
||||
return active_wheel();
|
||||
}
|
||||
|
||||
void app_next_wheel(void)
|
||||
{
|
||||
rtc_seq_idx = (uint8_t)((rtc_seq_idx + 1) % WHEEL_COUNT);
|
||||
ui_blink_count((uint8_t)(rtc_seq_idx + 1));
|
||||
Serial.printf("Kolo: %s (learn: %d/%d)\n", SENSOR[active_wheel()].name,
|
||||
(int)rtc_seq_idx + 1, WHEEL_COUNT);
|
||||
learn_window_start = millis();
|
||||
}
|
||||
|
||||
void app_set_mode(uint8_t mode, uint8_t wheel)
|
||||
{
|
||||
rtc_mode = mode;
|
||||
switch (mode) {
|
||||
case APP_MODE_LEARN:
|
||||
rtc_seq_idx = (uint8_t)(wheel % WHEEL_COUNT);
|
||||
learn_window_start = millis();
|
||||
learn_session_start = millis();
|
||||
next_tx_ms = 0;
|
||||
ui_set_pattern(UI_PAT_LEARN);
|
||||
ui_blink_count((uint8_t)(rtc_seq_idx + 1));
|
||||
Serial.printf("LEARN start, kolo %s\n", SENSOR[active_wheel()].name);
|
||||
app_stay_awake(LEARN_TOTAL_TIMEOUT_MS);
|
||||
break;
|
||||
case APP_MODE_SINGLE:
|
||||
rtc_seq_idx = (uint8_t)(wheel % WHEEL_COUNT);
|
||||
single_start = millis();
|
||||
next_tx_ms = 0;
|
||||
ui_set_pattern(UI_PAT_SINGLE);
|
||||
ui_blink_count((uint8_t)(rtc_seq_idx + 1));
|
||||
Serial.printf("SINGLE start, kolo %s\n", SENSOR[active_wheel()].name);
|
||||
app_stay_awake(SINGLE_TIMEOUT_MS ? SINGLE_TIMEOUT_MS : 3600000u);
|
||||
break;
|
||||
default:
|
||||
rtc_mode = APP_MODE_NORMAL;
|
||||
ui_set_pattern(UI_PAT_NORMAL);
|
||||
Serial.println(F("NORMAL"));
|
||||
next_tx_ms = 0;
|
||||
app_stay_awake(BOOT_STAY_AWAKE_MS);
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
/* ------------------------------------------------------------------ */
|
||||
/* Cykl nadawczy w trybie NORMAL */
|
||||
/* ------------------------------------------------------------------ */
|
||||
static uint32_t compute_interval(void)
|
||||
{
|
||||
if (rtc_interval_s != 0) {
|
||||
return rtc_interval_s;
|
||||
}
|
||||
uint64_t now_ms = power_elapsed_ms() + millis();
|
||||
#if PIN_ACC >= 0
|
||||
if (digitalRead(PIN_ACC) == HIGH) {
|
||||
rtc_last_acc_ms = now_ms;
|
||||
return (uint32_t)TX_INTERVAL_IGNITION_S;
|
||||
}
|
||||
#endif
|
||||
if (now_ms - rtc_last_acc_ms > (uint64_t)ACC_GRACE_MS) {
|
||||
return PARKING_SHUTDOWN ? 0u : (uint32_t)TX_INTERVAL_PARKING_S;
|
||||
}
|
||||
return (uint32_t)TX_INTERVAL_S;
|
||||
}
|
||||
|
||||
static void tx_cycle(void)
|
||||
{
|
||||
refresh_power();
|
||||
app_send_burst_all();
|
||||
}
|
||||
|
||||
static void go_sleep(uint32_t seconds)
|
||||
{
|
||||
Serial.printf("sleep %us\n", (unsigned)seconds);
|
||||
Serial.flush();
|
||||
power_elapsed_add_ms(millis() + (uint64_t)seconds * 1000u);
|
||||
power_deep_sleep(seconds); // nie wraca
|
||||
}
|
||||
|
||||
/* ------------------------------------------------------------------ */
|
||||
void setup(void)
|
||||
{
|
||||
Serial.begin(SERIAL_BAUD);
|
||||
ui_init();
|
||||
power_init();
|
||||
console_init();
|
||||
|
||||
#if PIN_LF_TRIGGER >= 0
|
||||
pinMode(PIN_LF_TRIGGER, INPUT_PULLDOWN);
|
||||
#endif
|
||||
#if PIN_ACC >= 0
|
||||
pinMode(PIN_ACC, INPUT_PULLDOWN);
|
||||
#endif
|
||||
|
||||
if (rtc_magic != RTC_MAGIC) {
|
||||
rtc_magic = RTC_MAGIC;
|
||||
rtc_mode = APP_MODE_NORMAL;
|
||||
rtc_seq_idx = 0;
|
||||
rtc_rot_idx = 0;
|
||||
rtc_wake_count = 0;
|
||||
rtc_interval_s = 0;
|
||||
rtc_flags = TPMS_FLAGS;
|
||||
rtc_last_acc_ms = 0;
|
||||
}
|
||||
rtc_wake_count++;
|
||||
|
||||
bool radio_ok = radio_init();
|
||||
Serial.println();
|
||||
Serial.printf("TPMS simulator FW %s (config v%d) - SYMULATOR, dane sztuczne!\n",
|
||||
FW_VERSION, CONFIG_VERSION);
|
||||
if (!radio_ok) {
|
||||
Serial.println(F("BLAD: brak modulu CC1101 (sprawdz SPI)"));
|
||||
}
|
||||
|
||||
refresh_power();
|
||||
if (low_batt) {
|
||||
Serial.printf("OSTRZEZENIE: niskie napiecie zasilania %u mV!\n",
|
||||
(unsigned)supply_mv);
|
||||
}
|
||||
|
||||
esp_sleep_wakeup_cause_t cause = esp_sleep_get_wakeup_cause();
|
||||
uint32_t iv = compute_interval();
|
||||
|
||||
switch (cause) {
|
||||
case ESP_SLEEP_WAKEUP_TIMER:
|
||||
/* zwykly cykl - nadaj i spij bez czuwania */
|
||||
next_tx_ms = 0;
|
||||
stay_awake_until = 0;
|
||||
break;
|
||||
|
||||
case ESP_SLEEP_WAKEUP_EXT0:
|
||||
/* przycisk - obsluga gestu w petli, krotkie okno konsoli */
|
||||
Serial.println(F("wake: button"));
|
||||
next_tx_ms = UINT32_MAX; // nie nadawaj automatycznie
|
||||
stay_awake_until = millis() + BOOT_STAY_AWAKE_MS;
|
||||
break;
|
||||
|
||||
case ESP_SLEEP_WAKEUP_EXT1: {
|
||||
uint64_t st = esp_sleep_get_ext1_wakeup_status();
|
||||
Serial.printf("wake: ext1 mask=%08X%08X\n",
|
||||
(unsigned)(st >> 32), (unsigned)(st & 0xFFFFFFFFu));
|
||||
refresh_power();
|
||||
app_send_burst_wheel(active_wheel()); // aktywacja LF = natychmiast
|
||||
next_tx_ms = UINT32_MAX;
|
||||
stay_awake_until = millis() + BOOT_STAY_AWAKE_MS;
|
||||
break;
|
||||
}
|
||||
|
||||
default:
|
||||
Serial.println(F("wake: power-on"));
|
||||
next_tx_ms = 0;
|
||||
stay_awake_until = millis() + BOOT_STAY_AWAKE_MS;
|
||||
break;
|
||||
}
|
||||
|
||||
if (rtc_mode == APP_MODE_LEARN) {
|
||||
ui_set_pattern(UI_PAT_LEARN);
|
||||
learn_window_start = millis();
|
||||
learn_session_start = millis();
|
||||
next_tx_ms = 0;
|
||||
stay_awake_until = millis() + LEARN_TOTAL_TIMEOUT_MS;
|
||||
}
|
||||
else if (rtc_mode == APP_MODE_SINGLE) {
|
||||
ui_set_pattern(UI_PAT_SINGLE);
|
||||
single_start = millis();
|
||||
next_tx_ms = 0;
|
||||
stay_awake_until = millis() +
|
||||
(SINGLE_TIMEOUT_MS ? SINGLE_TIMEOUT_MS : 3600000u);
|
||||
}
|
||||
else {
|
||||
ui_set_pattern(low_batt ? UI_PAT_LOWBAT : UI_PAT_NORMAL);
|
||||
}
|
||||
|
||||
Serial.printf("Vcc=%u mV tryb=%d interwal=%us\n", (unsigned)supply_mv,
|
||||
(int)rtc_mode, (unsigned)iv);
|
||||
app_print_info();
|
||||
Serial.println(F("gotowy ('help' - komendy)"));
|
||||
}
|
||||
|
||||
void loop(void)
|
||||
{
|
||||
uint32_t now = millis();
|
||||
|
||||
ui_update();
|
||||
|
||||
/* gesty przycisku */
|
||||
ui_event_t ev = ui_poll();
|
||||
if (ev == UI_EV_SHORT) {
|
||||
if (rtc_mode == APP_MODE_NORMAL) {
|
||||
refresh_power();
|
||||
app_send_burst_all(); // "aktywuj kolo" - nadaj teraz
|
||||
}
|
||||
else {
|
||||
app_next_wheel(); // learn/single: kolejne kolo
|
||||
}
|
||||
}
|
||||
else if (ev == UI_EV_LONG) {
|
||||
if (rtc_mode == APP_MODE_LEARN) {
|
||||
app_set_mode(APP_MODE_NORMAL, 0);
|
||||
}
|
||||
else {
|
||||
app_set_mode(APP_MODE_LEARN, 0);
|
||||
}
|
||||
}
|
||||
else if (ev == UI_EV_VERYLONG) {
|
||||
if (rtc_mode == APP_MODE_SINGLE) {
|
||||
app_set_mode(APP_MODE_NORMAL, 0);
|
||||
}
|
||||
else {
|
||||
app_set_mode(APP_MODE_SINGLE, rtc_seq_idx);
|
||||
}
|
||||
}
|
||||
|
||||
console_poll();
|
||||
|
||||
#if PIN_LF_TRIGGER >= 0
|
||||
/* aktywacja LF tez dziala "na zywo" (nie tylko przez budzenie) */
|
||||
{
|
||||
static bool lf_prev = false;
|
||||
bool lf = (digitalRead(PIN_LF_TRIGGER) == HIGH);
|
||||
if (lf && !lf_prev) {
|
||||
refresh_power();
|
||||
app_send_burst_wheel(active_wheel());
|
||||
}
|
||||
lf_prev = lf;
|
||||
}
|
||||
#endif
|
||||
|
||||
if (request_sleep) {
|
||||
request_sleep = false;
|
||||
go_sleep(compute_interval());
|
||||
}
|
||||
|
||||
switch (rtc_mode) {
|
||||
case APP_MODE_LEARN:
|
||||
if ((int32_t)(now - next_tx_ms) >= 0) {
|
||||
refresh_power();
|
||||
app_send_burst_wheel(active_wheel());
|
||||
next_tx_ms = now + LEARN_TX_PERIOD_MS;
|
||||
}
|
||||
if (now - learn_window_start >= LEARN_WINDOW_MS) {
|
||||
if (LEARN_WINDOW_EXPIRE_TO_NORMAL) {
|
||||
Serial.println(F("okno learn minelo - powrot do NORMAL"));
|
||||
app_set_mode(APP_MODE_NORMAL, 0);
|
||||
}
|
||||
else if (rtc_seq_idx + 1u >= WHEEL_COUNT) {
|
||||
Serial.println(F("learn ukonczony - powrot do NORMAL"));
|
||||
app_set_mode(APP_MODE_NORMAL, 0);
|
||||
}
|
||||
else {
|
||||
app_next_wheel();
|
||||
}
|
||||
}
|
||||
if (now - learn_session_start >= LEARN_TOTAL_TIMEOUT_MS) {
|
||||
Serial.println(F("timeout learn - powrot do NORMAL"));
|
||||
app_set_mode(APP_MODE_NORMAL, 0);
|
||||
}
|
||||
break;
|
||||
|
||||
case APP_MODE_SINGLE:
|
||||
if ((int32_t)(now - next_tx_ms) >= 0) {
|
||||
refresh_power();
|
||||
app_send_burst_wheel(active_wheel());
|
||||
next_tx_ms = now + LEARN_TX_PERIOD_MS;
|
||||
}
|
||||
if (SINGLE_TIMEOUT_MS && now - single_start >= SINGLE_TIMEOUT_MS) {
|
||||
Serial.println(F("timeout single - powrot do NORMAL"));
|
||||
app_set_mode(APP_MODE_NORMAL, 0);
|
||||
}
|
||||
break;
|
||||
|
||||
default: /* NORMAL */
|
||||
if (next_tx_ms != UINT32_MAX && (int32_t)(now - next_tx_ms) >= 0) {
|
||||
uint32_t iv = compute_interval();
|
||||
tx_cycle();
|
||||
next_tx_ms = now + (iv ? iv : 3600u) * 1000u;
|
||||
}
|
||||
if ((int32_t)(now - stay_awake_until) >= 0) {
|
||||
go_sleep(compute_interval());
|
||||
}
|
||||
break;
|
||||
}
|
||||
}
|
||||
@@ -0,0 +1,98 @@
|
||||
/*
|
||||
* power.cpp - zasilanie, pomiar napiecia, deep sleep
|
||||
*
|
||||
* Zastrzezenie: urzadzenie diagnostyczne/testowe - symulator TPMS
|
||||
* dostarcza sztuczne dane cisnienia i nie zastepuje prawdziwych czujnikow.
|
||||
*
|
||||
* Budzet pradu (patrz README):
|
||||
* - ESP32 deep sleep: ~10 uA (WiFi/BT nie sa wcale inicjalizowane)
|
||||
* - CC1101 w SLEEP (SPWD): < 1 uA
|
||||
* - gpio_hold trzyma linie CC1101 w stanach niskich/wysokiej CS
|
||||
*/
|
||||
#include <Arduino.h>
|
||||
#include <esp_sleep.h>
|
||||
#include <driver/gpio.h>
|
||||
#include <esp32-hal-bt.h>
|
||||
|
||||
#include "config.h"
|
||||
#include "power.h"
|
||||
#include "radio.h"
|
||||
|
||||
RTC_DATA_ATTR static uint64_t rtc_elapsed_ms = 0;
|
||||
|
||||
void power_init(void)
|
||||
{
|
||||
/* Zwolnij hold z poprzedniego snu - po deep sleep piny sa zatrzymane. */
|
||||
gpio_deep_sleep_hold_dis();
|
||||
gpio_hold_dis((gpio_num_t)PIN_CC1101_CS);
|
||||
gpio_hold_dis((gpio_num_t)PIN_CC1101_SCK);
|
||||
gpio_hold_dis((gpio_num_t)PIN_CC1101_MOSI);
|
||||
|
||||
/* WiFi nie jest wcale uruchamiany (brak init), BT wylaczamy defensywnie. */
|
||||
btStop();
|
||||
|
||||
analogSetPinAttenuation(PIN_VBAT_ADC, ADC_11db);
|
||||
}
|
||||
|
||||
uint32_t power_read_mv(void)
|
||||
{
|
||||
uint64_t sum = 0;
|
||||
for (int i = 0; i < VBAT_SAMPLES; i++) {
|
||||
sum += analogReadMilliVolts(PIN_VBAT_ADC);
|
||||
}
|
||||
uint32_t pin_mv = (uint32_t)(sum / VBAT_SAMPLES);
|
||||
float v = (float)pin_mv * ((VBAT_DIVIDER_R1 + VBAT_DIVIDER_R2) / VBAT_DIVIDER_R2)
|
||||
* VBAT_CAL;
|
||||
return (uint32_t)(v + 0.5f);
|
||||
}
|
||||
|
||||
bool power_low_battery(uint32_t mv)
|
||||
{
|
||||
return mv > 500u && mv < (uint32_t)LOWBATT_THRESHOLD_MV;
|
||||
}
|
||||
|
||||
void power_deep_sleep(uint32_t seconds)
|
||||
{
|
||||
/* CC1101 w sleep + bezpieczne stany linii (CS=1 utrzymuje SPWD). */
|
||||
radio_sleep();
|
||||
|
||||
/* Zatrzymaj piny w tych stanach na czas snu. */
|
||||
gpio_hold_en((gpio_num_t)PIN_CC1101_CS);
|
||||
gpio_hold_en((gpio_num_t)PIN_CC1101_SCK);
|
||||
gpio_hold_en((gpio_num_t)PIN_CC1101_MOSI);
|
||||
gpio_deep_sleep_hold_en();
|
||||
|
||||
/* Budzik RTC. */
|
||||
esp_sleep_disable_wakeup_source(ESP_SLEEP_WAKEUP_ALL);
|
||||
if (seconds > 0) {
|
||||
esp_sleep_enable_timer_wakeup((uint64_t)seconds * 1000000ULL);
|
||||
}
|
||||
|
||||
/* Przycisk jako zrodlo EXT0 (poziom konfigurowalny). */
|
||||
#if PIN_BUTTON >= 0
|
||||
esp_sleep_enable_ext0_wakeup((gpio_num_t)PIN_BUTTON, BTN_ACTIVE_LEVEL);
|
||||
#endif
|
||||
|
||||
/* Opcjonalne wejscie LF 125 kHz (impuls wysoki) jako EXT1.
|
||||
* Uwaga: poziom musi byc niski w spoczynku, inaczej ESP32 obudzi sie
|
||||
* natychmiast po wejsciu w sen. */
|
||||
uint64_t ext1_mask = 0;
|
||||
#if PIN_LF_TRIGGER >= 0
|
||||
ext1_mask |= (1ULL << PIN_LF_TRIGGER);
|
||||
#endif
|
||||
if (ext1_mask != 0) {
|
||||
esp_sleep_enable_ext1_wakeup(ext1_mask, ESP_EXT1_WAKEUP_ANY_HIGH);
|
||||
}
|
||||
|
||||
esp_deep_sleep_start();
|
||||
}
|
||||
|
||||
uint64_t power_elapsed_ms(void)
|
||||
{
|
||||
return rtc_elapsed_ms;
|
||||
}
|
||||
|
||||
void power_elapsed_add_ms(uint64_t delta_ms)
|
||||
{
|
||||
rtc_elapsed_ms += delta_ms;
|
||||
}
|
||||
+36
@@ -0,0 +1,36 @@
|
||||
/*
|
||||
* power.h - zasilanie, pomiar napiecia, deep sleep
|
||||
*/
|
||||
#ifndef TPMS_POWER_H
|
||||
#define TPMS_POWER_H
|
||||
|
||||
#include <stdint.h>
|
||||
#include <stdbool.h>
|
||||
|
||||
#ifdef __cplusplus
|
||||
extern "C" {
|
||||
#endif
|
||||
|
||||
/* Wywolac raz po starcie (zwalnia gpio_hold z poprzedniego snu). */
|
||||
void power_init(void);
|
||||
|
||||
/* Pomiar napiecia zasilania [mV] (dzielnik ADC + kalibracja). */
|
||||
uint32_t power_read_mv(void);
|
||||
|
||||
/* Decyzja o fladze "niska bateria" (prog LOWBATT_THRESHOLD_MV). */
|
||||
bool power_low_battery(uint32_t mV);
|
||||
|
||||
/* Przygotuj i wejdz w deep sleep na `seconds` (0 = bez budzika, tylko
|
||||
* przycisk/LF). Funkcja nie wraca. */
|
||||
void power_deep_sleep(uint32_t seconds);
|
||||
|
||||
/* Suma czasu pracy [ms] od pierwszego uruchomienia - licznik w RTC
|
||||
* przetrwuje deep sleep; uzywane do logiki "5 min po zaniku ACC". */
|
||||
uint64_t power_elapsed_ms(void);
|
||||
void power_elapsed_add_ms(uint64_t delta_ms);
|
||||
|
||||
#ifdef __cplusplus
|
||||
}
|
||||
#endif
|
||||
|
||||
#endif /* TPMS_POWER_H */
|
||||
+137
@@ -0,0 +1,137 @@
|
||||
/*
|
||||
* radio.cpp - konfiguracja CC1101 i nadawanie ramek TPMS
|
||||
*
|
||||
* Modul: CC1101 po SPI (SCK=18, MISO=19, MOSI=23, CS=5, GDO0=2).
|
||||
* Biblioteka: SmartRC-CC1101-Driver-Lib (LSatan), naglowek zgodnosciowy
|
||||
* ELECHOUSE_CC1101_SRC_DRV.h - obslugiwane sa obie wersje API (2.x i 3.x).
|
||||
*
|
||||
* Nadawanie: tryb FIFO (pakiet o stalej dlugosci, bez preambuly/sync/CRC
|
||||
* CC1101 - wszystkie bity, lacznie z preambula i wlasna suma kontrolna,
|
||||
* leza w naszym buforze). Kolejnosc bitow MSB first.
|
||||
*/
|
||||
#include <Arduino.h>
|
||||
#include <SPI.h>
|
||||
#include <ELECHOUSE_CC1101_SRC_DRV.h>
|
||||
#include <driver/gpio.h>
|
||||
|
||||
#include "config.h"
|
||||
#include "radio.h"
|
||||
#include "tpms_frame.h"
|
||||
|
||||
static bool radio_ok = false;
|
||||
|
||||
static void radio_set_pins(void)
|
||||
{
|
||||
#if defined(SMARTRC_CC1101_H) /* SmartRC-CC1101-Driver-Lib 3.x */
|
||||
ELECHOUSE_cc1101.setSpiPin(PIN_CC1101_SCK, PIN_CC1101_MISO,
|
||||
PIN_CC1101_MOSI, PIN_CC1101_CS);
|
||||
ELECHOUSE_cc1101.setGDO0(PIN_CC1101_GDO0);
|
||||
#else /* klasyczne ELECHOUSE_CC1101_SRC_DRV 1.x/2.x */
|
||||
ELECHOUSE_cc1101.setSCK(PIN_CC1101_SCK);
|
||||
ELECHOUSE_cc1101.setMISO(PIN_CC1101_MISO);
|
||||
ELECHOUSE_cc1101.setMOSI(PIN_CC1101_MOSI);
|
||||
ELECHOUSE_cc1101.setCS(PIN_CC1101_CS);
|
||||
ELECHOUSE_cc1101.setGDO0(PIN_CC1101_GDO0);
|
||||
#endif
|
||||
}
|
||||
|
||||
bool radio_init(void)
|
||||
{
|
||||
gpio_deep_sleep_hold_dis();
|
||||
gpio_hold_dis((gpio_num_t)PIN_CC1101_CS);
|
||||
gpio_hold_dis((gpio_num_t)PIN_CC1101_SCK);
|
||||
gpio_hold_dis((gpio_num_t)PIN_CC1101_MOSI);
|
||||
|
||||
radio_set_pins();
|
||||
ELECHOUSE_cc1101.Init();
|
||||
|
||||
radio_ok = ELECHOUSE_cc1101.getCC1101();
|
||||
if (!radio_ok) {
|
||||
return false;
|
||||
}
|
||||
|
||||
ELECHOUSE_cc1101.setCCMode(1); // tryb wewnetrzny, dane z FIFO
|
||||
if (TPMS_MODULATION == MODE_FSK) {
|
||||
ELECHOUSE_cc1101.setModulation(0); // 2-FSK
|
||||
ELECHOUSE_cc1101.setDeviation(TPMS_DEVIATION_KHZ);
|
||||
}
|
||||
else {
|
||||
ELECHOUSE_cc1101.setModulation(2); // ASK/OOK
|
||||
}
|
||||
ELECHOUSE_cc1101.setMHZ(TPMS_FREQUENCY_MHZ);
|
||||
ELECHOUSE_cc1101.setDRate(1000.0f / (float)TPMS_CHIP_US); // kBaud (8.33)
|
||||
ELECHOUSE_cc1101.setPA(TPMS_TX_POWER_DBM);
|
||||
ELECHOUSE_cc1101.setChannel(0);
|
||||
|
||||
ELECHOUSE_cc1101.setSyncMode(0); // bez preambuly/sync CC1101
|
||||
ELECHOUSE_cc1101.setPRE(0);
|
||||
ELECHOUSE_cc1101.setAdrChk(0);
|
||||
ELECHOUSE_cc1101.setAddr(0);
|
||||
ELECHOUSE_cc1101.setWhiteData(0); // bez whiteningu
|
||||
ELECHOUSE_cc1101.setManchester(0); // Manchester kodujemy sami
|
||||
ELECHOUSE_cc1101.setFEC(0);
|
||||
ELECHOUSE_cc1101.setCrc(0); // wlasna suma kontrolna protokolu
|
||||
ELECHOUSE_cc1101.setCRC_AF(0);
|
||||
ELECHOUSE_cc1101.setAppendStatus(0);
|
||||
ELECHOUSE_cc1101.setDcFilterOff(0);
|
||||
ELECHOUSE_cc1101.setPktFormat(0); // normalny tryb FIFO
|
||||
ELECHOUSE_cc1101.setLengthConfig(0); // stala dlugosc pakietu
|
||||
ELECHOUSE_cc1101.setPacketLength(TPMS_TX_BYTES);
|
||||
return true;
|
||||
}
|
||||
|
||||
void radio_send_frame(const uint8_t *buf, uint8_t len)
|
||||
{
|
||||
if (!radio_ok) {
|
||||
return;
|
||||
}
|
||||
|
||||
ELECHOUSE_cc1101.SpiStrobe(CC1101_SIDLE);
|
||||
ELECHOUSE_cc1101.SpiStrobe(CC1101_SFTX);
|
||||
ELECHOUSE_cc1101.SpiWriteBurstReg(CC1101_TXFIFO, (uint8_t *)buf, len);
|
||||
ELECHOUSE_cc1101.SpiStrobe(CC1101_STX);
|
||||
|
||||
/* Czekamy az caly bufor wyjdzie na antene: FIFO puste + margines na
|
||||
* ostatni chip. Blokada krotka (~30 ms) i niezbedna do zakonczenia
|
||||
* transmisji - poza tym petla glowna nie uzywa delay(). */
|
||||
uint32_t air_us = (uint32_t)len * 8u * (uint32_t)TPMS_CHIP_US + 3000u;
|
||||
uint32_t t0 = micros();
|
||||
while ((uint32_t)(micros() - t0) < air_us) {
|
||||
uint8_t txb = ELECHOUSE_cc1101.SpiReadStatus(CC1101_TXBYTES);
|
||||
if ((txb & 0x7Fu) == 0) {
|
||||
delayMicroseconds(2u * TPMS_CHIP_US); // ostatni chip na antenie
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
ELECHOUSE_cc1101.SpiStrobe(CC1101_SIDLE);
|
||||
ELECHOUSE_cc1101.SpiStrobe(CC1101_SFTX);
|
||||
}
|
||||
|
||||
void radio_send_burst(const uint8_t *buf, uint8_t len, uint8_t frames)
|
||||
{
|
||||
for (uint8_t i = 0; i < frames; i++) {
|
||||
radio_send_frame(buf, len);
|
||||
if (i + 1u < frames) {
|
||||
delay(TX_FRAME_GAP_MS);
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
void radio_sleep(void)
|
||||
{
|
||||
if (radio_ok) {
|
||||
ELECHOUSE_cc1101.goSleep(); // SIDLE + SPWD (sen po zboczu CS)
|
||||
}
|
||||
/* Zwolnij peryferium SPI i ustaw linie w stanach bezpiecznych:
|
||||
* CS=1 (utrzymuje CC1101 w sleep), SCK/MOSI=0, GDO0 wejscie z podciaganiem
|
||||
* w dol (CC1101 w sleep trzystanuje wyjscia). */
|
||||
SPI.end();
|
||||
pinMode(PIN_CC1101_CS, OUTPUT);
|
||||
digitalWrite(PIN_CC1101_CS, HIGH);
|
||||
pinMode(PIN_CC1101_SCK, OUTPUT);
|
||||
digitalWrite(PIN_CC1101_SCK, LOW);
|
||||
pinMode(PIN_CC1101_MOSI, OUTPUT);
|
||||
digitalWrite(PIN_CC1101_MOSI, LOW);
|
||||
pinMode(PIN_CC1101_GDO0, INPUT_PULLDOWN);
|
||||
}
|
||||
+32
@@ -0,0 +1,32 @@
|
||||
/*
|
||||
* radio.h - sterowanie CC1101 (nadawanie ramek TPMS, tryb uśpienia)
|
||||
*/
|
||||
#ifndef TPMS_RADIO_H
|
||||
#define TPMS_RADIO_H
|
||||
|
||||
#include <stdint.h>
|
||||
#include <stdbool.h>
|
||||
#include "config.h"
|
||||
|
||||
#ifdef __cplusplus
|
||||
extern "C" {
|
||||
#endif
|
||||
|
||||
/* Inicjalizacja SPI + konfiguracja CC1101. Zwraca false przy braku modulu. */
|
||||
bool radio_init(void);
|
||||
|
||||
/* Wyslij jeden bufor nadawczy (TPMS_TX_BYTES) - blokujace do zakonczenia
|
||||
* transmisji na eterze (~29 ms). */
|
||||
void radio_send_frame(const uint8_t *buf, uint8_t len);
|
||||
|
||||
/* Burts: n ramek tego samego bufora z odstepem TX_FRAME_GAP_MS. */
|
||||
void radio_send_burst(const uint8_t *buf, uint8_t len, uint8_t frames);
|
||||
|
||||
/* CC1101 do trybu SLEEP (<1 uA) + przygotowanie linii pod gpio_hold. */
|
||||
void radio_sleep(void);
|
||||
|
||||
#ifdef __cplusplus
|
||||
}
|
||||
#endif
|
||||
|
||||
#endif /* TPMS_RADIO_H */
|
||||
@@ -0,0 +1,97 @@
|
||||
/*
|
||||
* tpms_frame.cpp - generator ramek TPMS Schrader EG53MA4 (bez zaleznosci
|
||||
* od Arduino - kompilowalne takze natywnie w testach).
|
||||
*
|
||||
* Zastrzezenie: symulator generuje sztuczne dane cisnienia/temperatury
|
||||
* i nie zastepuje prawdziwych czujnikow TPMS.
|
||||
*/
|
||||
#include <string.h>
|
||||
#include "config.h"
|
||||
#include "tpms_frame.h"
|
||||
|
||||
static void put_bit(uint8_t *buf, unsigned *nbits, unsigned v)
|
||||
{
|
||||
if (v) {
|
||||
buf[*nbits >> 3] |= (uint8_t)(0x80u >> (*nbits & 7u));
|
||||
}
|
||||
(*nbits)++;
|
||||
}
|
||||
|
||||
/* G.E.T. Manchester: 0 -> "01", 1 -> "10" */
|
||||
static void put_cell(uint8_t *buf, unsigned *nbits, unsigned bit)
|
||||
{
|
||||
if (bit) {
|
||||
put_bit(buf, nbits, 1);
|
||||
put_bit(buf, nbits, 0);
|
||||
}
|
||||
else {
|
||||
put_bit(buf, nbits, 0);
|
||||
put_bit(buf, nbits, 1);
|
||||
}
|
||||
}
|
||||
|
||||
uint8_t tpms_build_payload(uint8_t out[TPMS_PAYLOAD_LEN], uint32_t id,
|
||||
uint16_t press_kpa10, int8_t temp_c,
|
||||
uint32_t flags, bool low_batt)
|
||||
{
|
||||
if (low_batt) {
|
||||
flags |= TPMS_FLAGS_LOWBAT_MASK;
|
||||
}
|
||||
|
||||
/* cisnienie: 25 mbar/bit = 2.5 kPa/bit, zaokraglenie w gore do polowy bitu */
|
||||
int32_t press = ((int32_t)press_kpa10 + 12) / 25;
|
||||
if (press < 0) press = 0;
|
||||
if (press > 255) press = 255;
|
||||
|
||||
/* temperatura: protokol podaje stopnie Fahrenheita */
|
||||
int32_t num = 9 * (int32_t)temp_c + 160;
|
||||
int32_t tf = (num >= 0) ? (num + 2) / 5 : -((-num + 2) / 5);
|
||||
if (tf < 0) tf = 0;
|
||||
if (tf > 255) tf = 255;
|
||||
|
||||
out[0] = (uint8_t)(flags >> 24);
|
||||
out[1] = (uint8_t)(flags >> 16);
|
||||
out[2] = (uint8_t)(flags >> 8);
|
||||
out[3] = (uint8_t)(flags);
|
||||
out[4] = (uint8_t)(id >> 16);
|
||||
out[5] = (uint8_t)(id >> 8);
|
||||
out[6] = (uint8_t)(id);
|
||||
out[7] = (uint8_t)press;
|
||||
out[8] = (uint8_t)tf;
|
||||
|
||||
uint8_t crc = 0;
|
||||
for (unsigned i = 0; i < 9; i++) {
|
||||
crc = (uint8_t)(crc + out[i]); // suma mod 256 (add_bytes w rtl_433)
|
||||
}
|
||||
out[9] = crc;
|
||||
return crc;
|
||||
}
|
||||
|
||||
void tpms_build_frame(uint8_t out[TPMS_TX_BYTES], uint32_t id,
|
||||
uint16_t press_kpa10, int8_t temp_c,
|
||||
uint32_t flags, bool low_batt)
|
||||
{
|
||||
uint8_t payload[TPMS_PAYLOAD_LEN];
|
||||
tpms_build_payload(payload, id, press_kpa10, temp_c, flags, low_batt);
|
||||
|
||||
memset(out, 0, TPMS_TX_BYTES);
|
||||
unsigned nbits = 0;
|
||||
|
||||
put_bit(out, &nbits, 1); // chip rozbiegowy (carrier on)
|
||||
|
||||
/* 39 bitow sync - pierwszy (zerowy) bit dopisuje odbiornik (MC_ZEROBIT) */
|
||||
for (unsigned i = 0; i < TPMS_SYNC_BITS - 1; i++) {
|
||||
put_cell(out, &nbits, 0);
|
||||
}
|
||||
|
||||
/* 80 bitow payloadu */
|
||||
for (unsigned b = 0; b < 8u * TPMS_PAYLOAD_LEN; b++) {
|
||||
unsigned bit = (payload[b >> 3] >> (7 - (b & 7u))) & 1u;
|
||||
put_cell(out, &nbits, bit);
|
||||
}
|
||||
|
||||
/* padding do granicy bajtu - dla OOK sa to chipy "off" = cisza w eterze */
|
||||
while (nbits % 8u) {
|
||||
put_bit(out, &nbits, 0);
|
||||
}
|
||||
}
|
||||
@@ -0,0 +1,61 @@
|
||||
/*
|
||||
* tpms_frame.h - generator ramek TPMS Schrader EG53MA4
|
||||
*
|
||||
* Zastrzezenie: dane sa sztuczne (diagnostyka/testy), nie zastepuja
|
||||
* prawdziwych czujnikow TPMS.
|
||||
*
|
||||
* Ramka na zrzuconej warstwie bitowej (120 bitow, po dekodowaniu
|
||||
* Manchester przez rtl_433 OOK_MC_ZEROBIT):
|
||||
*
|
||||
* 40 bit sync (zera) | flags(4B) | id(3B) | pressure(1B) | temp(1B) | crc(1B)
|
||||
*
|
||||
* - flags: 32 bity, wg dekodera "moze zawierac preamble/status/battery"
|
||||
* - pressure: 25 mbar/bit (cisnienie w kPa = bajt * 2.5)
|
||||
* - temperature: stopnie Fahrenheita
|
||||
* - crc: suma 9 poprzednich bajtow mod 256 (add_bytes w rtl_433)
|
||||
*
|
||||
* Kodowanie na zrzuconej warstwie RF (G.E.T. Manchester):
|
||||
* bit 0 -> chipy "01", bit 1 -> chipy "10", chip = 120 us
|
||||
* Odbiornik rtl_433 (MC_ZEROBIT) dopisuje pierwszy bit ramki samodzielnie,
|
||||
* wiec nadajnik wysyla ramke BEZ pierwszego bitu, poprzedzona jednym
|
||||
* chipem rozbiegowym '1'. Bufor wyjsciowy jest dopełniany zerami do
|
||||
* granicy bajtu (dla OOK sa to chipy "wylaczone" = cisza).
|
||||
*/
|
||||
#ifndef TPMS_FRAME_H
|
||||
#define TPMS_FRAME_H
|
||||
|
||||
#include <stdint.h>
|
||||
#include <stdbool.h>
|
||||
|
||||
#ifdef __cplusplus
|
||||
extern "C" {
|
||||
#endif
|
||||
|
||||
#define TPMS_ROW_BITS 120 // dlugosc dekodowanej ramki (wymagana przez rtl_433)
|
||||
#define TPMS_SYNC_BITS 40
|
||||
#define TPMS_PAYLOAD_LEN 10 // flags(4)+id(3)+press+temp+crc
|
||||
#define TPMS_TX_BYTES 30 // 240 chipow = 1 lead + 238 danych + 1 padding
|
||||
#define TPMS_TX_CHIPS (TPMS_TX_BYTES * 8)
|
||||
|
||||
typedef struct {
|
||||
uint32_t id; // 24-bit identyfikator czujnika
|
||||
uint16_t press_kpa10; // cisnienie w kPa * 10 (np. 2600 = 260.0 kPa)
|
||||
int8_t temp_c; // temperatura w st. C
|
||||
const char *name; // "FL", "FR", "RR", "RL"
|
||||
} tpms_sensor_t;
|
||||
|
||||
/* Zbuduj 10-bajtowy payload (bez sync). Zwraca crc (tez wpisane do out[9]). */
|
||||
uint8_t tpms_build_payload(uint8_t out[TPMS_PAYLOAD_LEN], uint32_t id,
|
||||
uint16_t press_kpa10, int8_t temp_c,
|
||||
uint32_t flags, bool low_batt);
|
||||
|
||||
/* Zbuduj kompletny bufor nadawczy (TPMS_TX_BYTES) gotowy do CC1101 FIFO. */
|
||||
void tpms_build_frame(uint8_t out[TPMS_TX_BYTES], uint32_t id,
|
||||
uint16_t press_kpa10, int8_t temp_c,
|
||||
uint32_t flags, bool low_batt);
|
||||
|
||||
#ifdef __cplusplus
|
||||
}
|
||||
#endif
|
||||
|
||||
#endif /* TPMS_FRAME_H */
|
||||
+143
@@ -0,0 +1,143 @@
|
||||
/*
|
||||
* ui.cpp - przycisk (gesty) i LED statusowy (nieblokujaco, bez delay())
|
||||
*/
|
||||
#include <Arduino.h>
|
||||
#include "config.h"
|
||||
#include "ui.h"
|
||||
|
||||
/* ---------------------------- przycisk ---------------------------- */
|
||||
|
||||
static bool btn_stable = false; // stan po debounce
|
||||
static uint32_t btn_last_change = 0;
|
||||
static uint32_t btn_press_start = 0;
|
||||
static bool btn_long_fired = false; // bardzo dlugie zdarzenie juz wyslane
|
||||
|
||||
bool ui_button_down(void)
|
||||
{
|
||||
return btn_stable;
|
||||
}
|
||||
|
||||
void ui_init(void)
|
||||
{
|
||||
pinMode(PIN_BUTTON, BTN_ACTIVE_LEVEL ? INPUT_PULLDOWN : INPUT_PULLUP);
|
||||
pinMode(PIN_LED, OUTPUT);
|
||||
digitalWrite(PIN_LED, LOW);
|
||||
btn_stable = (digitalRead(PIN_BUTTON) == BTN_ACTIVE_LEVEL);
|
||||
btn_last_change = millis();
|
||||
}
|
||||
|
||||
ui_event_t ui_poll(void)
|
||||
{
|
||||
ui_event_t ev = UI_EV_NONE;
|
||||
bool raw = (digitalRead(PIN_BUTTON) == BTN_ACTIVE_LEVEL);
|
||||
uint32_t now = millis();
|
||||
|
||||
if (raw != btn_stable && (now - btn_last_change) >= BTN_DEBOUNCE_MS) {
|
||||
btn_last_change = now;
|
||||
btn_stable = raw;
|
||||
if (btn_stable) {
|
||||
btn_press_start = now;
|
||||
btn_long_fired = false;
|
||||
}
|
||||
else {
|
||||
uint32_t held = now - btn_press_start;
|
||||
if (!btn_long_fired) {
|
||||
if (held >= BTN_VERYLONG_MS) ev = UI_EV_VERYLONG;
|
||||
else if (held >= BTN_LONG_MS) ev = UI_EV_LONG;
|
||||
else ev = UI_EV_SHORT;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
/* bardzo dlugi przycisk sygnalizujemy od razu (nie czekajac na puszczenie) */
|
||||
if (btn_stable && !btn_long_fired && (now - btn_press_start) >= BTN_VERYLONG_MS) {
|
||||
btn_long_fired = true;
|
||||
ev = UI_EV_VERYLONG;
|
||||
}
|
||||
return ev;
|
||||
}
|
||||
|
||||
/* ------------------------------- LED ------------------------------ */
|
||||
|
||||
static ui_pat_t led_pat = UI_PAT_OFF;
|
||||
static uint8_t led_blinks_left = 0;
|
||||
static bool led_on = false;
|
||||
static bool led_series = false; // seria migniec w trakcie
|
||||
static uint32_t led_next = 0;
|
||||
|
||||
void ui_set_pattern(ui_pat_t pat)
|
||||
{
|
||||
led_pat = pat;
|
||||
led_blinks_left = 0;
|
||||
led_on = false;
|
||||
led_series = false;
|
||||
digitalWrite(PIN_LED, LOW);
|
||||
led_next = millis();
|
||||
}
|
||||
|
||||
void ui_blink_count(uint8_t n)
|
||||
{
|
||||
led_blinks_left = n;
|
||||
led_on = false;
|
||||
led_series = true;
|
||||
led_next = millis();
|
||||
}
|
||||
|
||||
void ui_update(void)
|
||||
{
|
||||
uint32_t now = millis();
|
||||
if ((int32_t)(now - led_next) < 0) {
|
||||
return;
|
||||
}
|
||||
|
||||
if (led_series) {
|
||||
if (led_on) {
|
||||
/* koniec migniecia */
|
||||
digitalWrite(PIN_LED, LOW);
|
||||
led_on = false;
|
||||
if (led_blinks_left > 0) {
|
||||
led_blinks_left--;
|
||||
}
|
||||
led_next = now + 90;
|
||||
}
|
||||
else if (led_blinks_left > 0) {
|
||||
/* kolejne migniecie */
|
||||
digitalWrite(PIN_LED, HIGH);
|
||||
led_on = true;
|
||||
led_next = now + 90;
|
||||
}
|
||||
else {
|
||||
/* koniec serii - przerwa zalezna od wzorca */
|
||||
led_series = false;
|
||||
uint32_t idle = 2000;
|
||||
switch (led_pat) {
|
||||
case UI_PAT_OFF: idle = 50; break;
|
||||
case UI_PAT_NORMAL: idle = 2000; break;
|
||||
case UI_PAT_LEARN: idle = 500; break;
|
||||
case UI_PAT_SINGLE: idle = 500; break;
|
||||
case UI_PAT_LOWBAT: idle = 3000; break;
|
||||
}
|
||||
led_next = now + idle;
|
||||
}
|
||||
return;
|
||||
}
|
||||
|
||||
/* rozpoczynamy serie wg wzorca */
|
||||
if (led_pat == UI_PAT_OFF) {
|
||||
digitalWrite(PIN_LED, LOW);
|
||||
led_next = now + 50;
|
||||
return;
|
||||
}
|
||||
uint8_t n = 1;
|
||||
switch (led_pat) {
|
||||
case UI_PAT_NORMAL: n = 1; break;
|
||||
case UI_PAT_LEARN: n = 3; break;
|
||||
case UI_PAT_SINGLE: n = 2; break;
|
||||
case UI_PAT_LOWBAT: n = 10; break;
|
||||
default: break;
|
||||
}
|
||||
led_blinks_left = n;
|
||||
led_on = false;
|
||||
led_series = true;
|
||||
led_next = now;
|
||||
}
|
||||
@@ -0,0 +1,45 @@
|
||||
/*
|
||||
* ui.h - przycisk (gesty) i LED statusowy
|
||||
*/
|
||||
#ifndef TPMS_UI_H
|
||||
#define TPMS_UI_H
|
||||
|
||||
#include <stdint.h>
|
||||
#include <stdbool.h>
|
||||
|
||||
#ifdef __cplusplus
|
||||
extern "C" {
|
||||
#endif
|
||||
|
||||
typedef enum {
|
||||
UI_EV_NONE = 0,
|
||||
UI_EV_SHORT, // < BTN_LONG_MS
|
||||
UI_EV_LONG, // >= BTN_LONG_MS (wejscie/wyjscie LEARN)
|
||||
UI_EV_VERYLONG, // >= BTN_VERYLONG_MS (wejscie/wyjscie SINGLE)
|
||||
} ui_event_t;
|
||||
|
||||
typedef enum {
|
||||
UI_PAT_OFF = 0,
|
||||
UI_PAT_NORMAL, // 1 migniecie co 2 s
|
||||
UI_PAT_LEARN, // 3 szybkie migniecia co 0.5 s
|
||||
UI_PAT_SINGLE, // 2 szybkie migniecia co 0.5 s
|
||||
UI_PAT_LOWBAT, // 10 szybkich migniec co 3 s
|
||||
} ui_pat_t;
|
||||
|
||||
void ui_init(void);
|
||||
|
||||
/* Nieblokujaca obsluga przycisku i LED - wywolywac w kazdej petli. */
|
||||
ui_event_t ui_poll(void);
|
||||
void ui_update(void);
|
||||
|
||||
bool ui_button_down(void);
|
||||
void ui_set_pattern(ui_pat_t pat);
|
||||
|
||||
/* Seria n szybkich migniec (np. numer kola: 1-4). */
|
||||
void ui_blink_count(uint8_t n);
|
||||
|
||||
#ifdef __cplusplus
|
||||
}
|
||||
#endif
|
||||
|
||||
#endif /* TPMS_UI_H */
|
||||
Reference in new issue
Block a user