diff --git a/converter/src/main.rs b/converter/src/main.rs index 6067cd2..6eb7162 100644 --- a/converter/src/main.rs +++ b/converter/src/main.rs @@ -32,7 +32,10 @@ fn main() { loop { let command = command.lock().unwrap().clone(); let encoded: Vec = to_vec_cobs(&command).unwrap(); - port.write(&encoded).expect("port write fail"); + if port.write(&encoded).is_err() { + println!("disconnected from robot"); + return; + }; sleep(Duration::from_millis(200)); } @@ -94,7 +97,7 @@ fn handle_connection(command: Arc>, telemetry: Arc