Binary 封包與頻寬

適用於 IMU600-V2/韌體 0.11.2/GUI v1.6.1。

以 MODE,binary 切換 UART1 輸出;指令仍以 ASCII 送入,ACK/NAK/INFO 等回覆使用 0x7F TEXT 幀。UART2 出廠為 binary,單位與 status/flags 定義與 ASCII 相同。

幀格式與 CRC

D6 44 | id (1) | len (1) | seq (1) | payload (len) | crc16 (2)
欄位 規則
sync 0xD6 0x44
id / len 訊息種類/payload 長度 0–255 bytes
seq 每個 id、每個 UART 埠獨立遞增,8-bit 循環
payload Little-endian,f32 = IEEE-754 單精度
crc16 CRC-16/CCITT-FALSE:poly 0x1021、init 0xFFFF、不反射、xorout 0;涵蓋 id/len/seq/payload,CRC 本身以 LE 儲存
def crc16_ccitt(data: bytes) -> int:
    crc = 0xFFFF
    for byte in data:
        crc ^= byte << 8
        for _ in range(8):
            crc = ((crc << 1) ^ 0x1021) & 0xFFFF if crc & 0x8000 else (crc << 1) & 0xFFFF
    return crc

assert crc16_ccitt(b"123456789") == 0x29B1

def frame_crc_ok(frame: bytes) -> bool:
    if len(frame) < 7 or frame[:2] != b"\xd6\x44":
        return False
    size = frame[3]
    return (len(frame) == size + 7 and
            crc16_ccitt(frame[2:5 + size]) ==
            int.from_bytes(frame[5 + size:7 + size], "little"))

訊息表

ID Name Payload bytes Python struct
0x01 IMU_RAW 68 <BBHQ3f3ff3f3ff
0x02 IMU (fused) 68 <Q3f3ff3f3ffBBBB
0x03 BARO 24 <QfffB3x
0x04 AHRS 52 <Q4f3f3fBBH
0x05 PPS 24 <QIIiBBH
0x10 STAT 44 <BBBB9IHH
0x11 FUS 32 <6Iff
0x12 SYS 48 <7IHBBBBBBIII
0x7F TEXT 可變 ASCII 字串,不含 $ 與 *XX

Payload 欄位順序

0x01 IMU_RAW:
imu_id:u8, status:u8, n:u16, ts_us:u64,
gyro[3]:f32, acc[3]:f32, temp:f32, dth[3]:f32, dv[3]:f32, dt:f32

0x02 IMU:
ts_us:u64, gyro[3]:f32, acc[3]:f32, temp:f32,
dth[3]:f32, dv[3]:f32, dt:f32,
n_used:u8, flags:u8, used_mask:u8, reserved:u8

0x03 BARO:
ts_us:u64, press_hpa:f32, temp_c:f32, alt_m:f32, status:u8, reserved[3]:u8

0x04 AHRS:
ts_us:u64, q[4]:f32, roll:f32, pitch:f32, yaw:f32,
gyro_bias[3]:f32, align:u8, flags:u8, zb_ds:u16

0x05 PPS:
ts_us:u64, edges:u32, captures:u32, err_ppb:i32, state:u8, align:u8, age_ms:u16

0x10 STAT:
imu_id:u8, dry_timeout:u8, dry_pin:u8, isr_cpu_pct:u8,
dry:u32, out:u32, crc_err:u32, frame_err:u32, spi_timeout:u32,
dropped:u32, dcnt_skip:u32, dry_kicks:u32, resync:u32,
isr_us_max:u16, isr_us_last:u16

0x11 FUS:
outputs:u32, rej[3]:u32, incomplete:u32, degraded:u32,
gyro_thresh:f32, acc_thresh:f32

0x12 SYS:
uart_drop:u32, loops_per_s:u32, uart_resets:u32, pps_cnt:u32,
baro_samples:u32, baro_i2c_err:u32, baro_timeouts:u32,
rate_hz:u16, isr_cpu_total_pct:u8, out_mode:u8, baro_stale:u8,
baro_hz:u8, proto_mode:u8, pps_state:u8, u2_drop:u32, trig_cnt:u32, trig_rej:u32
  • AHRS binary 先四元數、再歐拉角,與 ASCII 順序不同。zb_ds 單位 0.1 s;ASCII zb_s 則為 s。
  • PPS binary 為 err_ppb,ASCII 為 err_ppm,正值表示本地時鐘較快。
  • used_mask 的 bit n 表示 IMU n+1 被採用。SYS out_mode:0 none/1 raw/2 fused/3 both;proto_mode:0 ascii/1 binary。解析 SYS 時,請用 len 判斷資料長度:本版為 48 bytes,fw 0.8.0 為 40 bytes,更早版本為 36 bytes。

頻寬規劃

