Blackwhitebear8/grovepi
1
0
Fork 0
Code Issues Pull requests Projects Releases Packages Wiki Activity Actions

first commit

Browse source
This commit is contained in:
pandacraft 2025-03-21 16:04:17 +01:00
commit a5a0434432
1126 changed files with 439481 additions and 0 deletions
Download patch file Download diff file Expand all files Collapse all files

41
Software/CSharp/GrovePi/Sensors/AccelerometerSensor.cs Normal file
View file

@ -0,0 +1,41 @@
using System;
namespace GrovePi.Sensors
{
public interface IAccelerometerSensor
{
byte[] Read();
}
internal class AccelerometerSensor : IAccelerometerSensor
{
private const byte CommandAddress = 20;
private readonly GrovePi _device;
private readonly Pin _pin;
internal AccelerometerSensor(GrovePi device, Pin pin)
{
if (device == null) throw new ArgumentNullException(nameof(device));
_device = device;
_pin = pin;
}
public byte[] Read()
{
var buffer = new [] {CommandAddress, (byte) _pin, Constants.Unused, Constants.Unused};
_device.DirectAccess.Write(buffer);
var readBuffer = new byte[1];
_device.DirectAccess.Read(readBuffer);
if (readBuffer[1] > 32)
readBuffer[1] = (byte) -(readBuffer[1] - 224);
if (readBuffer[2] > 32)
readBuffer[2] = (byte) -(readBuffer[1] - 224);
if (readBuffer[3] > 32)
readBuffer[3] = (byte) -(readBuffer[1] - 224);
return readBuffer;
}
}
}