Added util.py back
Updated URDF export to handle multiple collisions and better mirroring
Added updated robot model and floor color