added invert axis flag to SimJoint
some bugfixes in urdf loader