Update pll.c

from SC-02B kernel (same philosophy)