69 lines
1.5 KiB
C
69 lines
1.5 KiB
C
/*
|
|
This file is part of libcapwap.
|
|
|
|
libcapwap is free software: you can redistribute it and/or modify
|
|
it under the terms of the GNU General Public License as published by
|
|
the Free Software Foundation, either version 3 of the License, or
|
|
(at your option) any later version.
|
|
|
|
libcapwap is distributed in the hope that it will be useful,
|
|
but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
GNU General Public License for more details.
|
|
|
|
You should have received a copy of the GNU General Public License
|
|
along with Foobar. If not, see <http://www.gnu.org/licenses/>.
|
|
|
|
*/
|
|
|
|
#include "lwapp.h"
|
|
|
|
/**
|
|
* Calculate the 16-bit checksum for LWAPP image data message
|
|
* elements with opcode 3 - used by Cisco also in CAPWAP
|
|
* (But it's not always correct, the real algo might be another)
|
|
*/
|
|
uint16_t lw1_checksum(uint8_t * d, int len)
|
|
{
|
|
int i;
|
|
// uint32_t cs = 0xffff;
|
|
if (len == 0)
|
|
return 0xffff;
|
|
|
|
uint32_t cs = 0;
|
|
for (i = 0; i < len; i += 2) {
|
|
uint16_t w = d[i] << 8;
|
|
|
|
if (i + 1 < len)
|
|
w |= d[i + 1];
|
|
|
|
cs += w ^= 0xffff;
|
|
cs += cs >> 16;
|
|
cs &= 0xffff;
|
|
}
|
|
return (uint16_t) cs & 0xffff;
|
|
}
|
|
|
|
|
|
uint16_t lw_checksum(uint8_t * d, int len)
|
|
{
|
|
int i;
|
|
// uint32_t cs = 0xffff;
|
|
if (len == 0)
|
|
return 0xffff;
|
|
|
|
uint32_t cs = 0x0;
|
|
for (i = 0; i < len; i += 2) {
|
|
cs += (cs >> 16);
|
|
cs &= 0xffff;
|
|
uint16_t w = d[i] << 8;
|
|
|
|
if (i + 1 < len)
|
|
w |= d[i + 1];
|
|
|
|
cs += w ^= 0xffff;
|
|
}
|
|
cs += (cs >> 16);
|
|
return (uint16_t) cs & 0xffff;
|
|
}
|