some small bug fixes, added 2d coordinate conversion to robot, centeralized the shapely dependencies to the geometry classes