Enabled 7th dof, worked on caching ik results