Guided locomotion in 3D for snake robots based on contact force optimization | IEEE Conference Publication | IEEE Xplore