/* SPDX-License-Identifier: BSD-2-Clause */
/***********************************************************************;
 * Copyright (c) 2015 - 2017, Intel Corporation
 * All rights reserved.
 ***********************************************************************/

#ifdef HAVE_CONFIG_H
#include "config.h" // IWYU pragma: keep
#endif

#include <string.h> // for memcpy, size_t

#include "sysapi_util.h"     // for _TSS2_SYS_CONTEXT_BLOB, syscontext_cast
#include "tss2_common.h"     // for TSS2_RC, UINT32, TSS2_SYS_RC_BAD_REFERENCE
#include "tss2_mu.h"         // for Tss2_MU_UINT32_Marshal, Tss2_MU_TPMS_CA...
#include "tss2_sys.h"        // for TSS2_SYS_CONTEXT, TSS2L_SYS_AUTH_COMMAND
#include "tss2_tpm2_types.h" // for TPMS_CAPABILITY_DATA, TPM2B_MAX_CAP_BUFFER

TSS2_RC
Tss2_Sys_GetCapability_Prepare(TSS2_SYS_CONTEXT *sysContext,
                               TPM2_CAP          capability,
                               UINT32            property,
                               UINT32            propertyCount) {
    TSS2_SYS_CONTEXT_BLOB *ctx = syscontext_cast(sysContext);
    TSS2_RC                rval;

    if (!ctx)
        return TSS2_SYS_RC_BAD_REFERENCE;

    rval = CommonPreparePrologue(ctx, TPM2_CC_GetCapability);
    if (rval)
        return rval;

    rval = Tss2_MU_UINT32_Marshal(capability, ctx->cmdBuffer, ctx->maxCmdSize, &ctx->nextData);
    if (rval)
        return rval;

    rval = Tss2_MU_UINT32_Marshal(property, ctx->cmdBuffer, ctx->maxCmdSize, &ctx->nextData);
    if (rval)
        return rval;

    rval = Tss2_MU_UINT32_Marshal(propertyCount, ctx->cmdBuffer, ctx->maxCmdSize, &ctx->nextData);
    if (rval)
        return rval;

    ctx->decryptAllowed = 0;
    ctx->encryptAllowed = 0;
    ctx->authAllowed = 1;

    return CommonPrepareEpilogue(ctx);
}

TSS2_RC
Tss2_Sys_GetCapability_Complete(TSS2_SYS_CONTEXT     *sysContext,
                                TPMI_YES_NO          *moreData,
                                TPMS_CAPABILITY_DATA *capabilityData) {
    TSS2_SYS_CONTEXT_BLOB *ctx = syscontext_cast(sysContext);
    TSS2_RC                rval;
    TPM2_CAP               cap;

    if (!ctx)
        return TSS2_SYS_RC_BAD_REFERENCE;

    rval = CommonComplete(ctx);
    if (rval)
        return rval;

    rval = Tss2_MU_UINT8_Unmarshal(ctx->cmdBuffer, ctx->maxCmdSize, &ctx->nextData, moreData);
    if (rval)
        return rval;

    /* Peak at the capabilityData->capability field to decide what to do
       if this is a standard cap, just unmarshal it.
       if this is a vendor cap, we fill a tpm2b inside the struct buffer.*/
    size_t next_data_vendor = ctx->nextData;
    rval = Tss2_MU_UINT32_Unmarshal(ctx->cmdBuffer, ctx->maxCmdSize, &next_data_vendor, &cap);
    if (rval)
        return rval;

    if (cap != TPM2_CAP_VENDOR_PROPERTY)
        return Tss2_MU_TPMS_CAPABILITY_DATA_Unmarshal(ctx->cmdBuffer, ctx->maxCmdSize,
                                                      &ctx->nextData, capabilityData);

    /*
     * Size the capabilityData is the end of response we can copy the remainder
     * of the response in case of cap_vendor.
     *
     * Example for 23 byte response size:
     *
     * Header: 10 Bytes
     * MoreData: 1 byte
     * cap: 4 bytes
     * Vendor Data: 8 bytes
     */
    ctx->nextData = next_data_vendor;
    size_t left = ctx->rsp_header.responseSize - ctx->nextData;
    if (left > sizeof(capabilityData->data.vendor.buffer))
        return TSS2_MU_RC_BAD_SIZE;

    /* seems callers can use NULL */
    if (capabilityData) {
        capabilityData->capability = cap;

        capabilityData->data.vendor.size = left;
        memcpy(&capabilityData->data.vendor.buffer[0], &ctx->cmdBuffer[ctx->nextData], left);
    }
    ctx->nextData += left;

    return TSS2_RC_SUCCESS;
}

TSS2_RC
Tss2_Sys_GetCapability(TSS2_SYS_CONTEXT             *sysContext,
                       TSS2L_SYS_AUTH_COMMAND const *cmdAuthsArray,
                       TPM2_CAP                      capability,
                       UINT32                        property,
                       UINT32                        propertyCount,
                       TPMI_YES_NO                  *moreData,
                       TPMS_CAPABILITY_DATA         *capabilityData,
                       TSS2L_SYS_AUTH_RESPONSE      *rspAuthsArray) {
    TSS2_SYS_CONTEXT_BLOB *ctx = syscontext_cast(sysContext);
    TSS2_RC                rval;

    rval = Tss2_Sys_GetCapability_Prepare(sysContext, capability, property, propertyCount);
    if (rval)
        return rval;

    rval = CommonOneCall(ctx, cmdAuthsArray, rspAuthsArray);
    if (rval)
        return rval;

    return Tss2_Sys_GetCapability_Complete(sysContext, moreData, capabilityData);
}
