Clear Workspace, add Testcase in main.c, change readme