Rapid maneuvering of multi-body dynamic systems with optimal motion compensation. (December 2015)