Add unit test for math package

Signed-off-by: Kare Nuorteva <kare.nuorteva@me.com>