/*
 * Copyright 2016 NXP
 * SPDX-License-Identifier: Apache-2.0
 */

#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <assert.h>

// project specific include files
#include "sm_types.h"
#include "sm_apdu.h"
#include "tst_sm_util.h"
#include "global_platf.h"

#include "axHostCrypto.h"
#include "tstHostCrypto.h"

#include "probeAxUtil.h"

// #define FLOW_VERBOSE_PROBE_A70

#ifdef FLOW_VERBOSE_PROBE_A70
#define FPRINTF(...) printf (__VA_ARGS__)
#else
#define FPRINTF(...)
#endif

// #define DBG_PROBE_A70

#ifdef DBG_PROBE_A70
#define DBGPRINTF(...) printf (__VA_ARGS__)
#else
#define DBGPRINTF(...)
#endif

#define JCOP_242R1_IDENTIFY_RSP_LEN   21
#define JCOP_242R2_IDENTIFY_RSP_LEN   22

#define IDY_FABKEY_ID_OFFSET      0
#define IDY_PATCH_ID_OFFSET       1
#define IDY_TARGET_ID_OFFSET      2
#define IDY_MASK_ID_OFFSET        3
#define IDY_CUSTOM_MASK_ID_OFFSET 4
#define IDY_MASK_NAME_OFFSET      8
#define IDY_FUSED_STATE_OFFSET   14
#define IDY_ROM_INFO_LEN_OFFSET  15
#define IDY_ROM_INFO_OFFSET      16
#define IDY_FIPS_OFFSET          19

#define JCOP_242_GETCPLC_DATA_RSP_LEN 47
#define GET_CPLC_DATA_OFFSET           3
#define CPLC_IC_MOD_FAB_OFFSET         (GET_CPLC_DATA_OFFSET + 0x12)
#define CPCL_IC_MOD_PACK_DATE_OFFSET   (GET_CPLC_DATA_OFFSET + 0x14)
#define CPCL_ICC_MANUFACT_OFFSET       (GET_CPLC_DATA_OFFSET + 0x16)
#define CPCL_IC_EMBED_DATE_OFFSET      (GET_CPLC_DATA_OFFSET + 0x18)
#define CPCL_IC_PRE_PERSO_OFFSET       (GET_CPLC_DATA_OFFSET + 0x1A)

// TODO: Split fetching of value and printing out of value in two functions
U16 probeAxIdentifyFetchPrint()
{
    U16 sw;
    U8 resp[128];
    U16 respLen = sizeof(resp);
    U8 cmdIdentify[] = { 0x00, INS_GP_SELECT, 0x04, 0x00, 0x09,
                         0xA0, 0x00, 0x00, 0x01, 0x67, 0x41, 0x30, 0x00, 0xFF,
                         0x00 };
    DBGPRINTF("DBG: probeAxIdentifyFetchPrint().\n");
    respLen = sizeof(resp);
    sw = SM_SendAPDU(cmdIdentify, (U16) sizeof(cmdIdentify), resp, &respLen);
    // DBGPRINTF("DBG: respLen: %d.\n", respLen);
    if ( (respLen == JCOP_242R1_IDENTIFY_RSP_LEN) || (respLen == JCOP_242R2_IDENTIFY_RSP_LEN) )
    {
        if ( ((U16)(resp[respLen-2]<<8) + resp[respLen-1]) == SW_FILE_NOT_FOUND  )
        {
            printf("Fabkey ID      : 0x%02X\n", resp[IDY_FABKEY_ID_OFFSET]);
            printf("Patch ID       : 0x%02X\n", resp[IDY_PATCH_ID_OFFSET]);
            printf("Target ID      : 0x%02X\n", resp[IDY_TARGET_ID_OFFSET]);
            printf("Mask ID        : 0x%02X (%d)\n", resp[IDY_MASK_ID_OFFSET], (resp[IDY_MASK_ID_OFFSET] & 0x00FF) );
            printf("Custom Mask ID : 0x%02X:%02X:%02X:%02X\n", resp[IDY_CUSTOM_MASK_ID_OFFSET], resp[IDY_CUSTOM_MASK_ID_OFFSET+1],
                resp[IDY_CUSTOM_MASK_ID_OFFSET+2], resp[IDY_CUSTOM_MASK_ID_OFFSET+3]);
            printf("Mask Name      : %c%c%c%c%c%c\n", resp[IDY_MASK_NAME_OFFSET], resp[IDY_MASK_NAME_OFFSET+1], resp[IDY_MASK_NAME_OFFSET+2],
                resp[IDY_MASK_NAME_OFFSET+3], resp[IDY_MASK_NAME_OFFSET+4], resp[IDY_MASK_NAME_OFFSET+5]);
            printf("Fused State    : 0x%02X\n", resp[IDY_FUSED_STATE_OFFSET]);
            printf("Rom Info Len   : %d\n", resp[IDY_ROM_INFO_LEN_OFFSET]);
            printf("Rom Info       : 0x%02X:%02X:%02X\n", resp[IDY_ROM_INFO_OFFSET], resp[IDY_ROM_INFO_OFFSET+1], resp[IDY_ROM_INFO_OFFSET+2]);
            if (respLen == JCOP_242R2_IDENTIFY_RSP_LEN)
            {
                printf("FIPS           : 0x%02X\n", resp[IDY_FIPS_OFFSET]);
            }
        }
        else
        {
            printf("Identify command failed.\n");
            axPrintByteArray("Command Response", resp, respLen, AX_COLON_32);
        }
    }
    else
    {
        printf("Identify command failed.\n");
        axPrintByteArray("Command Response", resp, respLen, AX_COLON_32);
    }

    return sw;
}

