Add basic unit test for correctness