Cleaned up some data structures, now the instead of two huge structures (one for the floor and one for the point cloud), we only have one. The point cloud points tell us if we're on the floor.