// TODO: Split fetching of value and printing out of value in two functions
U16 probeAxSelectCardmanager()
{
    U16 sw_raw;
    U16 sw_response;
    U8 resp[200];
    U16 respLen = sizeof(resp);
    U8 cmdIdentify[] = { 0x00, INS_GP_SELECT, 0x04, 0x00, 0x00 };
    DBGPRINTF("DBG: probeAxSelectCardmanager().\n");
    respLen = sizeof(resp);
    sw_raw = SM_SendAPDU(cmdIdentify, (U16) sizeof(cmdIdentify), resp, &respLen);
    if (sw_raw == SW_OK)
    {
        sw_response = (U16)((resp[respLen-2]<<8) + resp[respLen-1]);
        if ( sw_response == SW_OK  )
        {
            printf("Select Card Manager command OK.\n");
            // axPrintByteArray("Command Response", resp, respLen, AX_COLON_32);
        }
        else
        {
            printf("Select Card Manager command FAILED.\n");
            axPrintByteArray("Command Response", resp, respLen, AX_COLON_32);
            sw_raw = sw_response;
        }
    }

    return sw_raw;
}

// TODO: Split fetching of value and printing out of value in two functions
U16 probeAxGetCplcDataFetchPrint()
{
    U16 sw;
    U8 resp[128];
    U16 respLen = sizeof(resp);
    U8 cmdIdentify[] = { 0x80, 0xCA, 0x9F, 0x7F, 0x00 };
    DBGPRINTF("DBG: probeAxGetCplcDataFetchPrint().\n");
    respLen = sizeof(resp);
    sw = SM_SendAPDU(cmdIdentify, (U16) sizeof(cmdIdentify), resp, &respLen);
    // DBGPRINTF("DBG: respLen: %d.\n", respLen);
    if ( respLen == JCOP_242_GETCPLC_DATA_RSP_LEN )
    {
        if ( ((U16)(resp[respLen-2]<<8) + resp[respLen-1]) == SW_OK  )
        {
            printf("CPLC Data:\n");
            printf("IC Fabricator  : 0x%02X:%02X\n", resp[GET_CPLC_DATA_OFFSET], resp[GET_CPLC_DATA_OFFSET+1]);
            printf("IC Type        : 0x%02X:%02X\n", resp[GET_CPLC_DATA_OFFSET+2], resp[GET_CPLC_DATA_OFFSET+3]);
            printf("OS ID          : 0x%02X:%02X\n", resp[GET_CPLC_DATA_OFFSET+4], resp[GET_CPLC_DATA_OFFSET+5]);
            printf("OS Rel Date    : 0x%02X:%02X\n", resp[GET_CPLC_DATA_OFFSET+6], resp[GET_CPLC_DATA_OFFSET+7]);
            printf("OS Rel Level   : 0x%02X:%02X\n", resp[GET_CPLC_DATA_OFFSET+8], resp[GET_CPLC_DATA_OFFSET+9]);
            printf("IC Fab Date    : 0x%02X:%02X\n", resp[GET_CPLC_DATA_OFFSET+10], resp[GET_CPLC_DATA_OFFSET+11]);
            printf("IC Ser Nr      : 0x%02X:%02X:%02X:%02X\n",
                resp[GET_CPLC_DATA_OFFSET+12], resp[GET_CPLC_DATA_OFFSET+13],resp[GET_CPLC_DATA_OFFSET+14], resp[GET_CPLC_DATA_OFFSET+15]);
            printf("IC Batch ID    : 0x%02X:%02X\n", resp[GET_CPLC_DATA_OFFSET+16], resp[GET_CPLC_DATA_OFFSET+17]);
            printf("IC Mod Fab     : 0x%02X:%02X\n", resp[CPLC_IC_MOD_FAB_OFFSET], resp[CPLC_IC_MOD_FAB_OFFSET+1]);
            printf("IC Mod PackDate: 0x%02X:%02X\n", resp[CPCL_IC_MOD_PACK_DATE_OFFSET], resp[CPCL_IC_MOD_PACK_DATE_OFFSET+1]);
            printf("ICC Manufact   : 0x%02X:%02X\n", resp[CPCL_ICC_MANUFACT_OFFSET], resp[CPCL_ICC_MANUFACT_OFFSET+1]);
            printf("IC Embed Date  : 0x%02X:%02X\n", resp[CPCL_IC_EMBED_DATE_OFFSET], resp[CPCL_IC_EMBED_DATE_OFFSET+1]);
            printf("IC Pre-Perso   : 0x%02X:%02X\n", resp[CPCL_IC_PRE_PERSO_OFFSET], resp[CPCL_IC_PRE_PERSO_OFFSET+1]);
            printf("NOTE: Remaining CPLC data not printed out...\n");
        }
        else
        {
            printf("GetCplcData command failed.\n");
            axPrintByteArray("Command Response", resp, respLen, AX_COLON_32);
        }
    }
    else
    {
        printf("GetCplcData command failed.\n");
        axPrintByteArray("Command Response", resp, respLen, AX_COLON_32);
    }

    return sw;
}