126 lines
3.4 KiB
C
126 lines
3.4 KiB
C
|
|
|
|
#include <wolfssl/options.h>
|
|
#include <wolfssl/wolfcrypt/settings.h>
|
|
#include <wolfssl/wolfcrypt/wc_pkcs11.h>
|
|
#include <wolfssl/wolfcrypt/asn_public.h>
|
|
#include <wolfssl/wolfcrypt/error-crypt.h>
|
|
#include <wolfssl/wolfcrypt/logging.h>
|
|
|
|
#if !defined(NO_AES) && defined(HAVE_AESGCM)
|
|
int aesgcm_enc_dec(int devId)
|
|
{
|
|
Aes aesEnc;
|
|
Aes aesDec;
|
|
unsigned char key[AES_256_KEY_SIZE];
|
|
int ret = 0;
|
|
unsigned char data[33];
|
|
unsigned char enc[33];
|
|
unsigned char dec[33];
|
|
unsigned char iv[GCM_NONCE_MID_SZ];
|
|
unsigned char authTag[AES_BLOCK_SIZE];
|
|
|
|
memset(key, 9, sizeof(key));
|
|
memset(data, 9, sizeof(data));
|
|
memset(iv, 9, sizeof(iv));
|
|
|
|
fprintf(stderr, "Encrypt with AES128-GCM\n");
|
|
ret = wc_AesInit_Id(&aesEnc, NULL, 0, NULL, devId);
|
|
if (ret == 0) {
|
|
ret = wc_AesGcmSetKey(&aesEnc, key, AES_128_KEY_SIZE);
|
|
if (ret != 0)
|
|
fprintf(stderr, "Set Key failed: %d\n", ret);
|
|
}
|
|
if (ret == 0) {
|
|
ret = wc_AesGcmEncrypt(&aesEnc, enc, data, sizeof(data), iv, sizeof(iv),
|
|
authTag, sizeof(authTag), NULL, 0);
|
|
if (ret != 0)
|
|
fprintf(stderr, "Encrypt failed: %d\n", ret);
|
|
}
|
|
|
|
if (ret == 0) {
|
|
fprintf(stderr, "Decrypt with AES128-GCM\n");
|
|
ret = wc_AesInit_Id(&aesDec, NULL, 0, NULL, devId);
|
|
}
|
|
if (ret == 0) {
|
|
ret = wc_AesGcmSetKey(&aesDec, key, AES_128_KEY_SIZE);
|
|
if (ret != 0)
|
|
fprintf(stderr, "Set Key failed: %d\n", ret);
|
|
}
|
|
if (ret == 0) {
|
|
ret = wc_AesGcmDecrypt(&aesDec, dec, enc, sizeof(enc), iv, sizeof(iv),
|
|
authTag, sizeof(authTag), NULL, 0);
|
|
if (ret != 0)
|
|
fprintf(stderr, "Decrypt failed: %d\n", ret);
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
#endif
|
|
|
|
int main(int argc, char* argv[])
|
|
{
|
|
int ret;
|
|
const char* library;
|
|
const char* slot;
|
|
const char* tokenName;
|
|
const char* userPin;
|
|
Pkcs11Dev dev;
|
|
Pkcs11Token token;
|
|
int slotId;
|
|
int devId = 1;
|
|
|
|
if (argc != 5) {
|
|
fprintf(stderr,
|
|
"Usage: pkcs11_aesgcm <libname> <slot> <tokenname> <userpin>\n");
|
|
return 1;
|
|
}
|
|
|
|
library = argv[1];
|
|
slot = argv[2];
|
|
tokenName = argv[3];
|
|
userPin = argv[4];
|
|
slotId = atoi(slot);
|
|
|
|
#if defined(DEBUG_WOLFSSL)
|
|
wolfSSL_Debugging_ON();
|
|
#endif
|
|
wolfCrypt_Init();
|
|
|
|
ret = wc_Pkcs11_Initialize(&dev, library, NULL);
|
|
if (ret != 0) {
|
|
fprintf(stderr, "Failed to initialize PKCS#11 library\n");
|
|
ret = 2;
|
|
}
|
|
if (ret == 0) {
|
|
ret = wc_Pkcs11Token_Init(&token, &dev, slotId, tokenName,
|
|
(byte*)userPin, strlen(userPin));
|
|
if (ret != 0) {
|
|
fprintf(stderr, "Failed to initialize PKCS#11 token\n");
|
|
ret = 2;
|
|
}
|
|
if (ret == 0) {
|
|
ret = wc_CryptoDev_RegisterDevice(devId, wc_Pkcs11_CryptoDevCb,
|
|
&token);
|
|
if (ret != 0) {
|
|
fprintf(stderr, "Failed to register PKCS#11 token\n");
|
|
ret = 2;
|
|
}
|
|
if (ret == 0) {
|
|
#if !defined(NO_AES) && defined(HAVE_AESGCM)
|
|
ret = aesgcm_enc_dec(devId);
|
|
if (ret != 0)
|
|
ret = 1;
|
|
#endif
|
|
}
|
|
wc_Pkcs11Token_Final(&token);
|
|
}
|
|
wc_Pkcs11_Finalize(&dev);
|
|
}
|
|
|
|
wolfCrypt_Cleanup();
|
|
|
|
return ret;
|
|
}
|
|
|