From be8bf0a8b6f1db49900974637d6c1e0d417800e8 Mon Sep 17 00:00:00 2001
From: linuswck <linuswck@m-labs.hk>
Date: Tue, 9 Jan 2024 16:13:42 +0800
Subject: [PATCH] ld_drive: add setup fn

---
 src/laser_diode/ld_drive.rs | 6 ++++++
 1 file changed, 6 insertions(+)

diff --git a/src/laser_diode/ld_drive.rs b/src/laser_diode/ld_drive.rs
index 9ba532b..d472344 100644
--- a/src/laser_diode/ld_drive.rs
+++ b/src/laser_diode/ld_drive.rs
@@ -71,6 +71,12 @@ impl LD_Drive{
         }
     }
 
+    pub fn setup(&mut self) {
+        self.power_down();
+        self.ld_set_i(ElectricCurrent::new::<milliampere>(0.0));
+        self.ld_short();
+    }
+
     pub fn power_up(&mut self){
         self.ctrl.power_up();
     }