Tja da haben die euch einen orgendtlichen Brocken hingeworfen. Das mit den 2D Karte ham nämlich bisher die wenigstens hier hinbekommen.
Aber gehen wir mal davon aus, dass diese nicht 100% genau sein muss (was sie auch nie werden wird) dann kann man das Problem schon recht gut Lösen.

Schritt eins ist also einen geeigneten Roboter bauen (mechanisch) und dann die Software zu optimieren bis das gewünschte Ergebnis erziehlt wird.