Architecture change (2026-04-03): Mamba F722S (STM32F722) and BlackPill replaced by ESP32 BALANCE (PID loop) and ESP32 IO (motors/sensors/comms). - Update CLAUDE.md, docs, chassis BOM/ASSEMBLY, pinout, power-budget, wiring-diagram, TEAM.md, AUTONOMOUS_ARMING.md, docker-compose - Update all ROS2 package comments, config labels, launch args (stm32_port→esp32_port, /dev/stm32-bridge→/dev/esp32-bridge) - Update WebUI: stm32Mode→esp32Mode, stm32Version→esp32Version, "STM32 State/Mode" labels → "ESP32 State/Mode" (ControlMode, SettingsPanel) - Add TODO(esp32-migration) markers on stm32_protocol.py and mamba_protocol.py binary frame layouts — pending ESP32 protocol spec from max - Fix roslib CDN 1.3.0→1.4.0 in all 11 HTML panels (fixes ROS2 Humble rosbridge "Received a message without an op" incompatibility) Co-Authored-By: Claude Sonnet 4.6 <noreply@anthropic.com>
4.3 KiB
4.3 KiB
Face LCD Animation System (Issue #507)
Implements expressive face animations on an ESP32 LCD display with 5 core emotions and smooth transitions.
Features
Emotions
- HAPPY: Upturned eyes, curved smile, raised eyebrows
- SAD: Downturned eyes, frown, lowered eyebrows
- CURIOUS: Wide eyes, raised eyebrows, slight tilt, inquisitive mouth
- ANGRY: Narrowed eyes, downturned brows, clenched frown
- SLEEPING: Closed/squinted eyes, peaceful smile
- NEUTRAL: Baseline relaxed expression
Animation Capabilities
- Smooth Transitions: 0.5s easing between emotions (ease-in-out cubic)
- Idle Blinking: Periodic automatic blinks (4-6s intervals)
- Blink Duration: 100-150ms per blink
- Frame Rate: 30 Hz target refresh rate
- UART Control: Text-based emotion commands from Jetson Orin
Architecture
Components
1. face_lcd.h / face_lcd.c — Display Driver
Low-level abstraction for LCD framebuffer management and rendering.
Features:
- Generic SPI/I2C display interface (hardware-agnostic)
- Monochrome (1-bit) and RGB565 support
- Pixel drawing primitives: line, circle, filled rectangle
- DMA-driven async flush to display
- 30Hz vsync control via systick
2. face_animation.h / face_animation.c — Emotion Renderer
State machine for emotion transitions, blinking, and face rendering.
Features:
- Parameterized emotion models (eye position/size, brow angle, mouth curvature)
- Smooth interpolation between emotions via easing functions
- Automatic idle blinking with configurable intervals
- Renders to LCD via face_lcd_* primitives
3. face_uart.h / face_uart.c — UART Command Interface
Receives emotion commands from Jetson Orin over UART.
Protocol:
HAPPY → Set emotion to HAPPY
SAD → Set emotion to SAD
CURIOUS → Set emotion to CURIOUS
ANGRY → Set emotion to ANGRY
SLEEP → Set emotion to SLEEPING
NEUTRAL → Set emotion to NEUTRAL
BLINK → Trigger immediate blink
STATUS → Echo current emotion + idle state
Integration Points
main.c
-
Includes (lines 32-34):
- face_lcd.h, face_animation.h, face_uart.h
-
Initialization (after servo_init()):
- face_lcd_init(), face_animation_init(), face_uart_init()
-
SysTick Handler:
- face_lcd_tick() for 30Hz refresh vsync
-
Main Loop:
- face_animation_tick() and face_animation_render() after servo_tick()
- face_uart_process() after jlink_process()
Hardware Requirements
Display
- Type: Small LCD/OLED (SSD1306, ILI9341, ST7789)
- Resolution: 128×64 to 320×240
- Interface: SPI or I2C
- Colors: Monochrome (1-bit) or RGB565
Microcontroller
- ESP32xx (ESP32 BALANCE)
- Available UART: USART3 (PB10=TX, PB11=RX)
- Clock: 216 MHz
Animation Timing
| Parameter | Value | Notes |
|---|---|---|
| Refresh Rate | 30 Hz | ~33ms per frame |
| Transition Duration | 500ms | 15 frames at 30Hz |
| Easing Function | Cubic ease-in-out | Smooth accel/decel |
| Blink Duration | 100-150ms | ~3-5 frames |
| Blink Interval | 4-6s | ~120-180 frames |
Files Modified/Created
| File | Type | Notes |
|---|---|---|
| include/face_lcd.h | NEW | LCD driver interface (105 lines) |
| include/face_animation.h | NEW | Emotion state machine (100 lines) |
| include/face_uart.h | NEW | UART command protocol (78 lines) |
| src/face_lcd.c | NEW | LCD framebuffer + primitives (185 lines) |
| src/face_animation.c | NEW | Emotion rendering + transitions (340 lines) |
| src/face_uart.c | NEW | UART command parser (185 lines) |
| src/main.c | MODIFIED | +35 lines (includes + init + ticks) |
| test/test_face_animation.c | NEW | Unit tests (14 test cases, 350+ lines) |
| docs/FACE_LCD_ANIMATION.md | NEW | This documentation |
Status
✅ Complete:
- Core emotion state machine (6 emotions)
- Smooth transition easing (ease-in-out cubic)
- Idle blinking logic (4-6s intervals, 100-150ms duration)
- UART command interface (text-based, 8 commands)
- LCD framebuffer abstraction (monochrome + RGB565)
- Rendering primitives (line, circle, filled rect)
- systick integration for 30Hz refresh
- Unit tests (14 test cases)
- Documentation
⏳ Pending Hardware:
- LCD hardware detection/initialization
- SPI/I2C peripheral configuration
- Display controller init sequence (SSD1306, ILI9341, etc.)
- Pin configuration for CS/DC/RES (if applicable)