now have a working 3 joints in 3D. the 3rd dimension is 0. I dont know how to compute jacobian in 3D