Unit test added

Tested and working