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<()>