Changed PID angle tolerance to 0.02