New/simpler motor and servo control