2D navigation with orientation

Solves #13