Added structure for rostest. Library tests could be added to .test file