src/crc.c

   1 /*
   2  * This file is part of the libsigrok project.
   3  *
   4  * Copyright (C) 2015 Aurelien Jacobs <aurel@gnuage.org>
   5  *
   6  * This program is free software: you can redistribute it and/or modify
   7  * it under the terms of the GNU General Public License as published by
   8  * the Free Software Foundation, either version 3 of the License, or
   9  * (at your option) any later version.
  10  *
  11  * This program is distributed in the hope that it will be useful,
  12  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  13  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  14  * GNU General Public License for more details.
  15  *
  16  * You should have received a copy of the GNU General Public License
  17  * along with this program.  If not, see <http://www.gnu.org/licenses/>.
  18  */
  19
  20 #include <config.h>
  21 #include <stdint.h>
  22 #include <libsigrok/libsigrok.h>
  23 #include "libsigrok-internal.h"
  24
  25 SR_PRIV uint16_t sr_crc16(uint16_t crc, const uint8_t *buffer, int len)
  26 {
  27         int i;
  28
  29         if (!buffer || len < 0)
  30                 return crc;
  31
  32         while (len--) {
  33                 crc ^= *buffer++;
  34                 for (i = 0; i < 8; i++) {
  35                         int carry = crc & 1;
  36                         crc >>= 1;
  37                         if (carry)
  38                                 crc ^= 0xA001;
  39                 }
  40         }
  41
  42         return crc;
  43 }