Resolved timing problem on solver-kine. Now working on second order