added pid and pid test for collector
adding console output
formatting
added teleop controls for collector pid
merge
fixing drive code and removing catapolt code
adjusting test functions and cleaning code
adding pit fixes