pub fn normal_phase(
    msg_id: u8,
    drive: &[Phase],
    tx: &mut TxDatagram
) -> Result<()>