341 lines
9.9 KiB
C
341 lines
9.9 KiB
C
/* signedData-EncryptedFirmwarePkgData.c
|
|
*
|
|
* Copyright (C) 2006-2020 wolfSSL Inc.
|
|
*
|
|
* This file is part of wolfSSL. (formerly known as CyaSSL)
|
|
*
|
|
* wolfSSL is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License as published by
|
|
* the Free Software Foundation; either version 2 of the License, or
|
|
* (at your option) any later version.
|
|
*
|
|
* wolfSSL is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* GNU General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License
|
|
* along with this program; if not, write to the Free Software
|
|
* Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA
|
|
*
|
|
* DESCRIPTION:
|
|
*
|
|
* This file includes an example of generating a PKCS7/CMS signedData
|
|
* bundle which encapsulates an encryptedData content type. The encryptedData
|
|
* that is encapsulated has a content type of FirmwarePkgData. It uses the
|
|
* single-shot API to do this.
|
|
*
|
|
* There are two output files generated by this example:
|
|
*
|
|
* signedEncryptedFPD_noattrs.der - without example of optional attributes
|
|
* signedEncryptedFPD_attrs.der - with example of optional attributes
|
|
*/
|
|
#include <wolfssl/options.h>
|
|
#include <wolfssl/wolfcrypt/settings.h>
|
|
#include <wolfssl/wolfcrypt/pkcs7.h>
|
|
#include <wolfssl/wolfcrypt/error-crypt.h>
|
|
#include <wolfssl/wolfcrypt/logging.h>
|
|
|
|
#define certFile "../certs/client-cert.der"
|
|
#define keyFile "../certs/client-key.der"
|
|
#define encodedFileNoAttrs "signedEncryptedFPD_noattrs.der"
|
|
#define encodedFileAttrs "signedEncryptedFPD_attrs.der"
|
|
|
|
static const byte data[] = { /* Hello World */
|
|
0x48,0x65,0x6c,0x6c,0x6f,0x20,0x57,0x6f,
|
|
0x72,0x6c,0x64
|
|
};
|
|
|
|
static byte aes256Key[] = {
|
|
0x01,0x02,0x03,0x04,0x05,0x06,0x07,0x08,
|
|
0x01,0x02,0x03,0x04,0x05,0x06,0x07,0x08,
|
|
0x01,0x02,0x03,0x04,0x05,0x06,0x07,0x08,
|
|
0x01,0x02,0x03,0x04,0x05,0x06,0x07,0x08
|
|
};
|
|
|
|
static int load_certs(byte* cert, word32* certSz, byte* key, word32* keySz)
|
|
{
|
|
FILE* file;
|
|
|
|
/* certificate file */
|
|
file = fopen(certFile, "rb");
|
|
if (!file)
|
|
return -1;
|
|
|
|
*certSz = (word32)fread(cert, 1, *certSz, file);
|
|
fclose(file);
|
|
|
|
/* key file */
|
|
file = fopen(keyFile, "rb");
|
|
if (!file)
|
|
return -1;
|
|
|
|
*keySz = (word32)fread(key, 1, *keySz, file);
|
|
fclose(file);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int write_file_buffer(const char* fileName, byte* in, word32 inSz)
|
|
{
|
|
int ret;
|
|
FILE* file;
|
|
|
|
file = fopen(fileName, "wb");
|
|
if (file == NULL) {
|
|
printf("ERROR: opening file for writing: %s\n", fileName);
|
|
return -1;
|
|
}
|
|
|
|
ret = (int)fwrite(in, 1, inSz, file);
|
|
if (ret == 0) {
|
|
printf("ERROR: writing buffer to output file\n");
|
|
return -1;
|
|
}
|
|
fclose(file);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int signedData_sign_noattrs(byte* cert, word32 certSz, byte* privateKey,
|
|
word32 privateKeySz, byte* encryptKey,
|
|
word32 encryptKeySz, byte* out, word32 outSz)
|
|
{
|
|
int ret;
|
|
PKCS7* pkcs7;
|
|
|
|
/* init PKCS7 */
|
|
pkcs7 = wc_PKCS7_New(NULL, INVALID_DEVID);
|
|
if (pkcs7 == NULL)
|
|
return -1;
|
|
|
|
ret = wc_PKCS7_InitWithCert(pkcs7, cert, certSz);
|
|
if (ret != 0) {
|
|
printf("ERROR: wc_PKCS7_InitWithCert() failed, ret = %d\n", ret);
|
|
wc_PKCS7_Free(pkcs7);
|
|
return -1;
|
|
}
|
|
|
|
/* encode Signed Encrypted FirmwarePkgData */
|
|
ret = wc_PKCS7_EncodeSignedEncryptedFPD(pkcs7, encryptKey, encryptKeySz,
|
|
privateKey, privateKeySz,
|
|
AES256CBCb, RSAk, SHA256h,
|
|
(byte*)data, sizeof(data),
|
|
NULL, 0, NULL, 0,
|
|
out, outSz);
|
|
if (ret <= 0) {
|
|
printf("ERROR: wc_PKCS7_EncodeSignedEncryptedFPD() failed, "
|
|
"ret = %d\n", ret);
|
|
wc_PKCS7_Free(pkcs7);
|
|
return -1;
|
|
|
|
} else {
|
|
printf("Successfully encoded Signed Encrypted FirmwarePkgData (%s)\n",
|
|
encodedFileNoAttrs);
|
|
|
|
#ifdef DEBUG_WOLFSSL
|
|
printf("Encoded DER (%d bytes):\n", ret);
|
|
WOLFSSL_BUFFER(out, ret);
|
|
#endif
|
|
|
|
if (write_file_buffer(encodedFileNoAttrs, out, ret) != 0) {
|
|
printf("ERROR: error writing encoded to output file\n");
|
|
return -1;
|
|
}
|
|
|
|
}
|
|
|
|
wc_PKCS7_Free(pkcs7);
|
|
|
|
return ret;
|
|
}
|
|
|
|
static int signedData_sign_attrs(byte* cert, word32 certSz, byte* privateKey,
|
|
word32 privateKeySz, byte* encryptKey,
|
|
word32 encryptKeySz, byte* out, word32 outSz)
|
|
{
|
|
int ret;
|
|
PKCS7* pkcs7;
|
|
|
|
static byte messageTypeOid[] =
|
|
{ 0x06, 0x0a, 0x60, 0x86, 0x48, 0x01, 0x86, 0xF8, 0x45, 0x01,
|
|
0x09, 0x02 };
|
|
static byte messageType[] = { 0x13, 2, '1', '9' };
|
|
|
|
PKCS7Attrib attribs[] =
|
|
{
|
|
{ messageTypeOid, sizeof(messageTypeOid), messageType,
|
|
sizeof(messageType) }
|
|
};
|
|
|
|
/* init PKCS7 */
|
|
pkcs7 = wc_PKCS7_New(NULL, INVALID_DEVID);
|
|
if (pkcs7 == NULL)
|
|
return -1;
|
|
|
|
ret = wc_PKCS7_InitWithCert(pkcs7, cert, certSz);
|
|
if (ret != 0) {
|
|
printf("ERROR: wc_PKCS7_InitWithCert() failed, ret = %d\n", ret);
|
|
wc_PKCS7_Free(pkcs7);
|
|
return -1;
|
|
}
|
|
|
|
/* encode Signed Encrypted FirmwarePkgData */
|
|
ret = wc_PKCS7_EncodeSignedEncryptedFPD(pkcs7, encryptKey, encryptKeySz,
|
|
privateKey, privateKeySz,
|
|
AES256CBCb, RSAk, SHA256h,
|
|
(byte*)data, sizeof(data),
|
|
attribs,
|
|
sizeof(attribs)/sizeof(PKCS7Attrib),
|
|
attribs,
|
|
sizeof(attribs)/sizeof(PKCS7Attrib),
|
|
out, outSz);
|
|
if (ret <= 0) {
|
|
printf("ERROR: wc_PKCS7_EncodeSignedEncryptedFPD() failed, "
|
|
"ret = %d\n", ret);
|
|
wc_PKCS7_Free(pkcs7);
|
|
return -1;
|
|
|
|
} else {
|
|
printf("Successfully encoded Signed Encrypted FirmwarePkgData (%s)\n",
|
|
encodedFileAttrs);
|
|
|
|
#ifdef DEBUG_WOLFSSL
|
|
printf("Encoded DER (%d bytes):\n", ret);
|
|
WOLFSSL_BUFFER(out, ret);
|
|
#endif
|
|
|
|
if (write_file_buffer(encodedFileAttrs, out, ret) != 0) {
|
|
printf("ERROR: error writing encoded to output file\n");
|
|
return -1;
|
|
}
|
|
|
|
}
|
|
|
|
wc_PKCS7_Free(pkcs7);
|
|
|
|
return ret;
|
|
}
|
|
|
|
static int signedData_verify(byte* in, word32 inSz, byte* cert,
|
|
word32 certSz, byte* key, word32 keySz,
|
|
byte* encryptKey, word32 encryptKeySz,
|
|
byte* out, word32 outSz)
|
|
{
|
|
int ret;
|
|
PKCS7* pkcs7;
|
|
|
|
pkcs7 = wc_PKCS7_New(NULL, INVALID_DEVID);
|
|
if (pkcs7 == NULL)
|
|
return -1;
|
|
|
|
/* decode signedData, returns size */
|
|
ret = wc_PKCS7_VerifySignedData(pkcs7, in, inSz);
|
|
|
|
if (ret < 0) {
|
|
printf("ERROR: Failed to verify SignedData bundle, ret = %d\n", ret);
|
|
wc_PKCS7_Free(pkcs7);
|
|
return -1;
|
|
}
|
|
|
|
/* decrypt inner encryptedData */
|
|
pkcs7->encryptionKey = encryptKey;
|
|
pkcs7->encryptionKeySz = encryptKeySz;
|
|
|
|
ret = wc_PKCS7_DecodeEncryptedData(pkcs7, pkcs7->content, pkcs7->contentSz,
|
|
out, outSz);
|
|
if (ret < 0) {
|
|
printf("ERROR: failed to decrypt inner EncryptedData, ret = %d\n", ret);
|
|
wc_PKCS7_Free(pkcs7);
|
|
return -1;
|
|
|
|
}
|
|
|
|
/* compare decrypted to expected */
|
|
if ((ret != sizeof(data)) || XMEMCMP(data, out, ret)) {
|
|
printf("Extracted FirmwarePkgData data does not match expected!\n");
|
|
wc_PKCS7_Free(pkcs7);
|
|
return -1;
|
|
|
|
} else {
|
|
printf("Successfully extracted and verified bundle contents\n");
|
|
|
|
#ifdef DEBUG_WOLFSSL
|
|
printf("Decoded content (%d bytes):\n", ret);
|
|
WOLFSSL_BUFFER(out, ret);
|
|
#endif
|
|
}
|
|
|
|
wc_PKCS7_Free(pkcs7);
|
|
|
|
return ret;
|
|
}
|
|
|
|
#ifdef HAVE_PKCS7
|
|
|
|
int main(int argc, char** argv)
|
|
{
|
|
int ret;
|
|
int encryptedSz, decryptedSz;
|
|
word32 certSz, keySz;
|
|
|
|
byte cert[2048];
|
|
byte key[2048];
|
|
byte encrypted[5096];
|
|
byte decrypted[5096];
|
|
|
|
#ifdef DEBUG_WOLFSSL
|
|
wolfSSL_Debugging_ON();
|
|
#endif
|
|
|
|
certSz = sizeof(cert);
|
|
keySz = sizeof(key);
|
|
ret = load_certs(cert, &certSz, key, &keySz);
|
|
if (ret != 0)
|
|
return -1;
|
|
|
|
/* no attributes */
|
|
encryptedSz = signedData_sign_noattrs(cert, certSz, key, keySz,
|
|
aes256Key, sizeof(aes256Key),
|
|
encrypted, sizeof(encrypted));
|
|
if (encryptedSz < 0)
|
|
return -1;
|
|
|
|
decryptedSz = signedData_verify(encrypted, encryptedSz,
|
|
cert, certSz, key, keySz,
|
|
aes256Key, sizeof(aes256Key),
|
|
decrypted, sizeof(decrypted));
|
|
if (decryptedSz < 0)
|
|
return -1;
|
|
|
|
/* default attributes + messageType attribute */
|
|
encryptedSz = signedData_sign_attrs(cert, certSz, key, keySz,
|
|
aes256Key, sizeof(aes256Key),
|
|
encrypted, sizeof(encrypted));
|
|
if (encryptedSz < 0)
|
|
return -1;
|
|
|
|
decryptedSz = signedData_verify(encrypted, encryptedSz,
|
|
cert, certSz, key, keySz,
|
|
aes256Key, sizeof(aes256Key),
|
|
decrypted, sizeof(decrypted));
|
|
if (decryptedSz < 0)
|
|
return -1;
|
|
|
|
(void)argc;
|
|
(void)argv;
|
|
|
|
return 0;
|
|
}
|
|
|
|
#else
|
|
|
|
int main(int argc, char** argv)
|
|
{
|
|
printf("Must build wolfSSL using ./configure --enable-pkcs7\n");
|
|
return 0;
|
|
}
|
|
|
|
#endif
|
|
|