8N1 每個位元組需 10 bit,因此 460800 bps 約可傳 46 kB/s。下列為原手冊 binary 估算,實際設定時,還要留出傳送指令回覆與統計資料所需的頻寬;ASCII 通常約需兩倍頻寬。

設定 概算流量 頻寬需求
50 Hz both + AHRS + BARO 19 kB/s 460800
100 Hz both + AHRS + BARO 37 kB/s 460800
200 Hz fused + AHRS 27 kB/s 460800
400 Hz fused + AHRS 54 kB/s 921600
500 Hz fused + AHRS 67 kB/s 921600
1000 Hz 單顆 RAW(計算基準) 75 kB/s 921600
1000 Hz fused + AHRS 134 kB/s 1500000 / 2000000

raw 實際會送三顆 IMU,不是只送一顆:1000 Hz 時約 225 kB/s,超過 2000000 bps 的約 200 kB/s 上限。請改 fused 或降低 RATE。UART 緩衝滿時整行/整幀丟棄,觀察 uart_drop/u2_drop;這不等於 SPI 也掉資料。

Payload 位元組偏移表

下表的 offset 從 payload 的第 0 byte 開始計算,不包含前方 5 bytes 的 sync/id/len/seq。完整 UART 封包長度=payload + 7。SPI 的偏移量是從整包開頭計算,請勿混用兩張表。

0x01 IMU_RAW · 68 / 75 bytes

Offset 欄位 Type
0 imu_id u8
1 status u8
2 n u16
4 ts_us u64
12 gyro[3] f32 ×3
24 acc[3] f32 ×3
36 temp f32
40 dth[3] f32 ×3
52 dv[3] f32 ×3
64 dt f32

0x02 IMU · 68 / 75 bytes

Offset 欄位 Type
0 ts_us u64
8 gyro[3] f32 ×3
20 acc[3] f32 ×3
32 temp f32
36 dth[3] f32 ×3
48 dv[3] f32 ×3
60 dt f32
64 n_used u8
65 flags u8
66 used_mask u8
67 reserved u8

0x03 BARO · 24 / 31 bytes

Offset 欄位 Type
0 ts_us u64
8 press_hpa f32
12 temp_c f32
16 alt_m f32
20 status u8
21 reserved[3] u8 ×3

0x04 AHRS · 52 / 59 bytes

Offset 欄位 Type
0 ts_us u64
8 q[4] f32 ×4
24 roll / pitch / yaw f32 ×3
36 gyro_bias[3] f32 ×3
48 align u8
49 flags u8
50 zb_ds u16

0x05 PPS · 24 / 31 bytes

Offset 欄位 Type
0 ts_us u64
8 edges u32
12 captures u32
16 err_ppb i32
20 state u8
21 align u8
22 age_ms u16

0x10 STAT · 44 / 51 bytes

Offset 欄位 Type
0 imu_id u8
1 dry_timeout u8
2 dry_pin u8
3 isr_cpu_pct u8
4 dry u32
8 out u32
12 crc_err u32
16 frame_err u32
20 spi_timeout u32
24 dropped u32
28 dcnt_skip u32
32 dry_kicks u32
36 resync u32
40 isr_us_max u16
42 isr_us_last u16

0x11 FUS · 32 / 39 bytes

Offset 欄位 Type
0 outputs u32
4 rej[3] u32 ×3
16 incomplete u32
20 degraded u32
24 gyro_thresh f32
28 acc_thresh f32

0x12 SYS · 48 / 55 bytes

Offset 欄位 Type
0 uart_drop u32
4 loops_per_s u32
8 uart_resets u32
12 pps_cnt u32
16 baro_samples u32
20 baro_i2c_err u32
24 baro_timeouts u32
28 rate_hz u16
30 isr_cpu_total_pct u8
31 out_mode u8
32 baro_stale u8
33 baro_hz u8
34 proto_mode u8
35 pps_state u8
36 u2_drop u32
40 trig_cnt u32
44 trig_rej u32

標題的兩個長度依序為 payload/完整幀。讀取舊版 36/40 bytes 的 SYS 時,只解析該版本實際提供的欄位;STAT 的 read_retry/read_bad 僅在 ASCII 提供。PPS age_ms 最大 65535;align=1 表示輸出邊界已對齊 PPS。AHRS zb_ds 為 0.1 s,fw 0.9.2 前固定 0。

0x7F TEXT 的 payload 是完整 ASCII body,不含 $、*XX、CRLF,例如 SPNVACK,RATE,100;最長完整幀為 262 bytes。一般 ACK/NAK 與 BOOT/RESET/DBG/AUTH/INIT/HB/STALL/TRAP 等文字訊息均可經此類型傳送。

本章通訊細節另依通訊協定 v1.1,第 21–26 頁整理;通訊協定總覽。


原始文件:IMU600-V2 User Manual v1.1 · PDF 頁 25–28

原文件逐頁閱讀 · 三份文件逐章對照與差異說明

回到本分類總覽 · 全部設定指南