Detecting frames in cuboid

Still WIP, can now find corners.