Added variables to PID and connections to gyro update
Added new global variables and functions to the PID controller which is supposed to sync with the main program
Added pid controller functions and low pass filter functions