Motion planning for redundant manipulators and other high degree-of-freedom systems