Working

First test with simple grid pattern is working. I need to still record
distance traveled.