Contact motion planning including force direction with relaxing impact | IEEE Conference Publication | IEEE Xplore