Fix arduino code bugs