Fix COM jacobian