feat: add Microduck UNO Q deployment and hotspot skill control

This commit is contained in:
2026-11-19 13:49:08 +08:00
parent 2b0c395508
commit 164a397726
99 changed files with 12488 additions and 4 deletions
+184
View File
@@ -0,0 +1,184 @@
from __future__ import annotations
import copy
import json
from email.parser import BytesParser
from email.policy import default as email_default_policy
from pathlib import Path
from typing import Any
from core.controller import MicroduckController
from core.deploy_service import DeployService
STATIC_DIR = Path(__file__).resolve().parent / "static"
def load_index_html() -> bytes:
path = STATIC_DIR / "index.html"
if not path.is_file():
return b"<html><body><h1>Microduck controller UI missing</h1></body></html>"
return path.read_bytes()
def parse_bool_flag(raw: str | None) -> bool:
if raw is None:
return False
return raw.strip().lower() in ("1", "true", "yes", "on")
def extract_deploy_payload(
content_type: str,
body: bytes,
query_overwrite: str | None = None,
) -> tuple[bytes, bool]:
overwrite = parse_bool_flag(query_overwrite)
ctype = (content_type or "").lower()
if "multipart/form-data" in ctype:
raw_msg = f"Content-Type: {content_type}\r\nMIME-Version: 1.0\r\n\r\n".encode("latin1") + body
msg = BytesParser(policy=email_default_policy).parsebytes(raw_msg)
if not msg.is_multipart():
raise ValueError("Malformed multipart/form-data upload")
zip_bytes: bytes | None = None
for part in msg.iter_parts():
field = part.get_param("name", header="content-disposition")
payload = part.get_payload(decode=True) or b""
if field in ("bundle", "file", "zip") and payload:
zip_bytes = payload
elif field == "overwrite_profile":
overwrite = parse_bool_flag(payload.decode("utf-8", errors="ignore"))
if not zip_bytes:
raise ValueError("Multipart upload missing 'bundle' zip field")
return zip_bytes, overwrite
return body, overwrite
def build_status_payload(controller: MicroduckController, deploy_service: DeployService) -> dict[str, Any]:
st = controller.get_status()
st["last_deploy"] = copy.deepcopy(deploy_service.last_deploy) if deploy_service.last_deploy else None
return st
def handle_ws_message(controller: MicroduckController, msg: dict[str, Any]) -> dict[str, Any] | None:
kind = msg.get("type")
if kind == "input":
controller.set_remote_input(
norm_x=float(msg.get("vx", 0.0)),
norm_wz=float(msg.get("wz", 0.0)),
speed_scale=float(msg["speed_scale"]) if "speed_scale" in msg else None,
)
return None
if kind == "head":
controller.set_head_target(
float(msg.get("neck_pitch", 0.0)),
float(msg.get("head_pitch", 0.0)),
float(msg.get("head_yaw", 0.0)),
float(msg.get("head_roll", 0.0)),
)
return None
if kind == "stand":
try:
controller.request_stand()
return {"type": "ack", "event": "stand"}
except RuntimeError as exc:
return {"type": "error", "error": str(exc)}
if kind == "estop":
controller.emergency_stop()
return {"type": "ack", "event": "estop"}
if kind == "action":
action = str(msg.get("action", ""))
ok = controller.trigger_action(action)
return {"type": "ack", "event": "action", "action": action, "ok": ok}
if kind == "settings":
if "auto_stand_on_fall" in msg:
controller.set_auto_stand_on_fall(bool(msg["auto_stand_on_fall"]))
if "speed_scale" in msg:
controller.set_speed_scale(float(msg["speed_scale"]))
return {"type": "ack", "event": "settings"}
if kind == "ping":
return {"type": "pong", "t": msg.get("t")}
return None
def dispatch_api_get(
path: str,
controller: MicroduckController,
deploy_service: DeployService,
) -> tuple[int, dict[str, Any]]:
if path == "/api/status":
return 200, build_status_payload(controller, deploy_service)
if path == "/api/profile":
return 200, {"ok": True, "profile": copy.deepcopy(controller.profile)}
return 404, {"ok": False, "error": f"Unknown GET endpoint: {path}"}
def dispatch_api_post(
path: str,
body_bytes: bytes,
content_type: str,
query_params: dict[str, list[str]],
controller: MicroduckController,
deploy_service: DeployService,
) -> tuple[int, dict[str, Any]]:
if path == "/api/deploy":
try:
q_ow = query_params.get("overwrite_profile", [None])[0]
raw_zip, overwrite = extract_deploy_payload(content_type, body_bytes, q_ow)
res = dict(deploy_service.apply_zip_bytes(raw_zip, overwrite_profile=overwrite))
res["status"] = build_status_payload(controller, deploy_service)
return 200, res
except ValueError as exc:
return 400, {"ok": False, "error": str(exc)}
except Exception as exc:
return 500, {"ok": False, "error": str(exc)}
try:
payload = json.loads(body_bytes.decode("utf-8")) if body_bytes.strip() else {}
except Exception:
return 400, {"ok": False, "error": "Invalid JSON body"}
try:
if path == "/api/stand":
controller.request_stand()
return 200, build_status_payload(controller, deploy_service)
if path == "/api/estop":
controller.emergency_stop()
return 200, build_status_payload(controller, deploy_service)
if path == "/api/action":
action = str(payload.get("action", ""))
ok = controller.trigger_action(action)
return 200, {"ok": ok, "status": build_status_payload(controller, deploy_service)}
if path == "/api/settings":
if "auto_stand_on_fall" in payload:
controller.set_auto_stand_on_fall(bool(payload["auto_stand_on_fall"]))
if "speed_scale" in payload:
controller.set_speed_scale(float(payload["speed_scale"]))
return 200, build_status_payload(controller, deploy_service)
if path == "/api/profile":
profile = controller.update_profile(payload)
return 200, {"ok": True, "profile": profile}
if path == "/api/calibrate/ping":
max_id = int(payload.get("max_id", 20))
return 200, {"ok": True, "ids": controller.ping_servos(max_id=max_id)}
if path == "/api/calibrate/joint_zero":
joint = str(payload.get("joint", ""))
profile = controller.capture_joint_zero(joint)
return 200, {"ok": True, "profile": profile}
if path == "/api/calibrate/test_joint":
joint = str(payload.get("joint", ""))
rad = float(payload.get("rad", 0.0))
ticks = controller.test_single_joint(joint, rad)
return 200, {"ok": True, "ticks": ticks}
if path == "/api/calibrate/exit":
controller.exit_calibration()
return 200, build_status_payload(controller, deploy_service)
if path == "/api/calibrate/imu_zero":
samples = int(payload.get("samples", 200))
imu = controller.calibrate_imu_zero(samples=samples)
return 200, {"ok": True, "imu": imu}
except (ValueError, RuntimeError) as exc:
return 400, {"ok": False, "error": str(exc)}
except Exception as exc:
return 500, {"ok": False, "error": str(exc)}
return 404, {"ok": False, "error": f"Unknown POST endpoint: {path}"}