Have doubts about the jacobian. Gonna try in simulation first