Change int16_t to uint16_t