mc_pos_control: improved smooth takeoff and used it for manual takeoff as well

adresses:
there were setpoint twitches at the beginning and end of my smooth takeoff routine
it was to slow and not configurable
it was only available for automatic takeoff