Adaptive trajectory planning as function of force on end effector, bucket