Revert "Merge pull request #707 from WildernessLabs/vlx53_update"

This reverts commit d21154b, reversing changes made to df16769.
WildernessLabs · Jul 25, 2023 · c48821d · c48821d
1 parent 288c508
commit c48821d
Showing 1 changed file with 8 additions and 1 deletion.
diff --git a/Source/Meadow.Foundation.Peripherals/Sensors.Distance.Vl53l0x/Driver/Vl53l0x.cs b/Source/Meadow.Foundation.Peripherals/Sensors.Distance.Vl53l0x/Driver/Vl53l0x.cs
@@ -396,6 +396,13 @@ byte Read(byte address)
             return result;
         }
 
+        int Read16(byte address)
+        {
+            //var result = BusComms.ReadRegisters(address, 2);
+            BusComms.ReadRegister(address, ReadBuffer.Span[0..2]);
+            return (ReadBuffer.Span[0] << 8) | ReadBuffer.Span[1];
+        }
+
         async Task<int> GetRawRangeData()
         {
             BusComms.WriteRegister(0x80, 0x01);
@@ -431,7 +438,7 @@ async Task<int> GetRawRangeData()
                 }
             }
 
-            var range_mm = BusComms.ReadRegisterAsUShort((byte)Register.ResultRangeStatus + 10);
+            var range_mm = Read16((byte)Register.ResultRangeStatus + 10);
             BusComms.WriteRegister((byte)Register.GpioHvMuxActiveHigh, 0x01);
 
             return range_mm;