Cleaned up vetex logging and added frame reorientation to match URDF