/*
 * Copyright (C) 2015 Kaspar Schleiser <kaspar@schleiser.de>
 *               2019 Freie Universität Berlin
 *
 * This file is subject to the terms and conditions of the GNU Lesser
 * General Public License v2.1. See the file LICENSE in the top level
 * directory for more details.
 */

#include <stdint.h>
#include <string.h>

#include "embUnit.h"

#include "bitfield.h"

static void test_bf_set(void)
{
    BITFIELD(field, 32U);

    memset(field, 0x00, sizeof(field));
    bf_set(field, 3);
    /* bit idx:  3/8 +   01234567
     *      0x10    == 0b00010000 */
    TEST_ASSERT_EQUAL_INT(0x10, field[3 / 8]);
    bf_set(field, 1);
    /* bit idx:  1/8 +   01234567
     *      0x50    == 0b01010000 */
    TEST_ASSERT_EQUAL_INT(0x50, field[1 / 8]);
    bf_set(field, 25);
    /* bit idx: 25/8 +   01234567
     *      0x40    == 0b01000000 */
    TEST_ASSERT_EQUAL_INT(0x40, field[25 / 8]);
}

static void test_bf_unset(void)
{
    BITFIELD(field, 32U);

    memset(field, 0xff, sizeof(field));
    bf_unset(field, 5);
    /* bit idx:  5/8 +   01234567
     *      0xfb    == 0b11111011 */
    TEST_ASSERT_EQUAL_INT(0xfb, field[5 / 8]);
    bf_unset(field, 8);
    /* cppcheck-suppress duplicateExpression
     * reason: intentionally dividing 8 by itself to make test more readable
     * bit idx:  8/8 +   01234567
     *      0x7f    == 0b01111111 */
    TEST_ASSERT_EQUAL_INT(0x7f, field[8 / 8]);
    bf_unset(field, 10);
    /* bit idx: 10/8 +   01234567
     *      0x5f    == 0b01011111 */
    TEST_ASSERT_EQUAL_INT(0x5f, field[10 / 8]);
}

static void test_bf_toggle(void)
{
    BITFIELD(field, 32U);

    memset(field, 0xff, sizeof(field));
    bf_toggle(field, 7);
    /* bit idx:  7/8 +   01234567
     *      0xfe    == 0b11111110 */
    TEST_ASSERT_EQUAL_INT(0xfe, field[7 / 8]);
    bf_toggle(field, 0);
    /* bit idx:  0/8 +   01234567
     *      0x7e    == 0b01111110 */
    TEST_ASSERT_EQUAL_INT(0x7e, field[0 / 8]);
    bf_toggle(field, 7);
    /* bit idx:  7/8 +   01234567
     *      0x7f    == 0b01111111 */
    TEST_ASSERT_EQUAL_INT(0x7f, field[7 / 8]);
    bf_toggle(field, 0);
    /* bit idx:  0/8 +   01234567
     *      0xff    == 0b11111111 */
    TEST_ASSERT_EQUAL_INT(0xff, field[0 / 8]);
    bf_toggle(field, 28);
    /* bit idx: 28/8 +   01234567
     *      0xf7    == 0b11110111 */
    TEST_ASSERT_EQUAL_INT(0xf7, field[28 / 8]);
}

static void test_bf_isset(void)
{
    BITFIELD(field, 32U);

    /* bf_set / bf_unset tested above */
    memset(field, 0x00, sizeof(field));
    TEST_ASSERT(!bf_isset(field, 25));
    bf_set(field, 25);
    TEST_ASSERT(bf_isset(field, 25));
    bf_unset(field, 25);
    TEST_ASSERT(!bf_isset(field, 25));
}

static void test_bf_get_unset_empty(void)
{
    int res = 0;
    uint8_t field[5];

    memset(field, 0, sizeof(field));
    res = bf_get_unset(field, 0);
    TEST_ASSERT_EQUAL_INT(-1, res);

    memset(field, 0, sizeof(field));
    res = bf_get_unset(field, 1);
    TEST_ASSERT_EQUAL_INT(0, res);

    memset(field, 0, sizeof(field));
    res = bf_get_unset(field, 3);
    TEST_ASSERT_EQUAL_INT(0, res);

    memset(field, 0, sizeof(field));
    res = bf_get_unset(field, 8);
    TEST_ASSERT_EQUAL_INT(0, res);

    memset(field, 0, sizeof(field));
    res = bf_get_unset(field, 9);
    TEST_ASSERT_EQUAL_INT(0, res);

    memset(field, 0, sizeof(field));
    res = bf_get_unset(field, 40);
    TEST_ASSERT_EQUAL_INT(0, res);
}

