Fix payload size calc when size > 125

When the payload length is > 125, then the previous payload length should be discarded, and the next 16 bits used instead. In the current code, the previous payload length is being combined while the 16 bytes, resulting in an incorrect value.