blob: 791fa5137dbab619344542031a2c96c8d3f182b2 [file] [log] [blame]
/*
*
* BlueZ - Bluetooth protocol stack for Linux
*
* Copyright (C) 2011 Intel Corporation
*
*
* This program 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 2 of the License, or
* (at your option) any later version.
*
* This program 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 this program; if not, write to the Free Software
* Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
*
*/
#ifdef HAVE_CONFIG_H
#include <config.h>
#endif
#include "monitor/crc.h"
#include "src/shared/tester.h"
#include <glib.h>
struct crc_data {
const void *packet;
size_t size;
uint32_t crc_init;
};
static const unsigned char packet_1[] = {
0xd6, 0xbe, 0x89, 0x8e, 0x00, 0x17, 0x7e, 0x01,
0x00, 0xd0, 0x22, 0x00, 0x02, 0x01, 0x06, 0x03,
0x02, 0x0d, 0x18, 0x06, 0xff, 0x6b, 0x00, 0x03,
0x16, 0x52, 0x02, 0x0a, 0x00, 0xf4, 0x09, 0x92,
};
static const struct crc_data crc_1 = {
.packet = packet_1,
.size = sizeof(packet_1),
};
static const unsigned char packet_2[] = {
0xd6, 0xbe, 0x89, 0x8e, 0x00, 0x17, 0x7e, 0x01,
0x00, 0xd0, 0x22, 0x00, 0x02, 0x01, 0x06, 0x03,
0x02, 0x0d, 0x18, 0x06, 0xff, 0x6b, 0x00, 0x03,
0x16, 0x54, 0x02, 0x0a, 0x00, 0x95, 0x5f, 0x14,
};
static const struct crc_data crc_2 = {
.packet = packet_2,
.size = sizeof(packet_2),
};
static const unsigned char packet_3[] = {
0xd6, 0xbe, 0x89, 0x8e, 0x00, 0x17, 0x7e, 0x01,
0x00, 0xd0, 0x22, 0x00, 0x02, 0x01, 0x06, 0x03,
0x02, 0x0d, 0x18, 0x06, 0xff, 0x6b, 0x00, 0x03,
0x16, 0x55, 0x02, 0x0a, 0x00, 0x85, 0x66, 0x63,
};
static const struct crc_data crc_3 = {
.packet = packet_3,
.size = sizeof(packet_3),
};
static const unsigned char packet_4[] = {
0xd6, 0xbe, 0x89, 0x8e, 0x00, 0x17, 0x7e, 0x01,
0x00, 0xd0, 0x22, 0x00, 0x02, 0x01, 0x06, 0x03,
0x02, 0x0d, 0x18, 0x06, 0xff, 0x6b, 0x00, 0x03,
0x16, 0x53, 0x02, 0x0a, 0x00, 0xe4, 0x30, 0xe5,
};
static const struct crc_data crc_4 = {
.packet = packet_4,
.size = sizeof(packet_4),
};
static const unsigned char packet_5[] = {
0xd6, 0xbe, 0x89, 0x8e, 0x03, 0x0c, 0x46, 0x1c,
0xda, 0x72, 0x02, 0x00, 0x7e, 0x01, 0x00, 0xd0,
0x22, 0x00, 0x6e, 0xf4, 0x6f,
};
static const struct crc_data crc_5 = {
.packet = packet_5,
.size = sizeof(packet_5),
};
static const unsigned char packet_6[] = {
0xd6, 0xbe, 0x89, 0x8e, 0x04, 0x17, 0x7e, 0x01,
0x00, 0xd0, 0x22, 0x00, 0x10, 0x09, 0x50, 0x6f,
0x6c, 0x61, 0x72, 0x20, 0x48, 0x37, 0x20, 0x30,
0x30, 0x30, 0x31, 0x37, 0x45, 0x0f, 0x8a, 0x65,
};
static const struct crc_data crc_6 = {
.packet = packet_6,
.size = sizeof(packet_6),
};
static const unsigned char packet_7[] = {
0xd6, 0xbe, 0x89, 0x8e, 0x05, 0x22, 0x46, 0x1c,
0xda, 0x72, 0x02, 0x00, 0x7e, 0x01, 0x00, 0xd0,
0x22, 0x00, 0x96, 0x83, 0x9a, 0xaf, 0xbe, 0x1d,
0x16, 0x03, 0x05, 0x00, 0x36, 0x00, 0x00, 0x00,
0x2a, 0x00, 0xff, 0xff, 0xff, 0xff, 0x1f, 0xa5,
0x77, 0x2d, 0x95,
};
static const struct crc_data crc_7 = {
.packet = packet_7,
.size = sizeof(packet_7),
};
static const unsigned char packet_8[] = {
0x96, 0x83, 0x9a, 0xaf, 0x01, 0x00, 0xc7, 0x15,
0x4d,
};
static const struct crc_data crc_8 = {
.packet = packet_8,
.size = sizeof(packet_8),
.crc_init = 0x161dbe, /* from packet_7 = 0xbe 0x1d 0x16 */
};
static const unsigned char packet_9[] = {
0x96, 0x83, 0x9a, 0xaf, 0x06, 0x14, 0x10, 0x00,
0x04, 0x00, 0x09, 0x07, 0x10, 0x00, 0x10, 0x11,
0x00, 0x37, 0x2a, 0x13, 0x00, 0x02, 0x14, 0x00,
0x38, 0x2a, 0x73, 0x2a, 0xa3,
};
static const struct crc_data crc_9 = {
.packet = packet_9,
.size = sizeof(packet_9),
.crc_init = 0x161dbe, /* from packet_7 = 0xbe 0x1d 0x16 */
};
static void test_crc(gconstpointer data)
{
const struct crc_data *test_data = data;
const uint8_t *buf = test_data->packet + test_data->size - 3;
uint32_t crc_init, crc_value, crc, rev;
if (test_data->crc_init)
crc_init = crc24_bit_reverse(test_data->crc_init);
else
crc_init = crc24_bit_reverse(0x555555);
crc_value = buf[0] | buf[1] << 8 | buf[2] << 16;
crc = crc24_calculate(crc_init, test_data->packet + 4,
test_data->size - 7);
tester_debug("CRC: 0x%6.6x, Calculated: 0x%6.6x", crc_value, crc);
g_assert(crc_value == crc);
rev = crc24_reverse(crc_value, test_data->packet + 4,
test_data->size - 7);
tester_debug("Preset: 0x%6.6x, Calculated: 0x%6.6x", crc_init, rev);
g_assert(crc_init == rev);
tester_test_passed();
}
int main(int argc, char *argv[])
{
tester_init(&argc, &argv);
tester_add("/crc/1", &crc_1, NULL, test_crc, NULL);
tester_add("/crc/2", &crc_2, NULL, test_crc, NULL);
tester_add("/crc/3", &crc_3, NULL, test_crc, NULL);
tester_add("/crc/4", &crc_4, NULL, test_crc, NULL);
tester_add("/crc/5", &crc_5, NULL, test_crc, NULL);
tester_add("/crc/6", &crc_6, NULL, test_crc, NULL);
tester_add("/crc/7", &crc_7, NULL, test_crc, NULL);
tester_add("/crc/8", &crc_8, NULL, test_crc, NULL);
tester_add("/crc/9", &crc_9, NULL, test_crc, NULL);
return tester_run();
}