rust-protocol: Implement encoding report packets.

common/rust-protocol/src/lib.rs

@@ -68,16 +68,16 @@ impl Packet {
                 true
             }
             Self::Report(report) => {
-                // TODO
-                false
+                data[0] = (report.count << 5) | 2;
+                report.encode(&mut data[1..])
             }
             Self::GetValues(get_values) => {
-                // TODO
-                false
+                data[0] = (get_values.count << 5) | 2;
+                get_values.encode(&mut data[1..])
             }
             Self::Values(values) => {
-                // TODO
-                false
+                data[0] = (values.count << 5) | 2;
+                values.encode(&mut data[1..])
             }
         }
     }
@@ -100,6 +100,20 @@ impl Report {
         }
         Some(report)
     }
+
+    fn encode(&self, mut data: &mut [u8]) -> bool {
+        for i in 0..self.count {
+            let value_len = self.values[i as usize].encoded_length();
+            if data.len() < value_len {
+                return false;
+            }
+            if !self.values[i as usize].encode(data) {
+                return false;
+            }
+            data = &mut data[value_len..];
+        }
+        false
+    }
 }
 
 #[derive(Debug, Clone)]
@@ -114,6 +128,11 @@ impl GetValues {
         // TODO
         None
     }
+
+    fn encode(&self, mut _data: &[u8]) -> bool {
+        // TODO
+        false
+    }
 }
 
 #[derive(Debug, Clone)]
@@ -128,6 +147,11 @@ impl Values {
         // TODO
         None
     }
+
+    fn encode(&self, mut _data: &[u8]) -> bool {
+        // TODO
+        false
+    }
 }
 
 #[derive(Debug, Clone, Copy)]
@@ -171,6 +195,39 @@ impl Value {
         *data = &data[length..];
         Some(result)
     }
+
+    fn encode(&self, data: &mut [u8]) -> bool {
+        match self {
+            Self::Invalid => {}
+            Self::Time(time) => {
+                data[0] = 0;
+                data[1..9].copy_from_slice(&time.to_le_bytes());
+            }
+            Self::Temperature(temperature) => {
+                data[0] = 1;
+                data[1..3].copy_from_slice(&temperature.to_le_bytes());
+            }
+            Self::Pressure(pressure) => {
+                data[0] = 2;
+                data[1..5].copy_from_slice(&pressure.to_le_bytes());
+            }
+            Self::Humidity(humidity) => {
+                data[0] = 3;
+                data[1..3].copy_from_slice(&humidity.to_le_bytes());
+            }
+        };
+        true
+    }
+
+    fn encoded_length(&self) -> usize {
+        match self {
+            Self::Invalid => 0,
+            Self::Time(_) => 9,
+            Self::Temperature(_) => 3,
+            Self::Pressure(_) => 5,
+            Self::Humidity(_) => 3,
+        }
+    }
 }
 
 #[derive(Debug, Clone, Copy)]