ad7172: move setup from main

src/ad7172/adc.rs

@@ -19,22 +19,26 @@ pub struct Adc<SPI: Transfer<u8>, NSS: OutputPin> {
 }
 
 impl<SPI: Transfer<u8, Error = E>, NSS: OutputPin, E: fmt::Debug> Adc<SPI, NSS> {
-    pub fn new(spi: SPI, mut nss: NSS) -> Result<Self, SPI::Error> {
+    pub fn new(spi: SPI, mut nss: NSS) -> Result<Self, AdcError<SPI::Error>> {
         let _ = nss.set_high();
         let mut adc = Adc {
             spi, nss,
             checksum_mode: ChecksumMode::Off,
         };
         adc.reset()?;
+        adc.set_checksum_mode(ChecksumMode::Crc).unwrap();
 
-        match adc.identify() {
+        let mut retries = 0;
-            Err(e) =>
+        let mut adc_id;
-                warn!("Cannot identify ADC: {:?}", e),
+        loop {
-            Ok(id) if id & 0xFFF0 == 0x00D0 =>
+            adc_id = adc.identify()?;
-                info!("ADC id: {:04X}", id),
+            if adc_id & 0xFFF0 == 0x00D0 {
-            Ok(id) =>
+                break;
-                info!("ADC id: {:04X} (corrupt)", id),
+            } else {
+                retries += 1;
             }
+        }
+        info!("ADC id: {:04X} ({} retries)", adc_id, retries);
 
         Ok(adc)
     }

src/main.rs

@@ -92,11 +92,8 @@ fn main() -> ! {
 
     let pins = Pins::setup(clocks, dp.GPIOA, dp.GPIOB, dp.GPIOC, dp.GPIOG, dp.SPI2);
 
-    info!("ADC init");
     let mut adc = ad7172::Adc::new(pins.adc_spi, pins.adc_nss).unwrap();
-    adc.set_checksum_mode(ad7172::ChecksumMode::Crc).unwrap();
 
-    info!("Timer setup");
     timer::setup(cp.SYST, clocks);
 
     #[cfg(not(feature = "generate-hwaddr"))]
@@ -128,15 +125,20 @@ fn main() -> ! {
                     last_output = now;
                 }
 
+                if let Some(channel) = adc.data_ready().unwrap() {
+                    let data = adc.read_data().unwrap();
+                    info!("ADC {}: {:08X}", channel, data);
+                }
+
                 // Update watchdog
                 wd.feed();
 
-                cortex_m::interrupt::free(|cs| {
+                // cortex_m::interrupt::free(|cs| {
-                    if !net::is_pending(cs) {
+                //     if !net::is_pending(cs) {
-                        // Wait for interrupts
+                //         // Wait for interrupts
-                        wfi();
+                //         wfi();
-                    }
+                //     }
-                });
+                // });
             }
         });
     });