Trajectory Planning and Control of Cooperative Robotic System for Automated Fiber Placement