Updated from mapping

Almost all cubes located, began orientation
Mapping function