Updated for pull request for PID and accelerometer changes