Program structured and PID implemented

PID not working!