MAPPING UPDATE

Cleaned up the segmentation to save more info. Also did a whole heap on
trying to find camera position and coin position.
What's left: Find the coin position when we can see the caltag.