Reorder functions. Rename internal functions.
print out OSCCAL info (if UART debugging active)
rename function