Adding test harness and some preliminary tests