Added more code on Arduino code
Merge branch 'master' of https://github.com/hhuynhlam/tessa