static void test_bf_get_unset_firstbyte(void)
{
    int res = 0;
    uint8_t field[5];
    memset(field, 0xff, sizeof(field));

    field[0] = 0x00;
    res = bf_get_unset(field, 40);
    TEST_ASSERT_EQUAL_INT(0, res);

    field[0] = 0x80;
    res = bf_get_unset(field, 40);
    TEST_ASSERT_EQUAL_INT(1, res);

    field[0] = 0xf0;
    res = bf_get_unset(field, 40);
    TEST_ASSERT_EQUAL_INT(4, res);

    field[0] = 0xfe;
    res = bf_get_unset(field, 40);
    TEST_ASSERT_EQUAL_INT(7, res);

    field[0] = 0xff;
    res = bf_get_unset(field, 40);
    TEST_ASSERT_EQUAL_INT(-1, res);
}

static void test_bf_get_unset_middle(void)
{
    int res = 0;
    uint8_t field[5];
    memset(field, 0xff, sizeof(field));

    field[2] = 0x00;
    res = bf_get_unset(field, 40);
    TEST_ASSERT_EQUAL_INT(16, res);

    field[2] = 0x80;
    res = bf_get_unset(field, 40);
    TEST_ASSERT_EQUAL_INT(17, res);

    field[2] = 0xf0;
    res = bf_get_unset(field, 40);
    TEST_ASSERT_EQUAL_INT(20, res);

    field[2] = 0xfe;
    res = bf_get_unset(field, 40);
    TEST_ASSERT_EQUAL_INT(23, res);
}

static void test_bf_get_unset_lastbyte(void)
{
    int res = 0;
    uint8_t field[5];
    memset(field, 0xff, sizeof(field));

    field[4] = 0x00;
    res = bf_get_unset(field, 40);
    TEST_ASSERT_EQUAL_INT(32, res);

    field[4] = 0x80;
    res = bf_get_unset(field, 40);
    TEST_ASSERT_EQUAL_INT(33, res);

    field[4] = 0xf0;
    res = bf_get_unset(field, 40);
    TEST_ASSERT_EQUAL_INT(36, res);

    field[4] = 0xfe;
    res = bf_get_unset(field, 40);
    TEST_ASSERT_EQUAL_INT(39, res);
}

static void test_bf_ops(void)
{
    const uint8_t zero[3] = {0};
    const uint8_t set[3] = { 0xFF, 0xFF, 0xFF };

    uint8_t a[3] = { 0xAA, 0x55, 0xF0 };
    uint8_t b[3] = { 0x55, 0xAA, 0x0F };
    uint8_t c[3];

    bf_or(c, a, b, 24);
    TEST_ASSERT_EQUAL_INT(0, memcmp(c, set, sizeof(c)));

    bf_inv(c, c, 24);
    TEST_ASSERT_EQUAL_INT(0, memcmp(c, zero, sizeof(c)));

    bf_and(c, a, b, 24);
    TEST_ASSERT_EQUAL_INT(0, memcmp(c, zero, sizeof(c)));

    bf_inv(c, c, 24);
    TEST_ASSERT_EQUAL_INT(0, memcmp(c, set, sizeof(c)));

    bf_xor(c, c, a, 24);
    TEST_ASSERT_EQUAL_INT(0, memcmp(c, b, sizeof(c)));
}

static void test_bf_find_first_set(void)
{
    int res;
    uint8_t field[5];
    memset(field, 0, sizeof(field));

    res = bf_find_first_set(field, 40);
    TEST_ASSERT_EQUAL_INT(-1, res);

    bf_set(field, 23);
    res = bf_find_first_set(field, 40);
    TEST_ASSERT_EQUAL_INT(23, res);

    bf_set(field, 24);
    res = bf_find_first_set(field, 40);
    TEST_ASSERT_EQUAL_INT(23, res);

    bf_set(field, 13);
    res = bf_find_first_set(field, 40);
    TEST_ASSERT_EQUAL_INT(13, res);

    bf_set(field, 3);
    res = bf_find_first_set(field, 40);
    TEST_ASSERT_EQUAL_INT(3, res);
}

