Loco-manipulation with non-impulsive contact-implicit planning in a slithering robot