2D navigation with orientation

2D map navigation with orientation. Solves Issue #13.