added final code and re-organised test folder
updated README
fixed data[] serial tx/rx