I cant see that you are feeding your PID Output to the motor. Cant see that you are using PID Output at all.
/T