Program working, timer working. Needed to rework the PDControl
because get_ms() was not returning the right thing, and switching
to my own getMSec() made results different.
Ready to hand this in.