some code improovement in sub handle_i2c_reply
Merge pull request #2 from ValdasRK/patch-2

some code improovement in sub handle_i2c_reply