Add test & tidy up