Adaptive Motion Planning for Multi-fingered Functional Grasp via Force Feedback