No need for the raytrace function.
General cleanup of code of collision_util.