Fixed math functions. Added console print w/ number support.
Various code fixes too. Scratched UART.cpp, now working on IRQ handlers.