period 2->1 sec; sampletime 0.25->0.2 sec; use MotorController convenience methods