ellipse is off. work needs to be done to fix it. the only reasonable solution is to replace ik_env integration with pinocchio in ik_env, as that needs to go anyway. move on from that code, it gave you everything that could. this is some work though, and i don't have the time for it, so we're stopping here with this'