| //**********************************************************************; |
| // Copyright (c) 2015, Intel Corporation |
| // All rights reserved. |
| // |
| // Redistribution and use in source and binary forms, with or without |
| // modification, are permitted provided that the following conditions are met: |
| // |
| // 1. Redistributions of source code must retain the above copyright notice, |
| // this list of conditions and the following disclaimer. |
| // |
| // 2. Redistributions in binary form must reproduce the above copyright notice, |
| // this list of conditions and the following disclaimer in the documentation |
| // and/or other materials provided with the distribution. |
| // |
| // THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" |
| // AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE |
| // IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE |
| // ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE |
| // LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR |
| // CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF |
| // SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS |
| // INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN |
| // CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) |
| // ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF |
| // THE POSSIBILITY OF SUCH DAMAGE. |
| //**********************************************************************; |
| |
| #include "sapi/tpm20.h" |
| #include "sample.h" |
| #include <stdio.h> |
| #include <stdlib.h> |
| #include "sysapi_util.h" |
| |
| // |
| // |
| TPM_RC KDFa( TPMI_ALG_HASH hashAlg, TPM2B *key, char *label, |
| TPM2B *contextU, TPM2B *contextV, UINT16 bits, TPM2B_MAX_BUFFER *resultKey ) |
| { |
| TPM2B_DIGEST tmpResult; |
| TPM2B_DIGEST tpm2bLabel, tpm2bBits, tpm2b_i_2; |
| UINT8 *tpm2bBitsPtr = &tpm2bBits.t.buffer[0]; |
| UINT8 *tpm2b_i_2Ptr = &tpm2b_i_2.t.buffer[0]; |
| TPM2B_DIGEST *bufferList[8]; |
| UINT32 bitsSwizzled, i_Swizzled; |
| TPM_RC rval; |
| int i, j; |
| UINT16 bytes = bits / 8; |
| |
| #ifdef DEBUG |
| DebugPrintf( 0, "KDFA, hashAlg = %4.4x\n", hashAlg ); |
| DebugPrintf( 0, "\n\nKDFA, key = \n" ); |
| PrintSizedBuffer( key ); |
| #endif |
| |
| resultKey->t .size = 0; |
| |
| tpm2b_i_2.t.size = 4; |
| |
| tpm2bBits.t.size = 4; |
| bitsSwizzled = CHANGE_ENDIAN_DWORD( bits ); |
| *(UINT32 *)tpm2bBitsPtr = bitsSwizzled; |
| |
| for(i = 0; label[i] != 0 ;i++ ); |
| |
| tpm2bLabel.t.size = i+1; |
| for( i = 0; i < tpm2bLabel.t.size; i++ ) |
| { |
| tpm2bLabel.t.buffer[i] = label[i]; |
| } |
| |
| #ifdef DEBUG |
| DebugPrintf( 0, "\n\nKDFA, tpm2bLabel = \n" ); |
| PrintSizedBuffer( (TPM2B *)&tpm2bLabel ); |
| |
| DebugPrintf( 0, "\n\nKDFA, contextU = \n" ); |
| PrintSizedBuffer( contextU ); |
| |
| DebugPrintf( 0, "\n\nKDFA, contextV = \n" ); |
| PrintSizedBuffer( contextV ); |
| #endif |
| |
| resultKey->t.size = 0; |
| |
| i = 1; |
| |
| while( resultKey->t.size < bytes ) |
| { |
| // Inner loop |
| |
| i_Swizzled = CHANGE_ENDIAN_DWORD( i ); |
| *(UINT32 *)tpm2b_i_2Ptr = i_Swizzled; |
| |
| j = 0; |
| bufferList[j++] = (TPM2B_DIGEST *)&(tpm2b_i_2.b); |
| bufferList[j++] = (TPM2B_DIGEST *)&(tpm2bLabel.b); |
| bufferList[j++] = (TPM2B_DIGEST *)contextU; |
| bufferList[j++] = (TPM2B_DIGEST *)contextV; |
| bufferList[j++] = (TPM2B_DIGEST *)&(tpm2bBits.b); |
| bufferList[j++] = (TPM2B_DIGEST *)0; |
| #ifdef DEBUG |
| for( j = 0; bufferList[j] != 0; j++ ) |
| { |
| DebugPrintf( 0, "\n\nbufferlist[%d]:\n", j ); |
| PrintSizedBuffer( &( bufferList[j]->b ) ); |
| } |
| #endif |
| rval = (*HmacFunctionPtr )( hashAlg, key, (TPM2B **)&( bufferList[0] ), &tmpResult ); |
| if( rval != TPM_RC_SUCCESS ) |
| { |
| return( rval ); |
| } |
| |
| ConcatSizedByteBuffer( resultKey, &(tmpResult.b) ); |
| } |
| |
| // Truncate the result to the desired size. |
| resultKey->t.size = bytes; |
| |
| #ifdef DEBUG |
| DebugPrintf( 0, "\n\nKDFA, resultKey = \n" ); |
| PrintSizedBuffer( &( resultKey->b ) ); |
| #endif |
| |
| return TPM_RC_SUCCESS; |
| } |