static int packet_parse(const uint8_t *buf, int idx, struct center_info *info)
{
int i;
- uint16_t temp_u16;
+ int16_t temp_i16;
log_packet(buf, idx);
/* Byte 7+8/9+10/11+12/13+14: channel T1/T2/T3/T4 temperature. */
for (i = 0; i < NUM_CHANNELS; i++) {
- temp_u16 = buf[8 + (i * 2)];
- temp_u16 |= ((uint16_t)buf[7 + (i * 2)] << 8);
- info->temp[i] = (float)temp_u16;
+ temp_i16 = RB16S(&buf[7 + 2 * i]);
+ info->temp[i] = (float)temp_i16;
}
/* Byte 43: Specifies whether we need to divide the value(s) by 10. */
{
struct dev_context *devc;
struct sr_serial_dev_inst *serial;
- int len, i, offset = 0, ret = FALSE;
+ int len, offset, ret = FALSE;
devc = sdi->priv;
serial = sdi->conn;
devc->buflen += len;
/* Now look for packets in that data. */
+ offset = 0;
while ((devc->buflen - offset) >= center_devs[idx].packet_size) {
if (center_devs[idx].packet_valid(devc->buf + offset)) {
handle_packet(devc->buf + offset, sdi, idx);
}
/* If we have any data left, move it to the beginning of our buffer. */
- for (i = 0; i < devc->buflen - offset; i++)
- devc->buf[i] = devc->buf[offset + i];
+ if (offset < devc->buflen)
+ memmove(devc->buf, devc->buf + offset, devc->buflen - offset);
devc->buflen -= offset;
return ret;