Simple autonomous to drive to blocks

starts on right wall, turns and drives towards blocks.