// SPDX-License-Identifier: GPL-2.0-only
/*
 * Digital Voice Modem - Test Suite
 * GPLv2 Open Source. Use is subject to license terms.
 * DO NOT ALTER OR REMOVE COPYRIGHT NOTICES OR THIS FILE HEADER.
 *
 *  Copyright (C) 2023 Bryan Biedenkapp, N2PLL
 *
 */
#include "host/Defines.h"
#include "common/AESCrypto.h"
#include "common/Log.h"
#include "common/Utils.h"

using namespace crypto;

#include <catch2/catch_test_macros.hpp>
#include <stdlib.h>
#include <time.h>

TEST_CASE("AES LLA AM4 Test", "[aes][lla_am4]") {
    bool failed = false;

    INFO("AES P25 LLA AM4 Test");

    /*
    ** TIA-102.AACE-A 6.6 AM4 Sample
    */

    srand((unsigned int)time(NULL));

    // key (KS)
    uint8_t KS[16] = 
    {
        0x69, 0xD5, 0xDC, 0x08, 0x02, 0x3C, 0x46, 0x52,
        0xCC, 0x71, 0xD5, 0xCD, 0x1E, 0x74, 0xE1, 0x04
    };

    // RES2
    uint8_t resultRES2[4] = 
    {
        0xB3, 0xAD, 0x16, 0xE1
    };

    // RAND2
    uint8_t RAND2[5] = 
    {
        0x6E, 0x78, 0x4F, 0x75, 0xBD
    };

    // expand RAND2 to 16 bytes
    uint8_t expandedRAND2[16];
    for (uint32_t i = 0; i < 16U; i++)
        expandedRAND2[i] = 0x00U;
    for (uint32_t i = 0; i < 5U; i++)
        expandedRAND2[i] = RAND2[i];

    // perform crypto
    AES* aes = new AES(AESKeyLength::AES_128);

    uint8_t* aesOut = aes->encryptECB(expandedRAND2, 16 * sizeof(uint8_t), KS);

    // reduce AES output
    uint8_t RES2[4];
    for (uint32_t i = 0; i < 4U; i++)
        RES2[i] = aesOut[i];

    Utils::dump(2U, "LLA_AM4_Test, Const Result", resultRES2, 4);
    Utils::dump(2U, "LLA_AM4_Test, AES Out", aesOut, 16);
    Utils::dump(2U, "LLA_AM4_Test, Result", RES2, 4);

    for (uint32_t i = 0; i < 4U; i++) {
        if (RES2[i] != resultRES2[i]) {
            ::LogError("T", "LLA_AM4_Test, INVALID AT IDX %d", i);
            failed = true;
        }
    }

    delete aes;
    REQUIRE(failed==false);
}
