Add sonar readings to output tables
Call "stopMotor" instead of setSpeed(0)
Remove dup setting
Rename to be sensible
Call set() before stop() to ensure get() later returns 0