Basic turtle logic added. 2D fwd and turning done