fix SensorDataIter

increase internal position at end of next function

l0dable/src/bhi160.rs

@@ -136,8 +136,6 @@ impl<'a, S: SensorType> Iterator for SensorDataIter<'a, S> {
 
     fn next(&mut self) -> Option<Self::Item> {
         while self.pos < self.data.n {
-            self.pos += 1;
-
             let vec = &self.data.buf[self.pos];
             if vec.data_type != DATA_TYPE_VECTOR {
                 writeln!(crate::UART, "Sensor: skip type {}\r", vec.data_type).ok();
@@ -151,6 +149,8 @@ impl<'a, S: SensorType> Iterator for SensorDataIter<'a, S> {
                 status: vec.status,
             };
 
+            self.pos += 1;
+
             return Some(item);
         }