Calculating optimal trajectories from contact transitions | IEEE Conference Publication | IEEE Xplore