Autonomous completed

Added encoder functions; not yet tested
Cleaned up file structure

Combined all test programs into one directory