Created data structure for controlling PID, now only need one type of PID function