Looks that this fix the issue #25. msg was int16_t instead of uint16_t