Files
hexapod-robot/2026-current/remote/README.md
T
mangavalkandClaude Opus 5.5 60605209fb 2026: remote v2 (flat console for the twist-grip sticks), STL/3MF exports, archive page
remote_v2.scad: a new remote for the same electronics, 216 x 116 x 32 mm,
ASA, two shells printed without supports and joined with M3 heat-set
inserts. Hangs level from a neck strap on a balance-point eyelet (top face
or front edge) with a fold-out body brace; kickstand for the table.
JH-D300X-R1 sticks clamp the plate; main perfboard (Teensy 4.0, nRF24,
IMU) clamped at its sides under the display; UPS board with its LEDs
through the floor. Red honeycomb and white ON/OFF inlays in the first
3 layers. Every part checked for collisions.

- stl/remote_v2/: print-ready STLs, plus a multi-part 3MF (export_3mf.py)
  with the inlays on filaments 2 and 3
- ARCHIVE.md: the original remote with the owner's photos; README shows v2
  and how to print it
- Notes for later: battery-voltage reading, IMU on Wire (18/19) with two
  stick axes moved to A7/A8, a stable 6 V supply for the 18 servos
- remote.scad: its sticks are JH-D300X-R1 (the model uses the D400X drawing)
- *.3mf through Git LFS; repo README says Teensy 4.0 remote

Co-Authored-By: Claude Opus 5.5 <noreply@anthropic.com>
2026-11-14 18:57:49 +01:00

7.0 KiB
Raw Blame History

Hexapod remote firmware (Teensy 4.0)

Handheld transmitter for the hexapod. It reads two 3-axis twist-grip joysticks and an MPU6050, takes operator commands from a Nextion touchscreen, and sends a CmdPacket (defined in ../shared/HexapodProtocol/HexapodProtocol.h) to the robot over nRF24L01 at 100 Hz.

