Oops didn't actually set that up correctly. Fixed now.
Softned the nullspace projection earlier in the motion (away from the goal) to give the default configuration higher priority. Added flags for manually setting the default configuration.