pub fn point_stm_body( points: &[Vec<SeqFocus>], is_first_frame: bool, freq_div: u32, sound_speed: f64, is_last_frame: bool, tx: &mut TxDatagram) -> Result<()>