working
test_obj_slide working
various
various
trying linearizing scene wrt joints
linearization seems okay except for angles
optimizing dont push (with only initial constraints) works, slow