[DISP] Works on raspi this way

src/platform/display.rs

@@ -96,18 +96,21 @@ impl Display {
         }
     }
 
+    #[inline]
+    fn color_component(&self, chan: u16) -> u32 {
+        u32::from(if self.order == PixelOrder::BGR {
+            2 - chan
+        } else {
+            chan
+        })
+    }
+
     pub fn putpixel(&mut self, x: u16, y: u16, color: u32) {
-        let c = |chan: u16| {
+        let f = |mut v: u32, chan: u16| unsafe {
-            if self.order == PixelOrder::BGR {
+            *(self.base as *mut u8)
-                2 - chan
+                .offset((u32::from(y) * self.pitch
-            } else {
+                    + u32::from(x) * 4//(self.depth / 8)
-                chan
+                    + self.color_component(chan)) as isize) = v as u8;
-            }
-        };
-        let f = |v: u32, chan: u16| unsafe {
-            *(self.base as *mut u8).offset(
-                (y as u32 * self.pitch + x as u32 * (self.depth / 8) + c(chan) as u32) as isize,
-            ) = v as u8;
         };
 
         f(color & 0xff, 0);