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>
22 lines
646 B
C++
22 lines
646 B
C++
#pragma once
|
|
#include <Arduino.h>
|
|
|
|
class RobotIMU {
|
|
public:
|
|
bool begin(); // returns false if the IMU didn't respond
|
|
void update(float dt); // no-op if the IMU never came up
|
|
float rollDeg() const { return roll_deg_; }
|
|
float pitchDeg() const { return pitch_deg_; }
|
|
bool ok() const { return ok_; }
|
|
|
|
// Robot-gyro toggle from CmdPacket. The attitude is estimated either way
|
|
// (the remote shows it); robot.ino only levels the body while it's set.
|
|
bool enabled = true;
|
|
|
|
private:
|
|
float roll_deg_ = 0, pitch_deg_ = 0;
|
|
bool ok_ = false;
|
|
|
|
bool readRaw(float& ax, float& ay, float& az, float& gx, float& gy, float& gz);
|
|
};
|