public int getAngle()
{
angleSensor aSensor = (angleSensor)this.sensors.getSensor(20);
byte[] angle = aSensor.getValue(false);
return(BitConverter.ToInt16(angle, 0));
}
private void motorThreadFunc()
{
while (true)
{
if (this.drivingState.isDriving)
{
distanceSensor dSensor = (distanceSensor)this.sensors.getSensor(19);
dSensor.setValue(this.drivingState.leftSpeed, this.drivingState.rightSpeed);
angleSensor aSensor = (angleSensor)this.sensors.getSensor(20);
aSensor.setValue(dSensor.getLeft(), dSensor.getRight());
}
Thread.Sleep(1000);
}
}
