Yea, I saw the filter you added. There is a problem if the filter threshold value is high because it will ignore regular low value which is not noise too. The noise can go up to 0.045. Hmm, might be my PID is not tuned well. I had my PID tuned to let speed reduce slowly. So when it reaches the goal, the last few seconds, it turns very slow and the gyroscope reading is below 0.03.