Optimal Trajectory Planning and Feedback Control of Lateral Undulation in Snake-Like Robots | IEEE Conference Publication | IEEE Xplore