Working on PID and actually making progress