2026 remote: tabbed Nextion UI, robot telemetry, servo centre calibration
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>
This commit is contained in:
1 parent
481610c9fd
commit
0b836af8de
40 files changed
+1463
-281
No files matched your search
@@ -12,22 +12,48 @@ bool Comms::begin() {
|
||||
SPI.setSCK(RADIO_SCK_PIN); // alternate SCK pin (see Config.h); before RF24 starts SPI
|
||||
radio_present_ = radio.begin();
|
||||
if (radio_present_) {
|
||||
radio.setPayloadSize(HXP_RADIO_PAYLOAD); // mismatched protocol versions won't be received at all
|
||||
// Telemetry rides back on the auto-ack (ack payloads), which needs dynamic
|
||||
// payload lengths - update() drops any packet that isn't a CmdPacket.
|
||||
radio.enableAckPayload();
|
||||
radio.openReadingPipe(1, HXP_RADIO_ADDRESS);
|
||||
radio.setPALevel((rf24_pa_dbm_e)HXP_RADIO_PA_LEVEL);
|
||||
radio.setDataRate((rf24_datarate_e)HXP_RADIO_DATA_RATE);
|
||||
radio.setChannel(HXP_RADIO_CHANNEL);
|
||||
radio.startListening();
|
||||
loadAckPayload();
|
||||
}
|
||||
return radio_present_;
|
||||
}
|
||||
|
||||
// Replaces whatever ack payload is still queued with the latest telemetry, so
|
||||
// the remote never gets stale data.
|
||||
void Comms::loadAckPayload() {
|
||||
radio.flush_tx();
|
||||
radio.writeAckPayload(1, &telemetry_, sizeof(telemetry_));
|
||||
}
|
||||
|
||||
void Comms::update() {
|
||||
if (radio_present_) {
|
||||
bool got = false;
|
||||
while (radio.available()) {
|
||||
radio.read(&packet_, sizeof(packet_));
|
||||
last_rx_ms_ = millis();
|
||||
uint8_t len = radio.getDynamicPayloadSize();
|
||||
if (len == sizeof(CmdPacket)) {
|
||||
radio.read(&packet_, sizeof(packet_));
|
||||
last_rx_ms_ = millis();
|
||||
rx_count_++;
|
||||
got = true;
|
||||
} else if (len > 0) { // 0 = corrupt length; RF24 has flushed the FIFO already
|
||||
uint8_t junk[32]; // another protocol version: never act on it
|
||||
radio.read(junk, len <= sizeof(junk) ? len : sizeof(junk));
|
||||
}
|
||||
}
|
||||
if (got) loadAckPayload();
|
||||
}
|
||||
uint32_t now = millis();
|
||||
if (now - rate_window_ms_ >= 1000) {
|
||||
rx_per_sec_ = (uint8_t)min(rx_count_, (uint16_t)255);
|
||||
rx_count_ = 0;
|
||||
rate_window_ms_ = now;
|
||||
}
|
||||
link_ok_ = (millis() - last_rx_ms_) < (uint32_t)(LINK_TIMEOUT_SEC * 1000);
|
||||
}
|
||||
Reference in new issue
Block a user