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); } }