Add UTs

Add unit tests