Trajectory Optimization for Robotic Suturing