Wifi and MQTT checks and reconnects added
This commit is contained in:
@@ -32,19 +32,33 @@ from gauge_vid6008 import Gauge
|
|||||||
# Logging
|
# Logging
|
||||||
# ---------------------------------------------------------------------------
|
# ---------------------------------------------------------------------------
|
||||||
|
|
||||||
|
|
||||||
def _ts():
|
def _ts():
|
||||||
ms = utime.ticks_ms()
|
ms = utime.ticks_ms()
|
||||||
return f"{(ms//3600000)%24:02d}:{(ms//60000)%60:02d}:{(ms//1000)%60:02d}.{ms%1000:03d}"
|
return f"{(ms // 3600000) % 24:02d}:{(ms // 60000) % 60:02d}:{(ms // 1000) % 60:02d}.{ms % 1000:03d}"
|
||||||
|
|
||||||
|
|
||||||
|
def log(level, msg):
|
||||||
|
print(f"[{_ts()}] {level:5s} {msg}")
|
||||||
|
|
||||||
|
|
||||||
|
def info(msg):
|
||||||
|
log("INFO", msg)
|
||||||
|
|
||||||
|
|
||||||
|
def warn(msg):
|
||||||
|
log("WARN", msg)
|
||||||
|
|
||||||
|
|
||||||
|
def log_err(msg):
|
||||||
|
log("ERROR", msg)
|
||||||
|
|
||||||
def log(level, msg): print(f"[{_ts()}] {level:5s} {msg}")
|
|
||||||
def info(msg): log("INFO", msg)
|
|
||||||
def warn(msg): log("WARN", msg)
|
|
||||||
def log_err(msg): log("ERROR", msg)
|
|
||||||
|
|
||||||
# ---------------------------------------------------------------------------
|
# ---------------------------------------------------------------------------
|
||||||
# Configuration
|
# Configuration
|
||||||
# ---------------------------------------------------------------------------
|
# ---------------------------------------------------------------------------
|
||||||
|
|
||||||
|
|
||||||
def _load_config():
|
def _load_config():
|
||||||
try:
|
try:
|
||||||
with open("/config.json") as f:
|
with open("/config.json") as f:
|
||||||
@@ -58,65 +72,66 @@ def _load_config():
|
|||||||
log_err(f"config.json parse error: {e} — cannot continue")
|
log_err(f"config.json parse error: {e} — cannot continue")
|
||||||
raise
|
raise
|
||||||
|
|
||||||
|
|
||||||
_cfg = _load_config()
|
_cfg = _load_config()
|
||||||
|
|
||||||
WIFI_SSID = _cfg["wifi_ssid"]
|
WIFI_SSID = _cfg["wifi_ssid"]
|
||||||
WIFI_PASSWORD = _cfg["wifi_password"]
|
WIFI_PASSWORD = _cfg["wifi_password"]
|
||||||
MQTT_BROKER = _cfg["mqtt_broker"]
|
MQTT_BROKER = _cfg["mqtt_broker"]
|
||||||
MQTT_PORT = int(_cfg.get("mqtt_port", 1883))
|
MQTT_PORT = int(_cfg.get("mqtt_port", 1883))
|
||||||
MQTT_USER = _cfg["mqtt_user"]
|
MQTT_USER = _cfg["mqtt_user"]
|
||||||
MQTT_PASSWORD = _cfg["mqtt_password"]
|
MQTT_PASSWORD = _cfg["mqtt_password"]
|
||||||
MQTT_CLIENT_ID = _cfg["mqtt_client_id"]
|
MQTT_CLIENT_ID = _cfg["mqtt_client_id"]
|
||||||
MQTT_PREFIX = _cfg["mqtt_prefix"]
|
MQTT_PREFIX = _cfg["mqtt_prefix"]
|
||||||
GAUGE_PINS = tuple(_cfg.get("gauge_pins", [12, 13]))
|
GAUGE_PINS = tuple(_cfg.get("gauge_pins", [12, 13]))
|
||||||
GAUGE_MODE = _cfg.get("gauge_mode", "stepdir")
|
GAUGE_MODE = _cfg.get("gauge_mode", "stepdir")
|
||||||
GAUGE_MIN = float(_cfg.get("gauge_min", 0))
|
GAUGE_MIN = float(_cfg.get("gauge_min", 0))
|
||||||
GAUGE_MAX = float(_cfg.get("gauge_max", 7300))
|
GAUGE_MAX = float(_cfg.get("gauge_max", 7300))
|
||||||
GAUGE_STEP_US = int(_cfg.get("gauge_step_us", 200))
|
GAUGE_STEP_US = int(_cfg.get("gauge_step_us", 200))
|
||||||
|
|
||||||
MICROSTEPS_PER_SECOND = 600 # microsteps per second (adjustable)
|
MICROSTEPS_PER_SECOND = 600 # microsteps per second (adjustable)
|
||||||
|
|
||||||
HEARTBEAT_MS = int(_cfg.get("heartbeat_ms", 10000))
|
HEARTBEAT_MS = int(_cfg.get("heartbeat_ms", 10000))
|
||||||
REZERO_INTERVAL_MS = int(_cfg.get("rezero_interval_ms", 3600000))
|
REZERO_INTERVAL_MS = int(_cfg.get("rezero_interval_ms", 3600000))
|
||||||
LED_RED_PIN = int(_cfg.get("led_red_pin", 33))
|
LED_RED_PIN = int(_cfg.get("led_red_pin", 33))
|
||||||
LED_GREEN_PIN = int(_cfg.get("led_green_pin", 32))
|
LED_GREEN_PIN = int(_cfg.get("led_green_pin", 32))
|
||||||
LED_BL_PIN = int(_cfg.get("led_bl_pin", 23))
|
LED_BL_PIN = int(_cfg.get("led_bl_pin", 23))
|
||||||
DEVICE_NAME = _cfg.get("device_name", "Selsyn 1")
|
DEVICE_NAME = _cfg.get("device_name", "Selsyn 1")
|
||||||
DEVICE_MODEL = _cfg.get("device_model", "Chernobyl Selsyn-inspired gauge")
|
DEVICE_MODEL = _cfg.get("device_model", "Chernobyl Selsyn-inspired gauge")
|
||||||
DEVICE_MFR = _cfg.get("device_manufacturer", "AdeBaumann")
|
DEVICE_MFR = _cfg.get("device_manufacturer", "AdeBaumann")
|
||||||
DEVICE_AREA = _cfg.get("device_area", "Control Panels")
|
DEVICE_AREA = _cfg.get("device_area", "Control Panels")
|
||||||
GAUGE_ENTITY = _cfg.get("gauge_entity_name", "Selsyn 1 Power")
|
GAUGE_ENTITY = _cfg.get("gauge_entity_name", "Selsyn 1 Power")
|
||||||
GAUGE_UNIT = _cfg.get("gauge_unit", "W")
|
GAUGE_UNIT = _cfg.get("gauge_unit", "W")
|
||||||
RED_ENTITY = _cfg.get("red_led_entity_name", "Selsyn 1 Red LED")
|
RED_ENTITY = _cfg.get("red_led_entity_name", "Selsyn 1 Red LED")
|
||||||
GREEN_ENTITY = _cfg.get("green_led_entity_name", "Selsyn 1 Green LED")
|
GREEN_ENTITY = _cfg.get("green_led_entity_name", "Selsyn 1 Green LED")
|
||||||
BL_ENTITY = _cfg.get("backlight_entity_name", "Selsyn 1 Backlight")
|
BL_ENTITY = _cfg.get("backlight_entity_name", "Selsyn 1 Backlight")
|
||||||
BL_UNIT = _cfg.get("backlight_unit", "%")
|
BL_UNIT = _cfg.get("backlight_unit", "%")
|
||||||
|
|
||||||
# ---------------------------------------------------------------------------
|
# ---------------------------------------------------------------------------
|
||||||
# Topics
|
# Topics
|
||||||
# ---------------------------------------------------------------------------
|
# ---------------------------------------------------------------------------
|
||||||
|
|
||||||
T_SET = f"{MQTT_PREFIX}/set"
|
T_SET = f"{MQTT_PREFIX}/set"
|
||||||
T_STATE = f"{MQTT_PREFIX}/state"
|
T_STATE = f"{MQTT_PREFIX}/state"
|
||||||
T_STATUS = f"{MQTT_PREFIX}/status"
|
T_STATUS = f"{MQTT_PREFIX}/status"
|
||||||
T_ZERO = f"{MQTT_PREFIX}/zero"
|
T_ZERO = f"{MQTT_PREFIX}/zero"
|
||||||
T_LED_RED = f"{MQTT_PREFIX}/led/red/set"
|
T_LED_RED = f"{MQTT_PREFIX}/led/red/set"
|
||||||
T_LED_GREEN = f"{MQTT_PREFIX}/led/green/set"
|
T_LED_GREEN = f"{MQTT_PREFIX}/led/green/set"
|
||||||
T_LED_BL = f"{MQTT_PREFIX}/led/backlight/set"
|
T_LED_BL = f"{MQTT_PREFIX}/led/backlight/set"
|
||||||
T_LED_BL_STATE = f"{MQTT_PREFIX}/led/backlight/state"
|
T_LED_BL_STATE = f"{MQTT_PREFIX}/led/backlight/state"
|
||||||
T_LED_RED_STATE = f"{MQTT_PREFIX}/led/red/state"
|
T_LED_RED_STATE = f"{MQTT_PREFIX}/led/red/state"
|
||||||
T_LED_GREEN_STATE = f"{MQTT_PREFIX}/led/green/state"
|
T_LED_GREEN_STATE = f"{MQTT_PREFIX}/led/green/state"
|
||||||
|
|
||||||
T_DISC_GAUGE = f"homeassistant/number/{MQTT_CLIENT_ID}/config"
|
T_DISC_GAUGE = f"homeassistant/number/{MQTT_CLIENT_ID}/config"
|
||||||
T_DISC_RED = f"homeassistant/switch/{MQTT_CLIENT_ID}_red/config"
|
T_DISC_RED = f"homeassistant/switch/{MQTT_CLIENT_ID}_red/config"
|
||||||
T_DISC_GREEN = f"homeassistant/switch/{MQTT_CLIENT_ID}_green/config"
|
T_DISC_GREEN = f"homeassistant/switch/{MQTT_CLIENT_ID}_green/config"
|
||||||
T_DISC_BL = f"homeassistant/light/{MQTT_CLIENT_ID}_bl/config"
|
T_DISC_BL = f"homeassistant/light/{MQTT_CLIENT_ID}_bl/config"
|
||||||
|
|
||||||
_DEVICE = {
|
_DEVICE = {
|
||||||
"identifiers": [MQTT_CLIENT_ID],
|
"identifiers": [MQTT_CLIENT_ID],
|
||||||
"name": DEVICE_NAME,
|
"name": DEVICE_NAME,
|
||||||
"model": DEVICE_MODEL,
|
"model": DEVICE_MODEL,
|
||||||
"manufacturer": DEVICE_MFR,
|
"manufacturer": DEVICE_MFR,
|
||||||
"suggested_area": DEVICE_AREA,
|
"suggested_area": DEVICE_AREA,
|
||||||
}
|
}
|
||||||
|
|
||||||
@@ -124,71 +139,128 @@ _DEVICE = {
|
|||||||
# WiFi
|
# WiFi
|
||||||
# ---------------------------------------------------------------------------
|
# ---------------------------------------------------------------------------
|
||||||
|
|
||||||
|
_wifi_reconnect_delay_s = 5
|
||||||
|
_wifi_check_interval_ms = 5000
|
||||||
|
_last_wifi_check = 0
|
||||||
|
_wifi_sta = None
|
||||||
|
|
||||||
|
|
||||||
def connect_wifi(ssid, password, timeout_s=15):
|
def connect_wifi(ssid, password, timeout_s=15):
|
||||||
sta = network.WLAN(network.STA_IF)
|
global _wifi_sta
|
||||||
sta.active(True)
|
_wifi_sta = network.WLAN(network.STA_IF)
|
||||||
if sta.isconnected():
|
_wifi_sta.active(True)
|
||||||
ip, mask, gw, dns = sta.ifconfig()
|
if _wifi_sta.isconnected():
|
||||||
|
ip, mask, gw, dns = _wifi_sta.ifconfig()
|
||||||
info("WiFi already connected")
|
info("WiFi already connected")
|
||||||
info(f" IP:{ip} mask:{mask} gw:{gw} dns:{dns}")
|
info(f" IP:{ip} mask:{mask} gw:{gw} dns:{dns}")
|
||||||
return ip
|
return ip
|
||||||
info(f"WiFi connecting to '{ssid}' ...")
|
info(f"WiFi connecting to '{ssid}' ...")
|
||||||
sta.connect(ssid, password)
|
_wifi_sta.connect(ssid, password)
|
||||||
deadline = utime.time() + timeout_s
|
deadline = utime.time() + timeout_s
|
||||||
while not sta.isconnected():
|
while not _wifi_sta.isconnected():
|
||||||
if utime.time() > deadline:
|
if utime.time() > deadline:
|
||||||
log_err(f"WiFi connect timeout after {timeout_s}s")
|
log_err(f"WiFi connect timeout after {timeout_s}s")
|
||||||
raise OSError("WiFi connect timeout")
|
raise OSError("WiFi connect timeout")
|
||||||
utime.sleep_ms(200)
|
utime.sleep_ms(200)
|
||||||
ip, mask, gw, dns = sta.ifconfig()
|
ip, mask, gw, dns = _wifi_sta.ifconfig()
|
||||||
mac = ':'.join(f'{b:02x}' for b in sta.config('mac'))
|
mac = ":".join(f"{b:02x}" for b in _wifi_sta.config("mac"))
|
||||||
info("WiFi connected!")
|
info("WiFi connected!")
|
||||||
info(f" SSID : {ssid}")
|
info(f" SSID : {ssid}")
|
||||||
info(f" MAC : {mac}")
|
info(f" MAC : {mac}")
|
||||||
info(f" IP : {ip} mask:{mask} gw:{gw} dns:{dns}")
|
info(f" IP : {ip} mask:{mask} gw:{gw} dns:{dns}")
|
||||||
return ip
|
return ip
|
||||||
|
|
||||||
|
|
||||||
|
def check_wifi():
|
||||||
|
global _last_wifi_check, _wifi_reconnect_delay_s
|
||||||
|
now = utime.ticks_ms()
|
||||||
|
if utime.ticks_diff(now, _last_wifi_check) < _wifi_check_interval_ms:
|
||||||
|
return
|
||||||
|
_last_wifi_check = now
|
||||||
|
|
||||||
|
if _wifi_sta is None:
|
||||||
|
_wifi_sta = network.WLAN(network.STA_IF)
|
||||||
|
|
||||||
|
if _wifi_sta.isconnected():
|
||||||
|
return
|
||||||
|
|
||||||
|
log_err("WiFi lost connection — attempting reconnect...")
|
||||||
|
try:
|
||||||
|
_wifi_sta.active(True)
|
||||||
|
_wifi_sta.connect(WIFI_SSID, WIFI_PASSWORD)
|
||||||
|
deadline = utime.time() + 15
|
||||||
|
while not _wifi_sta.isconnected():
|
||||||
|
if utime.time() > deadline:
|
||||||
|
log_err("WiFi reconnect timeout")
|
||||||
|
return
|
||||||
|
utime.sleep_ms(200)
|
||||||
|
ip, mask, gw, dns = _wifi_sta.ifconfig()
|
||||||
|
info(f"WiFi reconnected! IP:{ip}")
|
||||||
|
except Exception as e:
|
||||||
|
log_err(f"WiFi reconnect failed: {e}")
|
||||||
|
|
||||||
|
|
||||||
# ---------------------------------------------------------------------------
|
# ---------------------------------------------------------------------------
|
||||||
# Gauge
|
# Gauge
|
||||||
# ---------------------------------------------------------------------------
|
# ---------------------------------------------------------------------------
|
||||||
|
|
||||||
info("Initialising gauge ...")
|
info("Initialising gauge ...")
|
||||||
gauge = Gauge(pins=GAUGE_PINS, mode=GAUGE_MODE, min_val=GAUGE_MIN, max_val=GAUGE_MAX, step_us=GAUGE_STEP_US)
|
gauge = Gauge(
|
||||||
info(f"Gauge ready pins={GAUGE_PINS} mode={GAUGE_MODE} range=[{GAUGE_MIN}, {GAUGE_MAX}] step_us={GAUGE_STEP_US}")
|
pins=GAUGE_PINS,
|
||||||
|
mode=GAUGE_MODE,
|
||||||
|
min_val=GAUGE_MIN,
|
||||||
|
max_val=GAUGE_MAX,
|
||||||
|
step_us=GAUGE_STEP_US,
|
||||||
|
)
|
||||||
|
info(
|
||||||
|
f"Gauge ready pins={GAUGE_PINS} mode={GAUGE_MODE} range=[{GAUGE_MIN}, {GAUGE_MAX}] step_us={GAUGE_STEP_US}"
|
||||||
|
)
|
||||||
|
|
||||||
# ---------------------------------------------------------------------------
|
# ---------------------------------------------------------------------------
|
||||||
# LEDs
|
# LEDs
|
||||||
# ---------------------------------------------------------------------------
|
# ---------------------------------------------------------------------------
|
||||||
|
|
||||||
led_red = Pin(LED_RED_PIN, Pin.OUT, value=0)
|
led_red = Pin(LED_RED_PIN, Pin.OUT, value=0)
|
||||||
led_green = Pin(LED_GREEN_PIN, Pin.OUT, value=0)
|
led_green = Pin(LED_GREEN_PIN, Pin.OUT, value=0)
|
||||||
led_bl = NeoPixel(Pin(LED_BL_PIN), 3)
|
led_bl = NeoPixel(Pin(LED_BL_PIN), 3)
|
||||||
|
|
||||||
_backlight_color = (0, 0, 0)
|
_backlight_color = (0, 0, 0)
|
||||||
_backlight_brightness = 100 # last *active* brightness — never set to 0
|
_backlight_brightness = 100 # last *active* brightness — never set to 0
|
||||||
_backlight_on = False
|
_backlight_on = False
|
||||||
_bl_dirty_since = None
|
_bl_dirty_since = None
|
||||||
_BL_SAVE_DELAY_MS = 5000
|
_BL_SAVE_DELAY_MS = 5000
|
||||||
|
|
||||||
|
|
||||||
def _flush_backlight(client):
|
def _flush_backlight(client):
|
||||||
payload = {
|
payload = {
|
||||||
"state": "ON" if _backlight_on else "OFF",
|
"state": "ON" if _backlight_on else "OFF",
|
||||||
"color": {"r": _backlight_color[0], "g": _backlight_color[1], "b": _backlight_color[2]},
|
"color": {
|
||||||
|
"r": _backlight_color[0],
|
||||||
|
"g": _backlight_color[1],
|
||||||
|
"b": _backlight_color[2],
|
||||||
|
},
|
||||||
"brightness": int(_backlight_brightness * 2.55),
|
"brightness": int(_backlight_brightness * 2.55),
|
||||||
}
|
}
|
||||||
client.publish(T_LED_BL, ujson.dumps(payload), retain=True)
|
client.publish(T_LED_BL, ujson.dumps(payload), retain=True)
|
||||||
info(f"Backlight state retained: {payload['state']} {_backlight_color} @ {_backlight_brightness}%")
|
info(
|
||||||
|
f"Backlight state retained: {payload['state']} {_backlight_color} @ {_backlight_brightness}%"
|
||||||
|
)
|
||||||
|
|
||||||
|
|
||||||
def _backlight_changed(new_color, new_on, new_brightness):
|
def _backlight_changed(new_color, new_on, new_brightness):
|
||||||
"""Return True if any backlight property differs from current state."""
|
"""Return True if any backlight property differs from current state."""
|
||||||
return (new_color != _backlight_color or
|
return (
|
||||||
new_on != _backlight_on or
|
new_color != _backlight_color
|
||||||
(new_on and new_brightness != _backlight_brightness))
|
or new_on != _backlight_on
|
||||||
|
or (new_on and new_brightness != _backlight_brightness)
|
||||||
|
)
|
||||||
|
|
||||||
|
|
||||||
def _mark_bl_dirty():
|
def _mark_bl_dirty():
|
||||||
global _bl_dirty_since
|
global _bl_dirty_since
|
||||||
_bl_dirty_since = utime.ticks_ms()
|
_bl_dirty_since = utime.ticks_ms()
|
||||||
|
|
||||||
|
|
||||||
def set_backlight_color(r, g, b, brightness=None):
|
def set_backlight_color(r, g, b, brightness=None):
|
||||||
global _backlight_color, _backlight_brightness, _backlight_on
|
global _backlight_color, _backlight_brightness, _backlight_on
|
||||||
if brightness is None:
|
if brightness is None:
|
||||||
@@ -206,6 +278,7 @@ def set_backlight_color(r, g, b, brightness=None):
|
|||||||
led_bl.write()
|
led_bl.write()
|
||||||
_mark_bl_dirty()
|
_mark_bl_dirty()
|
||||||
|
|
||||||
|
|
||||||
def set_backlight_brightness(brightness):
|
def set_backlight_brightness(brightness):
|
||||||
global _backlight_brightness, _backlight_on
|
global _backlight_brightness, _backlight_on
|
||||||
clamped = max(0, min(100, brightness))
|
clamped = max(0, min(100, brightness))
|
||||||
@@ -222,24 +295,40 @@ def set_backlight_brightness(brightness):
|
|||||||
led_bl.write()
|
led_bl.write()
|
||||||
_mark_bl_dirty()
|
_mark_bl_dirty()
|
||||||
|
|
||||||
|
|
||||||
info(f"LEDs ready red={LED_RED_PIN} green={LED_GREEN_PIN} backlight={LED_BL_PIN}")
|
info(f"LEDs ready red={LED_RED_PIN} green={LED_GREEN_PIN} backlight={LED_BL_PIN}")
|
||||||
|
|
||||||
# ---------------------------------------------------------------------------
|
# ---------------------------------------------------------------------------
|
||||||
# State
|
# State
|
||||||
# ---------------------------------------------------------------------------
|
# ---------------------------------------------------------------------------
|
||||||
|
|
||||||
_target_value = GAUGE_MIN
|
_target_value = GAUGE_MIN
|
||||||
_last_rezero_ms = None # set to ticks_ms() in main()
|
_last_rezero_ms = None # set to ticks_ms() in main()
|
||||||
client_ref = None
|
client_ref = None
|
||||||
|
_mqtt_connected = False
|
||||||
|
|
||||||
|
|
||||||
|
def _publish(topic, payload, retain=False):
|
||||||
|
"""Safely publish MQTT message, returning True on success."""
|
||||||
|
if client_ref is None:
|
||||||
|
return False
|
||||||
|
try:
|
||||||
|
client_ref.publish(topic, payload, retain=retain)
|
||||||
|
return True
|
||||||
|
except Exception as e:
|
||||||
|
log_err(f"MQTT publish failed: {e}")
|
||||||
|
return False
|
||||||
|
|
||||||
|
|
||||||
# ---------------------------------------------------------------------------
|
# ---------------------------------------------------------------------------
|
||||||
# MQTT callbacks
|
# MQTT callbacks
|
||||||
# ---------------------------------------------------------------------------
|
# ---------------------------------------------------------------------------
|
||||||
|
|
||||||
|
|
||||||
def on_message(topic, payload):
|
def on_message(topic, payload):
|
||||||
if client_ref is None:
|
if client_ref is None:
|
||||||
return
|
return
|
||||||
topic = topic.decode()
|
topic = topic.decode()
|
||||||
payload = payload.decode().strip()
|
payload = payload.decode().strip()
|
||||||
info(f"MQTT rx {topic} {payload}")
|
info(f"MQTT rx {topic} {payload}")
|
||||||
|
|
||||||
@@ -254,14 +343,14 @@ def on_message(topic, payload):
|
|||||||
if topic == T_LED_RED:
|
if topic == T_LED_RED:
|
||||||
state = payload.upper() == "ON"
|
state = payload.upper() == "ON"
|
||||||
led_red.value(1 if state else 0)
|
led_red.value(1 if state else 0)
|
||||||
client_ref.publish(T_LED_RED_STATE, "ON" if state else "OFF", retain=True)
|
_publish(T_LED_RED_STATE, "ON" if state else "OFF", retain=True)
|
||||||
info(f"Red LED → {'ON' if state else 'OFF'}")
|
info(f"Red LED → {'ON' if state else 'OFF'}")
|
||||||
return
|
return
|
||||||
|
|
||||||
if topic == T_LED_GREEN:
|
if topic == T_LED_GREEN:
|
||||||
state = payload.upper() == "ON"
|
state = payload.upper() == "ON"
|
||||||
led_green.value(1 if state else 0)
|
led_green.value(1 if state else 0)
|
||||||
client_ref.publish(T_LED_GREEN_STATE, "ON" if state else "OFF", retain=True)
|
_publish(T_LED_GREEN_STATE, "ON" if state else "OFF", retain=True)
|
||||||
info(f"Green LED → {'ON' if state else 'OFF'}")
|
info(f"Green LED → {'ON' if state else 'OFF'}")
|
||||||
return
|
return
|
||||||
|
|
||||||
@@ -269,10 +358,12 @@ def on_message(topic, payload):
|
|||||||
info(f"Backlight raw payload: '{payload}'")
|
info(f"Backlight raw payload: '{payload}'")
|
||||||
try:
|
try:
|
||||||
data = ujson.loads(payload)
|
data = ujson.loads(payload)
|
||||||
info(f"Backlight parsed: state={data.get('state')} color={data.get('color')} brightness={data.get('brightness')}")
|
info(
|
||||||
|
f"Backlight parsed: state={data.get('state')} color={data.get('color')} brightness={data.get('brightness')}"
|
||||||
|
)
|
||||||
if data.get("state", "ON").upper() == "OFF":
|
if data.get("state", "ON").upper() == "OFF":
|
||||||
set_backlight_brightness(0)
|
set_backlight_brightness(0)
|
||||||
client_ref.publish(T_LED_BL_STATE, ujson.dumps({"state": "OFF"}), retain=True)
|
_publish(T_LED_BL_STATE, ujson.dumps({"state": "OFF"}), retain=True)
|
||||||
info("Backlight → OFF")
|
info("Backlight → OFF")
|
||||||
return
|
return
|
||||||
color = data.get("color", {})
|
color = data.get("color", {})
|
||||||
@@ -292,9 +383,13 @@ def on_message(topic, payload):
|
|||||||
return
|
return
|
||||||
set_backlight_color(r, g, b, brightness)
|
set_backlight_color(r, g, b, brightness)
|
||||||
color_hex = f"#{r:02x}{g:02x}{b:02x}"
|
color_hex = f"#{r:02x}{g:02x}{b:02x}"
|
||||||
state = {"state": "ON", "color_mode": "rgb", "brightness": int(brightness * 2.55),
|
state = {
|
||||||
"color": {"r": r, "g": g, "b": b}}
|
"state": "ON",
|
||||||
client_ref.publish(T_LED_BL_STATE, ujson.dumps(state), retain=True)
|
"color_mode": "rgb",
|
||||||
|
"brightness": int(brightness * 2.55),
|
||||||
|
"color": {"r": r, "g": g, "b": b},
|
||||||
|
}
|
||||||
|
_publish(T_LED_BL_STATE, ujson.dumps(state), retain=True)
|
||||||
info(f"Backlight → {color_hex} @ {brightness}%")
|
info(f"Backlight → {color_hex} @ {brightness}%")
|
||||||
return
|
return
|
||||||
|
|
||||||
@@ -306,104 +401,179 @@ def on_message(topic, payload):
|
|||||||
except ValueError:
|
except ValueError:
|
||||||
warn(f"Invalid set value: '{payload}'")
|
warn(f"Invalid set value: '{payload}'")
|
||||||
|
|
||||||
|
|
||||||
# ---------------------------------------------------------------------------
|
# ---------------------------------------------------------------------------
|
||||||
# MQTT connect + discovery
|
# MQTT connect + discovery
|
||||||
# ---------------------------------------------------------------------------
|
# ---------------------------------------------------------------------------
|
||||||
|
|
||||||
|
|
||||||
def connect_mqtt():
|
def connect_mqtt():
|
||||||
global client_ref
|
global client_ref, _mqtt_connected
|
||||||
info(f"Connecting to MQTT broker {MQTT_BROKER}:{MQTT_PORT} ...")
|
info(f"Connecting to MQTT broker {MQTT_BROKER}:{MQTT_PORT} ...")
|
||||||
client = MQTTClient(
|
client = MQTTClient(
|
||||||
client_id = MQTT_CLIENT_ID,
|
client_id=MQTT_CLIENT_ID,
|
||||||
server = MQTT_BROKER,
|
server=MQTT_BROKER,
|
||||||
port = MQTT_PORT,
|
port=MQTT_PORT,
|
||||||
user = MQTT_USER,
|
user=MQTT_USER,
|
||||||
password = MQTT_PASSWORD,
|
password=MQTT_PASSWORD,
|
||||||
keepalive = 60,
|
keepalive=60,
|
||||||
)
|
)
|
||||||
client.set_last_will(T_STATUS, b"offline", retain=True, qos=0)
|
client.set_last_will(T_STATUS, b"offline", retain=True, qos=0)
|
||||||
client.set_callback(on_message)
|
client.set_callback(on_message)
|
||||||
client.connect()
|
client.connect()
|
||||||
# Set client_ref AFTER connect so retained messages during subscribe
|
|
||||||
# are handled safely
|
|
||||||
client_ref = client
|
client_ref = client
|
||||||
client.subscribe(T_SET)
|
client.subscribe(T_SET)
|
||||||
client.subscribe(T_ZERO)
|
client.subscribe(T_ZERO)
|
||||||
client.subscribe(T_LED_RED)
|
client.subscribe(T_LED_RED)
|
||||||
client.subscribe(T_LED_GREEN)
|
client.subscribe(T_LED_GREEN)
|
||||||
client.subscribe(T_LED_BL)
|
client.subscribe(T_LED_BL)
|
||||||
|
_mqtt_connected = True
|
||||||
info(f"MQTT connected client_id={MQTT_CLIENT_ID}")
|
info(f"MQTT connected client_id={MQTT_CLIENT_ID}")
|
||||||
return client
|
return client
|
||||||
|
|
||||||
|
|
||||||
|
def check_mqtt():
|
||||||
|
global client_ref, _mqtt_connected
|
||||||
|
if client_ref is None:
|
||||||
|
return False
|
||||||
|
|
||||||
|
try:
|
||||||
|
client_ref.ping()
|
||||||
|
_mqtt_connected = True
|
||||||
|
return True
|
||||||
|
except Exception as e:
|
||||||
|
log_err(f"MQTT connection lost: {e}")
|
||||||
|
_mqtt_connected = False
|
||||||
|
|
||||||
|
# Try to reconnect
|
||||||
|
log_err("Attempting MQTT reconnection...")
|
||||||
|
for attempt in range(3):
|
||||||
|
try:
|
||||||
|
client_ref = MQTTClient(
|
||||||
|
client_id=MQTT_CLIENT_ID,
|
||||||
|
server=MQTT_BROKER,
|
||||||
|
port=MQTT_PORT,
|
||||||
|
user=MQTT_USER,
|
||||||
|
password=MQTT_PASSWORD,
|
||||||
|
keepalive=60,
|
||||||
|
)
|
||||||
|
client_ref.set_last_will(T_STATUS, b"offline", retain=True, qos=0)
|
||||||
|
client_ref.set_callback(on_message)
|
||||||
|
client_ref.connect()
|
||||||
|
client_ref.subscribe(T_SET)
|
||||||
|
client_ref.subscribe(T_ZERO)
|
||||||
|
client_ref.subscribe(T_LED_RED)
|
||||||
|
client_ref.subscribe(T_LED_GREEN)
|
||||||
|
client_ref.subscribe(T_LED_BL)
|
||||||
|
_mqtt_connected = True
|
||||||
|
info("MQTT reconnected!")
|
||||||
|
publish_discovery(client_ref)
|
||||||
|
publish_state(client_ref)
|
||||||
|
return True
|
||||||
|
except Exception as e2:
|
||||||
|
log_err(f"MQTT reconnect attempt {attempt + 1} failed: {e2}")
|
||||||
|
utime.sleep_ms(2000)
|
||||||
|
|
||||||
|
log_err("MQTT reconnection failed after 3 attempts")
|
||||||
|
return False
|
||||||
|
|
||||||
|
|
||||||
def publish_discovery(client):
|
def publish_discovery(client):
|
||||||
"""Publish all HA MQTT discovery payloads using short-form keys to stay under 512 bytes."""
|
"""Publish all HA MQTT discovery payloads using short-form keys to stay under 512 bytes."""
|
||||||
# Full device block only on first payload; subsequent use identifiers-only ref
|
# Full device block only on first payload; subsequent use identifiers-only ref
|
||||||
_dev_ref = {"identifiers": [MQTT_CLIENT_ID]}
|
_dev_ref = {"identifiers": [MQTT_CLIENT_ID]}
|
||||||
|
|
||||||
client.publish(T_DISC_GAUGE, ujson.dumps({
|
client.publish(
|
||||||
"name": GAUGE_ENTITY,
|
T_DISC_GAUGE,
|
||||||
"unique_id": MQTT_CLIENT_ID,
|
ujson.dumps(
|
||||||
"cmd_t": T_SET,
|
{
|
||||||
"stat_t": T_STATE,
|
"name": GAUGE_ENTITY,
|
||||||
"avty_t": T_STATUS,
|
"unique_id": MQTT_CLIENT_ID,
|
||||||
"min": GAUGE_MIN,
|
"cmd_t": T_SET,
|
||||||
"max": GAUGE_MAX,
|
"stat_t": T_STATE,
|
||||||
"step": 1,
|
"avty_t": T_STATUS,
|
||||||
"unit_of_meas": GAUGE_UNIT,
|
"min": GAUGE_MIN,
|
||||||
"icon": "mdi:gauge",
|
"max": GAUGE_MAX,
|
||||||
"dev": _DEVICE,
|
"step": 1,
|
||||||
}), retain=True)
|
"unit_of_meas": GAUGE_UNIT,
|
||||||
|
"icon": "mdi:gauge",
|
||||||
|
"dev": _DEVICE,
|
||||||
|
}
|
||||||
|
),
|
||||||
|
retain=True,
|
||||||
|
)
|
||||||
info("Discovery: gauge")
|
info("Discovery: gauge")
|
||||||
|
|
||||||
client.publish(T_DISC_RED, ujson.dumps({
|
client.publish(
|
||||||
"name": RED_ENTITY,
|
T_DISC_RED,
|
||||||
"uniq_id": f"{MQTT_CLIENT_ID}_led_red",
|
ujson.dumps(
|
||||||
"cmd_t": T_LED_RED,
|
{
|
||||||
"stat_t": T_LED_RED_STATE,
|
"name": RED_ENTITY,
|
||||||
"pl_on": "ON",
|
"uniq_id": f"{MQTT_CLIENT_ID}_led_red",
|
||||||
"pl_off": "OFF",
|
"cmd_t": T_LED_RED,
|
||||||
"icon": "mdi:led-on",
|
"stat_t": T_LED_RED_STATE,
|
||||||
"dev": _dev_ref,
|
"pl_on": "ON",
|
||||||
"ret": True,
|
"pl_off": "OFF",
|
||||||
}), retain=True)
|
"icon": "mdi:led-on",
|
||||||
|
"dev": _dev_ref,
|
||||||
|
"ret": True,
|
||||||
|
}
|
||||||
|
),
|
||||||
|
retain=True,
|
||||||
|
)
|
||||||
info("Discovery: red LED")
|
info("Discovery: red LED")
|
||||||
|
|
||||||
client.publish(T_DISC_GREEN, ujson.dumps({
|
client.publish(
|
||||||
"name": GREEN_ENTITY,
|
T_DISC_GREEN,
|
||||||
"uniq_id": f"{MQTT_CLIENT_ID}_led_green",
|
ujson.dumps(
|
||||||
"cmd_t": T_LED_GREEN,
|
{
|
||||||
"stat_t": T_LED_GREEN_STATE,
|
"name": GREEN_ENTITY,
|
||||||
"pl_on": "ON",
|
"uniq_id": f"{MQTT_CLIENT_ID}_led_green",
|
||||||
"pl_off": "OFF",
|
"cmd_t": T_LED_GREEN,
|
||||||
"icon": "mdi:led-on",
|
"stat_t": T_LED_GREEN_STATE,
|
||||||
"dev": _dev_ref,
|
"pl_on": "ON",
|
||||||
"ret": True,
|
"pl_off": "OFF",
|
||||||
}), retain=True)
|
"icon": "mdi:led-on",
|
||||||
|
"dev": _dev_ref,
|
||||||
|
"ret": True,
|
||||||
|
}
|
||||||
|
),
|
||||||
|
retain=True,
|
||||||
|
)
|
||||||
info("Discovery: green LED")
|
info("Discovery: green LED")
|
||||||
|
|
||||||
client.publish(T_DISC_BL, ujson.dumps({
|
client.publish(
|
||||||
"name": BL_ENTITY,
|
T_DISC_BL,
|
||||||
"uniq_id": f"{MQTT_CLIENT_ID}_led_bl",
|
ujson.dumps(
|
||||||
"cmd_t": T_LED_BL,
|
{
|
||||||
"stat_t": T_LED_BL_STATE,
|
"name": BL_ENTITY,
|
||||||
"schema": "json",
|
"uniq_id": f"{MQTT_CLIENT_ID}_led_bl",
|
||||||
"supported_color_modes": ["rgb"],
|
"cmd_t": T_LED_BL,
|
||||||
"icon": "mdi:led-strip",
|
"stat_t": T_LED_BL_STATE,
|
||||||
"dev": _dev_ref,
|
"schema": "json",
|
||||||
"ret": True,
|
"supported_color_modes": ["rgb"],
|
||||||
}), retain=True)
|
"icon": "mdi:led-strip",
|
||||||
|
"dev": _dev_ref,
|
||||||
|
"ret": True,
|
||||||
|
}
|
||||||
|
),
|
||||||
|
retain=True,
|
||||||
|
)
|
||||||
info("Discovery: backlight")
|
info("Discovery: backlight")
|
||||||
|
|
||||||
|
|
||||||
def publish_state(client):
|
def publish_state(client):
|
||||||
val = gauge.get()
|
val = gauge.get()
|
||||||
client.publish(T_STATE, str(round(val, 1)), retain=True)
|
client.publish(T_STATE, str(round(val, 1)), retain=True)
|
||||||
client.publish(T_STATUS, "online", retain=True)
|
client.publish(T_STATUS, "online", retain=True)
|
||||||
info(f"State published value={val:.1f} step={gauge._current_step}")
|
info(f"State published value={val:.1f} step={gauge._current_step}")
|
||||||
|
|
||||||
|
|
||||||
# ---------------------------------------------------------------------------
|
# ---------------------------------------------------------------------------
|
||||||
# Main
|
# Main
|
||||||
# ---------------------------------------------------------------------------
|
# ---------------------------------------------------------------------------
|
||||||
|
|
||||||
|
|
||||||
def main():
|
def main():
|
||||||
info("=" * 48)
|
info("=" * 48)
|
||||||
info("Gauge MQTT controller starting")
|
info("Gauge MQTT controller starting")
|
||||||
@@ -425,13 +595,14 @@ def main():
|
|||||||
|
|
||||||
try:
|
try:
|
||||||
import ota
|
import ota
|
||||||
|
|
||||||
ota.mark_ok()
|
ota.mark_ok()
|
||||||
info("OTA OK flag set")
|
info("OTA OK flag set")
|
||||||
except ImportError:
|
except ImportError:
|
||||||
pass
|
pass
|
||||||
|
|
||||||
global _last_rezero_ms, _bl_dirty_since
|
global _last_rezero_ms, _bl_dirty_since
|
||||||
last_heartbeat = utime.ticks_ms()
|
last_heartbeat = utime.ticks_ms()
|
||||||
_last_rezero_ms = utime.ticks_ms()
|
_last_rezero_ms = utime.ticks_ms()
|
||||||
|
|
||||||
target_step = gauge._val_to_step(_target_value)
|
target_step = gauge._val_to_step(_target_value)
|
||||||
@@ -442,6 +613,12 @@ def main():
|
|||||||
|
|
||||||
while True:
|
while True:
|
||||||
try:
|
try:
|
||||||
|
check_wifi()
|
||||||
|
|
||||||
|
if not check_mqtt():
|
||||||
|
utime.sleep_ms(1000)
|
||||||
|
continue
|
||||||
|
|
||||||
client.check_msg()
|
client.check_msg()
|
||||||
|
|
||||||
now = utime.ticks_ms()
|
now = utime.ticks_ms()
|
||||||
@@ -455,40 +632,54 @@ def main():
|
|||||||
moved = True
|
moved = True
|
||||||
|
|
||||||
# Publish state during movement at intervals
|
# Publish state during movement at intervals
|
||||||
if moved and utime.ticks_diff(now, last_move_state) >= MOVE_STATE_INTERVAL_MS:
|
if (
|
||||||
publish_state(client)
|
moved
|
||||||
|
and utime.ticks_diff(now, last_move_state) >= MOVE_STATE_INTERVAL_MS
|
||||||
|
):
|
||||||
|
publish_state(client_ref)
|
||||||
last_move_state = now
|
last_move_state = now
|
||||||
|
|
||||||
# Sleep to achieve constant speed
|
# Sleep to achieve constant speed
|
||||||
if moved or (current_target == gauge._current_step and gauge._current_step != gauge._val_to_step(_target_value)):
|
if moved or (
|
||||||
|
current_target == gauge._current_step
|
||||||
|
and gauge._current_step != gauge._val_to_step(_target_value)
|
||||||
|
):
|
||||||
delay_us = 1_000_000 // MICROSTEPS_PER_SECOND
|
delay_us = 1_000_000 // MICROSTEPS_PER_SECOND
|
||||||
utime.sleep_us(delay_us)
|
utime.sleep_us(delay_us)
|
||||||
|
|
||||||
# Periodic auto-rezero (disabled when interval is 0)
|
# Periodic auto-rezero (disabled when interval is 0)
|
||||||
if REZERO_INTERVAL_MS > 0 and utime.ticks_diff(now, _last_rezero_ms) >= REZERO_INTERVAL_MS:
|
if (
|
||||||
|
REZERO_INTERVAL_MS > 0
|
||||||
|
and utime.ticks_diff(now, _last_rezero_ms) >= REZERO_INTERVAL_MS
|
||||||
|
):
|
||||||
info("Auto-rezero triggered")
|
info("Auto-rezero triggered")
|
||||||
saved = _target_value
|
saved = _target_value
|
||||||
gauge.zero()
|
gauge.zero()
|
||||||
if saved > GAUGE_MIN:
|
if saved > GAUGE_MIN:
|
||||||
gauge.set(saved)
|
gauge.set(saved)
|
||||||
publish_state(client)
|
publish_state(client_ref)
|
||||||
_last_rezero_ms = now
|
_last_rezero_ms = now
|
||||||
info(f"Auto-rezero complete, restored to {saved:.1f}")
|
info(f"Auto-rezero complete, restored to {saved:.1f}")
|
||||||
|
|
||||||
# Retain backlight state via MQTT after settling
|
# Retain backlight state via MQTT after settling
|
||||||
if _bl_dirty_since is not None and utime.ticks_diff(now, _bl_dirty_since) >= _BL_SAVE_DELAY_MS:
|
if (
|
||||||
_flush_backlight(client)
|
_bl_dirty_since is not None
|
||||||
|
and utime.ticks_diff(now, _bl_dirty_since) >= _BL_SAVE_DELAY_MS
|
||||||
|
):
|
||||||
|
_flush_backlight(client_ref)
|
||||||
_bl_dirty_since = None
|
_bl_dirty_since = None
|
||||||
|
|
||||||
# Heartbeat
|
# Heartbeat
|
||||||
if utime.ticks_diff(now, last_heartbeat) >= HEARTBEAT_MS:
|
if utime.ticks_diff(now, last_heartbeat) >= HEARTBEAT_MS:
|
||||||
publish_state(client)
|
publish_state(client_ref)
|
||||||
info(f"step={gauge._current_step} phase={gauge._phase} target_step={gauge._val_to_step(_target_value)} expected_phase={gauge._current_step % 4}")
|
info(
|
||||||
|
f"step={gauge._current_step} phase={gauge._phase} target_step={gauge._val_to_step(_target_value)} expected_phase={gauge._current_step % 4}"
|
||||||
|
)
|
||||||
last_heartbeat = now
|
last_heartbeat = now
|
||||||
|
|
||||||
except Exception as e:
|
except Exception as e:
|
||||||
log_err(f"Main loop error: {e} — continuing")
|
log_err(f"Main loop error: {e} — continuing")
|
||||||
utime.sleep_ms(100)
|
utime.sleep_ms(100)
|
||||||
|
|
||||||
main()
|
|
||||||
|
|
||||||
|
main()
|
||||||
|
|||||||
Reference in New Issue
Block a user