Removed data[0] being overwritten
Merge pull request #29 from xross/master

removed data[0] being overwritten in read_reg