[Alan Anderson]

(One bit of general advice: avoid using printf() in the "fast" section. It's too easy to get characters trying to go out faster than the serial port can handle them.)

You say it doesn't work, but we don't really know what "it" or "work" mean to you. What do you expect to happen, and what is happening instead?