Create Navigation Code

Combined encoder, door counting, and wall following code