Title: A surface integral algorithm for the motion planning of nonholonomic mechanical systems