Cleanded up TestMath and added print statements to aid with debugging