Fix payload size calc when size > 125
Merge pull request #11 from mrdooz/master

Fix payload size calc when size > 125