Simple Program for PID testing