Support NVM hard resetting

conUDS/src/arguments.rs

@@ -30,6 +30,7 @@ pub enum ArgSubCommands {
     Reset(SubArgReset),
     BootloaderDownload(SubArgBootloaderDownload),
     ReadDID(SubArgReadDID),
+    NVMHardReset(SubArgNVMHardReset),
 }
 
 /// Download an application to an ECU
@@ -66,3 +67,9 @@ pub struct SubArgReadDID {
     #[argh(positional)]
     pub id: String,
 }
+
+/// Hard reset entire NVM including internal values
+#[derive(Debug, FromArgs)]
+#[argh(subcommand, name = "nvmHardReset")]
+pub struct SubArgNVMHardReset {
+}

conUDS/src/main.rs

@@ -144,13 +144,24 @@ async fn main() -> Result<()> {
             }
         }
         ArgSubCommands::ReadDID(did) => {
-            debug!(
-                "Performing DID read on {:#?} for node `{}`",
-                did, args.node
-            );
+            info!("Performing DID read on id {:#?} for node `{}`", did.id, args.node);
             let id = u16::from_str_radix(&did.id, 16).unwrap();
             let _ = uds_client.did_read(id).await;
         }
+        ArgSubCommands::NVMHardReset(_) => {
+            info!(
+                "Performing NVM hard reset for node `{}`",
+                args.node
+            );
+            if let Err(e) = uds_client.routine_start(0xf0f0, None).await {
+                error!("While downloading app: {}", e);
+            }
+            else {
+                let result = uds_client.routine_get_results(0xf0f0).await;
+                /// TODO: Implement error checking
+                info!("Successful NVM erase");
+            }
+        }
     }
 
     app.lock().unwrap().exit = true;

conUDS/src/modules/uds.rs

@@ -131,7 +131,7 @@ impl UdsClient {
             .await?
             .await
         {
-            Ok(resp) => debug!("Start routine response: {:02x?}", resp),
+            Ok(resp) => info!("Start routine response: {:02x?}", resp),
             Err(e) => {
                 error!("When waiting for response from ECU: {}", e);
                 return Err(e.into());