implement configuring transceiver delay compensation

stm32-rs · Jan 24, 2025 · 78df8a1 · 78df8a1
1 parent 2169741
commit 78df8a1
Show file tree

Hide file tree

Showing 2 changed files with 10 additions and 6 deletions.
diff --git a/src/config.rs b/src/config.rs
@@ -76,12 +76,10 @@ pub struct DataBitTiming {
     pub sync_jump_width: NonZeroU8,
 }
 impl DataBitTiming {
-    // #[inline]
-    // fn tdc(&self) -> u8 {
-    //     let tsd = self.transceiver_delay_compensation as u8;
-    //     //TODO: stm32g4 does not export the TDC field
-    //     todo!()
-    // }
+    #[inline]
+    pub(crate) fn tdc(&self) -> bool {
+        self.transceiver_delay_compensation
+    }
     #[inline]
     pub(crate) fn dbrp(&self) -> u8 {
         u8::from(self.prescaler) & 0x1F

diff --git a/src/lib.rs b/src/lib.rs
@@ -735,6 +735,10 @@ where
         self.control.config.dbtr = btr;
 
         let can = self.registers();
+        if btr.tdc() {
+            let tcdo = btr.dtseg1() * btr.dbrp();
+            can.tdcr.write(|w| unsafe { w.tdco().bits(tcdo) });
+        }
         can.dbtp.write(|w| unsafe {
             w.dbrp()
                 .bits(btr.dbrp() - 1)
@@ -744,6 +748,8 @@ where
                 .bits(btr.dtseg2() - 1)
                 .dsjw()
                 .bits(btr.dsjw() - 1)
+                .tdc()
+                .bit(btr.tdc())
         });
     }