Renamed Util::min/max as Util::umin/umax and changed matrices in Robot/ObjModel to non-pointers