Added our autonomous file, still need to hardcode
Too many uncommitted changes, but we added a lot of stuff
Cleanup
Added servo controls, changed up autonomous a bit

Finished hard coding function library