2014-07-03 15:26:44 +02:00
|
|
|
/****************************************************************************
|
|
|
|
* arch/arm/src/sam34/sam_aes.c
|
|
|
|
*
|
|
|
|
* Copyright (C) 2014 Gregory Nutt. All rights reserved.
|
2014-07-04 02:28:26 +02:00
|
|
|
* Author: Max Nekludov <macscomp@gmail.com>
|
2014-07-03 15:26:44 +02:00
|
|
|
*
|
|
|
|
* 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.
|
|
|
|
* 3. Neither the name NuttX nor the names of its contributors may be
|
|
|
|
* used to endorse or promote products derived from this software
|
|
|
|
* without specific prior written permission.
|
|
|
|
*
|
|
|
|
* 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 OWNER 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.
|
|
|
|
*
|
|
|
|
****************************************************************************/
|
|
|
|
|
|
|
|
/****************************************************************************
|
|
|
|
* Included Files
|
|
|
|
****************************************************************************/
|
|
|
|
|
|
|
|
#include <nuttx/config.h>
|
|
|
|
|
|
|
|
#include <sys/types.h>
|
|
|
|
#include <stdint.h>
|
|
|
|
#include <stdbool.h>
|
|
|
|
#include <stdlib.h>
|
2014-07-03 15:58:43 +02:00
|
|
|
#include <semaphore.h>
|
2014-07-03 15:26:44 +02:00
|
|
|
#include <errno.h>
|
|
|
|
#include <debug.h>
|
|
|
|
|
2014-07-04 02:35:08 +02:00
|
|
|
#include <nuttx/crypto/crypto.h>
|
2014-07-03 15:26:44 +02:00
|
|
|
#include <nuttx/arch.h>
|
2014-07-04 02:35:08 +02:00
|
|
|
#include <arch/board/board.h>
|
2014-07-03 15:26:44 +02:00
|
|
|
|
|
|
|
#include "up_internal.h"
|
|
|
|
#include "up_arch.h"
|
|
|
|
|
|
|
|
#include "chip.h"
|
|
|
|
#include "sam_periphclks.h"
|
|
|
|
#include "sam_aes.h"
|
|
|
|
|
|
|
|
/****************************************************************************
|
|
|
|
* Pre-processor Definitions
|
|
|
|
****************************************************************************/
|
|
|
|
|
|
|
|
#define AES_BLOCK_SIZE 16
|
|
|
|
|
|
|
|
/****************************************************************************
|
|
|
|
* Private Types
|
|
|
|
****************************************************************************/
|
|
|
|
|
|
|
|
/****************************************************************************
|
|
|
|
* Private Function Prototypes
|
|
|
|
****************************************************************************/
|
|
|
|
|
|
|
|
/****************************************************************************
|
|
|
|
* Private Data
|
|
|
|
****************************************************************************/
|
|
|
|
|
|
|
|
static sem_t lock;
|
|
|
|
|
|
|
|
/****************************************************************************
|
|
|
|
* Public Data
|
|
|
|
****************************************************************************/
|
|
|
|
|
|
|
|
/****************************************************************************
|
|
|
|
* Private Functions
|
|
|
|
****************************************************************************/
|
|
|
|
|
|
|
|
static void aes_lock(void)
|
|
|
|
{
|
|
|
|
sem_wait(&lock);
|
|
|
|
}
|
|
|
|
|
|
|
|
static void aes_unlock(void)
|
|
|
|
{
|
|
|
|
sem_post(&lock);
|
|
|
|
}
|
|
|
|
|
|
|
|
static void aes_memcpy(void *out, const void *in, size_t size)
|
|
|
|
{
|
|
|
|
size_t i;
|
|
|
|
size_t wcount = size / 4;
|
2015-10-07 19:39:06 +02:00
|
|
|
for (i = 0; i < wcount; i++, out = (uint8_t *)out + 4, in = (uint8_t *)in + 4)
|
2014-07-03 15:26:44 +02:00
|
|
|
{
|
2015-10-07 19:39:06 +02:00
|
|
|
*(uint32_t *)out = *(uint32_t *)in;
|
2014-07-03 15:26:44 +02:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
static void aes_encryptblock(void *out, const void *in)
|
|
|
|
{
|
2015-10-07 19:39:06 +02:00
|
|
|
aes_memcpy((void *)SAM_AES_IDATAR, in, AES_BLOCK_SIZE);
|
2014-07-03 15:26:44 +02:00
|
|
|
|
|
|
|
putreg32(AES_CR_START, SAM_AES_CR);
|
|
|
|
|
2015-10-06 01:13:53 +02:00
|
|
|
while (!(getreg32(SAM_AES_ISR) & AES_ISR_DATRDY));
|
2014-07-03 15:26:44 +02:00
|
|
|
|
2015-06-22 14:42:37 +02:00
|
|
|
if (out)
|
|
|
|
{
|
2015-10-07 19:39:06 +02:00
|
|
|
aes_memcpy(out, (void *)SAM_AES_ODATAR, AES_BLOCK_SIZE);
|
2015-06-22 14:42:37 +02:00
|
|
|
}
|
2014-07-03 15:26:44 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
static int aes_setup_mr(uint32_t keysize, int mode, int encrypt)
|
|
|
|
{
|
|
|
|
uint32_t regval = AES_MR_SMOD_MANUAL_START | AES_MR_CKEY;
|
|
|
|
|
|
|
|
if (encrypt)
|
2015-10-06 01:13:53 +02:00
|
|
|
{
|
|
|
|
regval |= AES_MR_CIPHER_ENCRYPT;
|
|
|
|
}
|
2014-07-03 15:26:44 +02:00
|
|
|
else
|
2015-10-06 01:13:53 +02:00
|
|
|
{
|
|
|
|
regval |= AES_MR_CIPHER_DECRYPT;
|
|
|
|
}
|
|
|
|
|
|
|
|
switch (keysize)
|
|
|
|
{
|
|
|
|
case 16:
|
|
|
|
regval |= AES_MR_KEYSIZE_AES128;
|
|
|
|
break;
|
|
|
|
case 24:
|
|
|
|
regval |= AES_MR_KEYSIZE_AES192;
|
|
|
|
break;
|
|
|
|
case 32:
|
|
|
|
regval |= AES_MR_KEYSIZE_AES256;
|
|
|
|
break;
|
|
|
|
default:
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
|
|
|
switch (mode)
|
|
|
|
{
|
|
|
|
case AES_MODE_ECB:
|
|
|
|
regval |= AES_MR_OPMOD_ECB;
|
|
|
|
break;
|
|
|
|
case AES_MODE_CBC:
|
|
|
|
regval |= AES_MR_OPMOD_CBC;
|
|
|
|
break;
|
|
|
|
case AES_MODE_CTR:
|
|
|
|
regval |= AES_MR_OPMOD_CTR;
|
|
|
|
break;
|
|
|
|
case AES_MODE_CFB:
|
|
|
|
regval |= AES_MR_OPMOD_CFB;
|
|
|
|
break;
|
|
|
|
default:
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
2014-07-03 15:26:44 +02:00
|
|
|
|
|
|
|
putreg32(regval, SAM_AES_MR);
|
|
|
|
return OK;
|
|
|
|
}
|
|
|
|
|
|
|
|
/****************************************************************************
|
|
|
|
* Public Functions
|
|
|
|
****************************************************************************/
|
|
|
|
|
|
|
|
int aes_cypher(void *out, const void *in, uint32_t size, const void *iv,
|
|
|
|
const void *key, uint32_t keysize, int mode, int encrypt)
|
|
|
|
{
|
|
|
|
int res = OK;
|
|
|
|
|
|
|
|
if (size % 16)
|
2015-10-06 01:13:53 +02:00
|
|
|
{
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
2014-07-03 15:26:44 +02:00
|
|
|
|
|
|
|
aes_lock();
|
|
|
|
|
2015-06-22 14:42:37 +02:00
|
|
|
res = aes_setup_mr(keysize, mode & AES_MODE_MASK, encrypt);
|
2014-07-03 15:26:44 +02:00
|
|
|
if (res)
|
|
|
|
{
|
|
|
|
aes_unlock();
|
|
|
|
return res;
|
|
|
|
}
|
|
|
|
|
2015-10-07 19:39:06 +02:00
|
|
|
aes_memcpy((void *)SAM_AES_KEYWR, key, keysize);
|
2014-07-03 15:26:44 +02:00
|
|
|
if (iv)
|
|
|
|
{
|
2015-10-07 19:39:06 +02:00
|
|
|
aes_memcpy((void *)SAM_AES_IVR, iv, AES_BLOCK_SIZE);
|
2014-07-03 15:26:44 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
while (size)
|
|
|
|
{
|
2015-06-22 14:42:37 +02:00
|
|
|
if ((mode & AES_MODE_MAC) == 0)
|
|
|
|
{
|
|
|
|
aes_encryptblock(out, in);
|
2015-10-07 19:39:06 +02:00
|
|
|
out = (char *)out + AES_BLOCK_SIZE;
|
2015-06-22 14:42:37 +02:00
|
|
|
}
|
|
|
|
else if (size == AES_BLOCK_SIZE)
|
|
|
|
{
|
|
|
|
aes_encryptblock(out, in);
|
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
|
|
|
aes_encryptblock(NULL, in);
|
|
|
|
}
|
|
|
|
|
2015-10-07 19:39:06 +02:00
|
|
|
in = (char *)in + AES_BLOCK_SIZE;
|
2014-07-03 15:26:44 +02:00
|
|
|
size -= AES_BLOCK_SIZE;
|
|
|
|
}
|
|
|
|
|
|
|
|
aes_unlock();
|
|
|
|
return res;
|
|
|
|
}
|
|
|
|
|
|
|
|
int up_aesinitialize()
|
|
|
|
{
|
|
|
|
sem_init(&lock, 0, 1);
|
|
|
|
sam_aes_enableclk();
|
|
|
|
putreg32(AES_CR_SWRST, SAM_AES_CR);
|
|
|
|
return OK;
|
2014-07-04 02:35:08 +02:00
|
|
|
}
|