Optimal Trajectory Planning and Multimodal Force Control for Robotic Large Surface Rapid Grinding