finished PID
added index if limit switch is pushed
Merge in preparation for push.