Update MASTER_v2

Changed PID code. "Output PID" Functionality still not present since this commit and the last commit.