Fixed ordering of joints in URDF vs hubo.h in the header file.