small changes

+added initial PID stuff
+added autonomous code
inverted ch2 for the lift speed