A lazy algorithm for planning motions in contact | IEEE Conference Publication | IEEE Xplore