Protocol v4: CmdPacket grows to 26 bytes (cal_cmd, cal_servo, cal_value); new 30-byte Telemetry rides back on the nRF24 ack payload (robot state, IMU, battery, 18 joint angles, packets/s, servo-cal echo). Each end drops wrong-length packets, so version mismatches still fail closed. Robot (owner-approved): SERVO_CAL state while disarmed, per-servo centre trims (+-200 us) in EEPROM, telemetry, battery reading; the IMU estimate now always runs (leveling still gated by ROBOT GYRO). Remote: generated HMI (scripts/make_remote_hmi.py) with pages splash, drive, status, servos, cal, setup, upload; page-aware NextionUI that only writes the showing page and only what changed; servo calibration and UPDATE DISPLAY on the touchscreen and serial console; battery module. The display is on Serial2 (pins 7/8), found on the real remote; the old sketch's Serial1 was never connected to it. Sim: RF24 shim supports ack payloads, API version 8 (hxsim_get_ack_payload); sim_smoke checks telemetry and every CAL command. Unity CmdPacket mirror updated. Co-Authored-By: Claude Opus 5.5 <noreply@anthropic.com>
27 lines
1.4 KiB
C++
27 lines
1.4 KiB
C++
#pragma once
|
|
#include "Kinematics.h"
|
|
|
|
class ServoDriver {
|
|
public:
|
|
void begin(); // set up the PWM pins (no pulses yet)
|
|
void relaxAll(); // stop all pulses - call when disarming
|
|
void writeLeg(int leg_index, const JointAngles& angles);
|
|
|
|
// Joint angle -> pulse through that servo's calibration (Config.h SERVOS)
|
|
// plus its centre trim.
|
|
static int degToMicros(int leg, int joint, float deg);
|
|
|
|
// ---- Servo centre calibration (remote's CAL page, CmdPacket.cal_*) ----
|
|
// Each servo has a centre trim in us on top of Config.h SERVOS, kept in
|
|
// EEPROM. Trims shift the whole pulse range, like the old sketch's
|
|
// servoCallibration[].
|
|
static void loadTrims(); // from EEPROM; all 0 if none stored. Call in setup()
|
|
static int16_t trim(int servo); // servo = leg * 3 + joint
|
|
static bool trimsDirty(); // changed since the last load/save
|
|
static bool trimsStored(); // the EEPROM holds a trim record
|
|
// Applies one calibration command (CAL_* in HexapodProtocol.h) and holds
|
|
// every servo at the centre pose. Call every loop while in SERVO_CAL.
|
|
void calibrate(uint8_t cal_cmd, uint8_t servo, int16_t value_us);
|
|
static const JointAngles CAL_POSE; // coxa 0, femur 0, tibia -90
|
|
};
|