Added PID and bang bang calculations, some user input functions

-Not fully implementing driver calls yet
-Doesn't update LCD
Merge branch 'master' of https://github.com/rhodeser/cockroach-sunset