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
原文件逐頁閱讀 · 三份文件逐章對照與差異說明
回到本分類總覽 · 全部設定指南