Planned

  • Battery level (not built yet): read the 18650's voltage through a ~100k/100k divider from the cell's + (not the boost board's 5 V output) into A6 (pin 20, free), with 100 nF to GND, and show the charge on the Nextion with a low-battery warning. Details in ../hardware/openscad/PLANNING.md (notes for future designs).

  • IMU on the normal pin headers (suggestion, not done): with the GY-521 on the main board, wire it to Wire (SDA 18 / SCL 19) instead of Wire2 (the 24/25 pads under the Teensy 4.0). 18/19 are A4/A5, used by two stick axes now, so move those two axes to A7 (pin 21) and A8 (pin 22): all on the edge headers. A6 (pin 20) stays free for the battery divider, A9 (23) is spare. Firmware: in Config.h STICK_PINS = { A0, A1, A2, A3, A7, A8 } and #define IMU_WIRE Wire; Sticks.cpp reads through STICK_PINS, so nothing else changes. Redo the stick axis check (p dump) and calibration afterwards. (Wire1 is no way out: its 16/17 are stick pins A2/A3 too.)

Building

From the 2026-current folder: pio run -e remote, flash with pio run -e remote -t upload, monitor with pio device monitor -e remote.

Wiring (from the old remote sketch in ../../2019-teensy-nrf24/remote/; edit Config.h if yours differs)

Part Signal Teensy 4.0 pin
nRF24L01 MOSI / MISO / SCK 11 / 12 / 13 (SPI0)
nRF24L01 CE / CSN 9 / 10
nRF24L01 VCC 3.3 V, with a 10–100 µF cap right at the module
MPU6050 SDA / SCL 25 / 24 (Wire2), solder pads on the underside of the 4.0: not 18/19, those are stick pins A4/A5
Nextion TX → RX1, RX ← TX1 0 / 1 (Serial1), 5 V supply
Sticks 6 axes A0–A5. Which axis is on which pin isn't known yet: reorder STICK_PINS until the p dump reads right

MPU6050 rewiring: the old remote had its MPU code switched off, probably because A4/A5 double as Wire's pins. Move the MPU's SDA/SCL to pins 25/24 (the pads under the board).

Stick pots are wired 3.3 V – wiper – GND. Never feed 5 V into a Teensy 4.x analog pin.

Control scheme

Input Packet field Meaning on the robot
Left stick forward/back vx walk forward/back
Left stick left/right vy strafe (mode A); heading target direction (mode B)
Left stick twist yaw_rate turn rate (mode A only; ignored in mode B)
Right stick, ROTATE (default) rx/ry/rz body roll / pitch / yaw
Right stick, MOVE (FLAG_RSTICK_XLATE) rx/ry/rz body X / Y / Z (height, via twist) offset
Handset tilt remote_roll/pitch extra body roll/pitch while REMOTE GYRO is on
Height slider body_height standing height, default ± STANCE_HEIGHT_RANGE_MM (robot rate-limits the change)

In HEADING mode the left stick steers, relative to where the robot faces at that moment. Forward/back walks forward/back, and sideways steers: forward+left or back+left walk while turning left, and left alone turns on the spot for as long as you hold it. Let go and the robot holds its heading.

Touchscreen: ARM / DISARM, SIT/STAND, TRIPOD/WAVE, DIRECT/HEADING, R: ROTATE/MOVE, REMOTE GYRO, ROBOT GYRO, speed slider, LEVEL (re-zero the handset tilt), CAL / CANCEL CAL. NEXTION.md has the HMI build guide.

Safety interlocks (in RemoteState)

  • Arming is refused unless every stick axis is centered, and never allowed during calibration.
  • Disarming always clears the stand request. The robot arms into SIT, so re-arming never stands it up by itself.
  • Link loss: if no ack arrives for LINK_LOST_MS (300 ms, matching the robot's failsafe), the remote disarms itself. When the link comes back the robot stays down until you re-arm deliberately.
  • Sit/stand requests are only accepted while armed. FLAG_WALK is only sent while standing is requested.
  • While disarmed or calibrating, all motion fields are sent as zero.

Smoothing

  • Speed scale ramps toward the slider at SPEED_SCALE_RATE_PER_SEC. The robot uses speed scale directly on the walking twist, so a slider jump would otherwise be a velocity step.
  • Remote tilt fades in/out over ~0.5 s when REMOTE GYRO is toggled, and the handset re-zeroes its "level" at the moment you enable it.
  • FLAG_WALK lingers 250 ms after the left stick centers, so hovering at the deadzone edge doesn't make the robot chatter between STAND and WALKING.
  • Body pose smoothing is left to the robot's BodyPose rate limiters.

Stick calibration

  1. Power on with both sticks released and the remote held still. Each axis's resting center is captured automatically.
  2. For full calibration, disarm, then tap CAL (or press c on the serial console). Move every axis of both sticks to both limits, release them, and tap SAVE CAL (c). The result is saved to EEPROM.
  3. If any axis moved less than CAL_MIN_HALF_SPAN either side of center, the save is refused and you stay in calibration mode. CANCEL CAL (x) aborts.
  4. p prints the calibration in a form you can paste into Config.h defaults. R wipes EEPROM back to the Config.h defaults.

Serial console (USB, 115200, single keystrokes)

Every touchscreen control is available here, so you can bench-test with no display attached.

Key Action Key Action
a toggle arm k disarm
s toggle sit/stand g tripod ↔ wave
m direct ↔ heading-hold t right stick rotate ↔ translate
r remote gyro on/off b robot gyro on/off
+ / - speed ±25 z zero handset level
] / [ height up / down 10%
c start / save calibration x cancel calibration
p print status (raw + mapped sticks, IMU, link, state, cal) d toggle 10 Hz packet dump
R reset stick cal to Config defaults U Nextion upload mode (USB ↔ display; power-cycle to leave)

Bench-check checklist

  1. Stick directions: with p, confirm each logical axis reads positive for right / forward / counterclockwise twist. Flip it in STICK_INVERT[] if not.
  2. IMU mounting: with p, dip the right edge down to get +roll, and tip the far edge down to get +pitch. If not, fix IMU_AXIS_FROM_CHIP / IMU_AXIS_SIGN.
  3. Nextion baud: bauds=115200 must be in Program.s, or the display shows nothing useful.
  4. Radio: with the robot powered, tLink / p should show ~100%. If it reads NO LINK, check that both boards were built from the same HexapodProtocol.h. The static payload size is part of the handshake.
  5. End to end with the robot on a stand: use d to dump packets and confirm each field changes the way the table above says.