static void test_bf_find_first_unset(void)
{
    int res;
    uint8_t field[5];
    memset(field, 0xff, sizeof(field));

    res = bf_find_first_unset(field, 40);
    TEST_ASSERT_EQUAL_INT(-1, res);

    bf_unset(field, 23);
    res = bf_find_first_unset(field, 40);
    TEST_ASSERT_EQUAL_INT(23, res);

    bf_unset(field, 24);
    res = bf_find_first_unset(field, 40);
    TEST_ASSERT_EQUAL_INT(23, res);

    bf_unset(field, 13);
    res = bf_find_first_unset(field, 40);
    TEST_ASSERT_EQUAL_INT(13, res);

    bf_unset(field, 3);
    res = bf_find_first_unset(field, 40);
    TEST_ASSERT_EQUAL_INT(3, res);
}

static void test_bf_set_all(void)
{
    uint8_t field[5];

    memset(field, 0, sizeof(field));
    bf_set_all(field, 5);
    TEST_ASSERT_EQUAL_INT(0xf8, field[0]);
    TEST_ASSERT_EQUAL_INT(0, field[1]);

    memset(field, 0, sizeof(field));
    bf_set_all(field, 24);
    TEST_ASSERT_EQUAL_INT(0xff, field[0]);
    TEST_ASSERT_EQUAL_INT(0xff, field[1]);
    TEST_ASSERT_EQUAL_INT(0xff, field[2]);
    TEST_ASSERT_EQUAL_INT(0, field[3]);

    memset(field, 0, sizeof(field));
    bf_set_all(field, 30);
    TEST_ASSERT_EQUAL_INT(0xff, field[0]);
    TEST_ASSERT_EQUAL_INT(0xff, field[1]);
    TEST_ASSERT_EQUAL_INT(0xff, field[2]);
    TEST_ASSERT_EQUAL_INT(0xfc, field[3]);
    TEST_ASSERT_EQUAL_INT(0, field[4]);
}

static void test_bf_clear_all(void)
{
    uint8_t field[5];

    memset(field, 0xFF, sizeof(field));
    bf_clear_all(field, 5);
    TEST_ASSERT_EQUAL_INT(0x7, field[0]);
    TEST_ASSERT_EQUAL_INT(0xFF, field[1]);
}

static void test_bf_popcnt(void)
{
    uint8_t field[5];

    memset(field, 0xff, sizeof(field));
    bf_set_all(field, 5);
    TEST_ASSERT_EQUAL_INT(5, bf_popcnt(field, 5));

    field[0] = 0x1;
    field[1] = 0x80;
    TEST_ASSERT_EQUAL_INT(2, bf_popcnt(field, 9));

    field[0] = 0x0;
    field[1] = 0x0;
    TEST_ASSERT_EQUAL_INT(0, bf_popcnt(field, 16));

    field[0] = 0xff;
    field[1] = 0xff;
    TEST_ASSERT_EQUAL_INT(16, bf_popcnt(field, 16));
}

Test *tests_bitfield_tests(void) {
    EMB_UNIT_TESTFIXTURES(fixtures) {
        new_TestFixture(test_bf_set),
        new_TestFixture(test_bf_unset),
        new_TestFixture(test_bf_toggle),
        new_TestFixture(test_bf_isset),
        new_TestFixture(test_bf_get_unset_empty),
        new_TestFixture(test_bf_get_unset_firstbyte),
        new_TestFixture(test_bf_get_unset_middle),
        new_TestFixture(test_bf_get_unset_lastbyte),
        new_TestFixture(test_bf_ops),
        new_TestFixture(test_bf_find_first_set),
        new_TestFixture(test_bf_find_first_unset),
        new_TestFixture(test_bf_set_all),
        new_TestFixture(test_bf_clear_all),
        new_TestFixture(test_bf_popcnt),
    };

    EMB_UNIT_TESTCALLER(bitfield_tests, NULL, NULL, fixtures);

    return (Test *)&bitfield_tests;
}

void tests_bitfield(void)
{
    TESTS_RUN(tests_bitfield_tests());
}