Basic setup of flarb_motorcontrol, needs PID and some extra parameters