more prototyping

added encoder, sonar sensor code
clean up too
added draft autonomous