Add some math and unit test framework