Trying to test using only constraint freedoms; not working yet
removed accidentally copied line
new robot model