[urdf2dh] added check that the generated DH chain is consistent