public bool ReadHiTechnicCompassSensor( NXTBrick.Sensor sensor, ref int angle )
{
byte[] command = { 0x02, 0x42 };
byte[] readBuffer = new byte[2];
int bytesReady;
int bytesRead;
LsWrite( sensor, command, readBuffer.Length );
LsGetStatus( sensor, out bytesReady );
LsRead( sensor, readBuffer, out bytesRead );
if ( bytesRead == readBuffer.Length )
{
angle = ( readBuffer[0] * 2 ) + readBuffer[1];
return true;
}
return false;
}