Write test harness for math functions

There should be a program that runs unit tests on all the math functions.

This will be helpful for fixing the remaining bugs in the math library, and allow us to quickly test any optimizations that we can try.