SAM4 AES driver from Max Neklyudov

5 files changed, 435 insertions, 2 deletions

diff --git a/nuttx/arch/arm/src/sam34/Kconfig b/nuttx/arch/arm/src/sam34/Kconfig
index c5b4c839d..d813016ad 100644
--- a/nuttx/arch/arm/src/sam34/Kconfig
+++ b/nuttx/arch/arm/src/sam34/Kconfig
@@ -279,9 +279,9 @@ config SAM34_ADC12B
 	depends on !ARCH_CHIP_SAM4E
 
 config SAM34_AES
-	bool "AES"
+	bool "Advanced Encryption Standard (AES)"
 	default n
-	depends on ARCH_CHIP_SAM4E
+	depends on ARCH_CHIP_SAM4CM || ARCH_CHIP_SAM4E
 
 config SAM34_AESA
 	bool "Advanced Encryption Standard (AESA)"
diff --git a/nuttx/arch/arm/src/sam34/Make.defs b/nuttx/arch/arm/src/sam34/Make.defs
index 28bb3f69e..622f5ab8c 100644
--- a/nuttx/arch/arm/src/sam34/Make.defs
+++ b/nuttx/arch/arm/src/sam34/Make.defs
@@ -134,6 +134,10 @@ CHIP_CSRCS += sam_spi.c
 endif
 endif
 
+ifeq ($(CONFIG_SAM34_AES),y)
+CHIP_CSRCS += sam_aes.c
+endif
+
 ifeq ($(CONFIG_SAM34_RTC),y)
 CHIP_CSRCS += sam_rtc.c
 endif
diff --git a/nuttx/arch/arm/src/sam34/chip/sam4cm_aes.h b/nuttx/arch/arm/src/sam34/chip/sam4cm_aes.h
new file mode 100644
index 000000000..051318dd1
--- /dev/null
+++ b/nuttx/arch/arm/src/sam34/chip/sam4cm_aes.h
@@ -0,0 +1,139 @@
+/********************************************************************************************
+ * arch/arm/src/sam34/chip/sam4cm_aes.h
+ * AES hardware accelerator for SAM4CM
+ *
+ *   Copyright (C) 2014 Gregory Nutt. All rights reserved.
+ *   Author: Gregory Nutt <gnutt@nuttx.org>
+ *
+ * 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.
+ *
+ ********************************************************************************************/
+
+#ifndef __ARCH_ARM_SRC_SAM34_CHIP_SAM4CM_AES_H
+#define __ARCH_ARM_SRC_SAM34_CHIP_SAM4CM_AES_H
+
+/********************************************************************************************
+ * Included Files
+ ********************************************************************************************/
+
+#include <nuttx/config.h>
+
+#include "chip.h"
+#include "chip/sam_memorymap.h"
+
+/********************************************************************************************
+ * Pre-processor Definitions
+ ********************************************************************************************/
+
+/* AES register offsets *********************************************************************/
+
+#define SAM_AES_CR_OFFSET                0x0000 /* Control Register */
+#define SAM_AES_MR_OFFSET                0x0004 /* Control Register */
+#define SAM_AES_IER_OFFSET               0x0010 /* Interrupt Enable Register */
+#define SAM_AES_IDR_OFFSET               0x0014 /* Interrupt Disable Register */
+#define SAM_AES_IMR_OFFSET               0x0018 /* Interrupt Mask Register */
+#define SAM_AES_ISR_OFFSET               0x001C /* Interrupt Status Register */
+#define SAM_AES_KEYWR_OFFSET             0x0020 /* Key Word Register */
+#define SAM_AES_IDATAR_OFFSET            0x0040 /* Input Data Register */
+#define SAM_AES_ODATAR_OFFSET            0x0050 /* Output Data Register */
+#define SAM_AES_IVR_OFFSET               0x0060 /* Initialization Vector Register */
+#define SAM_AES_AADLENR_OFFSET           0x0070 /* Additional Authenticated Data Length Register */
+#define SAM_AES_CLENR_OFFSET             0x0074 /* Plaintext/Ciphertext Length Register */
+#define SAM_AES_GHASHR_OFFSET            0x0078 /* GCM Intermediate Hash Word Register */
+#define SAM_AES_TAGR_OFFSET              0x0088 /* GCM Authentication Tag Word Register */
+#define SAM_AES_CTRR_OFFSET              0x0098 /* GCM Encryption Counter Value Register */
+#define SAM_AES_GCMHR_OFFSET             0x009C /* GCM H World Register */
+
+/* AES register addresses *******************************************************************/
+
+#define SAM_AES_CR                       (SAM_AES_BASE + SAM_AES_CR_OFFSET)
+#define SAM_AES_MR                       (SAM_AES_BASE + SAM_AES_MR_OFFSET)
+#define SAM_AES_IER                      (SAM_AES_BASE + SAM_AES_IER_OFFSET)
+#define SAM_AES_IDR                      (SAM_AES_BASE + SAM_AES_IDR_OFFSET)
+#define SAM_AES_IMR                      (SAM_AES_BASE + SAM_AES_IMR_OFFSET)
+#define SAM_AES_ISR                      (SAM_AES_BASE + SAM_AES_ISR_OFFSET)
+#define SAM_AES_KEYWR                    (SAM_AES_BASE + SAM_AES_KEYWR_OFFSET)
+#define SAM_AES_IDATAR                   (SAM_AES_BASE + SAM_AES_IDATAR_OFFSET)
+#define SAM_AES_ODATAR                   (SAM_AES_BASE + SAM_AES_ODATAR_OFFSET)
+#define SAM_AES_IVR                      (SAM_AES_BASE + SAM_AES_IVR_OFFSET)
+#define SAM_AES_AADLENR                  (SAM_AES_BASE + SAM_AES_AADLENR_OFFSET)
+#define SAM_AES_CLENR                    (SAM_AES_BASE + SAM_AES_CLENR_OFFSET)
+#define SAM_AES_GHASHR                   (SAM_AES_BASE + SAM_AES_GHASHR_OFFSET)
+#define SAM_AES_TAGR                     (SAM_AES_BASE + SAM_AES_TAGR_OFFSET)
+#define SAM_AES_CTRR                     (SAM_AES_BASE + SAM_AES_CTRR_OFFSET)
+#define SAM_AES_GCMHR                    (SAM_AES_BASE + SAM_AES_GCMHR_OFFSET)
+
+/* AES register bit definitions *************************************************************/
+
+/* AES Control Register */
+
+#define AES_CR_START                     (1 << 0) /* Start Processing */
+#define AES_CR_SWRST                     (1 << 8) /* Software Reset */
+
+/* AES Mode Register */
+
+#define AES_MR_CIPHER_OFSET              (0)
+#define AES_MR_CIPHER_MASK               (0x1 << AES_MR_CIPHER_OFSET)
+#  define AES_MR_CIPHER_DECRYPT          (0 << AES_MR_CIPHER_OFSET)
+#  define AES_MR_CIPHER_ENCRYPT          (1 << AES_MR_CIPHER_OFSET)
+#define AES_MR_GTAGEN                    (1 << 1)                     /* GCM Automatic Tag Generation Enable */
+#define AES_MR_DUALBUFF                  (1 << 3)                     /* Dual Input Buffer (requires SMOD = 0x2) */
+#define AES_MR_PROCDLY(n)                ((n) << 4)                   /* Processing Time = 12 × ( PROCDLY + 1 ) */
+#define AES_MR_SMOD_OFSET                (8)
+#define AES_MR_SMOD_MASK                 (0x3 << AES_MR_SMOD_OFSET)
+#  define AES_MR_SMOD_MANUAL_START       (0 << AES_MR_SMOD_OFSET)     /* Manual Mode */
+#  define AES_MR_SMOD_AUTO_START         (1 << AES_MR_SMOD_OFSET)     /* Auto Mode */
+#  define AES_MR_SMOD_IDATAR0_START      (2 << AES_MR_SMOD_OFSET)     /* AES_IDATAR0 access only Auto Mode */
+#define AES_MR_KEYSIZE_OFFSET            (10)
+#define AES_MR_KEYSIZE_MASK              (0x3 << AES_MR_KEYSIZE_OFFSET)
+#  define AES_MR_KEYSIZE_AES128          (0 << AES_MR_KEYSIZE_OFFSET) /* AES Key Size is 128 bits */
+#  define AES_MR_KEYSIZE_AES192          (1 << AES_MR_KEYSIZE_OFFSET) /* AES Key Size is 192 bits */
+#  define AES_MR_KEYSIZE_AES256          (2 << AES_MR_KEYSIZE_OFFSET) /* AES Key Size is 256 bits */
+#define AES_MR_OPMOD_OFFSET              (12)
+#define AES_MR_OPMOD_MASK                (0x7 << AES_MR_OPMOD_OFFSET)
+#  define AES_MR_OPMOD_ECB               (0 << AES_MR_OPMOD_OFFSET)
+#  define AES_MR_OPMOD_CBC               (1 << AES_MR_OPMOD_OFFSET)
+#  define AES_MR_OPMOD_OFB               (2 << AES_MR_OPMOD_OFFSET)
+#  define AES_MR_OPMOD_CFB               (3 << AES_MR_OPMOD_OFFSET)
+#  define AES_MR_OPMOD_CTR               (4 << AES_MR_OPMOD_OFFSET)
+#  define AES_MR_OPMOD_GCM               (5 << AES_MR_OPMOD_OFFSET)
+#define AES_MR_LOD                       (1 << 15)                    /* Last Output Data Mode */
+#define AES_MR_CFBS_OFFSET               (16)                         /* Cipher Feedback Data Size */
+#define AES_MR_CFBS_MASK                 (0x7 << AES_MR_CFBS_OFFSET)
+#  define AES_MR_CFBS_SIZE_128BIT        (0 << AES_MR_CFBS_OFFSET)
+#  define AES_MR_CFBS_SIZE_64BIT         (1 << AES_MR_CFBS_OFFSET)
+#  define AES_MR_CFBS_SIZE_32BIT         (2 << AES_MR_CFBS_OFFSET)
+#  define AES_MR_CFBS_SIZE_16BIT         (3 << AES_MR_CFBS_OFFSET)
+#  define AES_MR_CFBS_SIZE_8BIT          (4 << AES_MR_CFBS_OFFSET)
+#define AES_MR_CKEY                      (0xE << 20)
+
+/* AES Interrupt Status Register */
+
+#define AES_ISR_DATRDY                   (1 << 0)
+
+#endif /* __ARCH_ARM_SRC_SAM34_CHIP_SAM4CM_AES_H */
diff --git a/nuttx/arch/arm/src/sam34/sam_aes.c b/nuttx/arch/arm/src/sam34/sam_aes.c
new file mode 100644
index 000000000..12aa0cb69
--- /dev/null
+++ b/nuttx/arch/arm/src/sam34/sam_aes.c
@@ -0,0 +1,223 @@
+/****************************************************************************
+ * arch/arm/src/sam34/sam_aes.c
+ *
+ *   Copyright (C) 2014 Gregory Nutt. All rights reserved.
+ *   Authors: Gregory Nutt <gnutt@nuttx.org>
+ *            Diego Sanchez <dsanchez@nx-engineering.com>
+ *
+ * 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>
+#include <errno.h>
+#include <debug.h>
+#include <semaphore.h>
+#include <crypto/crypto.h>
+
+#include <arch/board/board.h>
+#include <nuttx/arch.h>
+
+#include "up_internal.h"
+#include "up_arch.h"
+
+#include "chip.h"
+#include "sam_periphclks.h"
+#include "sam_aes.h"
+
+/****************************************************************************
+ * Pre-processor Definitions
+ ****************************************************************************/
+
+#define CONFIG_DEBUG_CRYPTO
+
+#ifdef CONFIG_DEBUG_CRYPTO
+#  define cryptdbg lldbg
+#  ifdef CONFIG_DEBUG_VERBOSE
+#    define cryptvdbg lldbg
+#  else
+#    define cryptvdbg(x...)
+#  endif
+#else
+#  define cryptdbg(x...)
+#  define cryptvdbg(x...)
+#endif
+
+#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;
+  for (i = 0; i < wcount; i++, out = (uint8_t*)out + 4, in = (uint8_t*)in + 4)
+    {
+      *(uint32_t*)out = *(uint32_t*)in;
+    }
+}
+
+static void aes_encryptblock(void *out, const void *in)
+{
+  aes_memcpy((void*)SAM_AES_IDATAR, in, AES_BLOCK_SIZE);
+
+  putreg32(AES_CR_START, SAM_AES_CR);
+
+  while(!(getreg32(SAM_AES_ISR) & AES_ISR_DATRDY)) {}
+
+  aes_memcpy(out, (void*)SAM_AES_ODATAR, AES_BLOCK_SIZE);
+}
+
+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)
+    regval |= AES_MR_CIPHER_ENCRYPT;
+  else
+    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;
+  default:
+    return -EINVAL;
+  }
+
+  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)
+    return -EINVAL;
+
+  aes_lock();
+
+  res = aes_setup_mr(keysize, mode, encrypt);
+  if (res)
+    {
+      aes_unlock();
+      return res;
+    }
+
+  aes_memcpy((void*)SAM_AES_KEYWR, key, keysize);
+  if (iv)
+    {
+      aes_memcpy((void*)SAM_AES_IVR, iv, AES_BLOCK_SIZE);
+    }
+
+  while (size)
+    {
+      aes_encryptblock(out, in);
+      out = (char*)out + AES_BLOCK_SIZE;
+      in  = (char*)in  + AES_BLOCK_SIZE;
+      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;
+}
\ No newline at end of file
diff --git a/nuttx/arch/arm/src/sam34/sam_aes.h b/nuttx/arch/arm/src/sam34/sam_aes.h
new file mode 100644
index 000000000..b582f44b1
--- /dev/null
+++ b/nuttx/arch/arm/src/sam34/sam_aes.h
@@ -0,0 +1,67 @@
+/************************************************************************************
+ * arch/arm/src/sam34/sam4cm_aes.h
+ *
+ *   Copyright (C) 2014 Gregory Nutt. All rights reserved.
+ *   Author: Gregory Nutt <gnutt@nuttx.org>
+ *
+ * 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.
+ *
+ ************************************************************************************/
+
+#ifndef __ARCH_ARM_SRC_SAM34_SAM_AES_H
+#define __ARCH_ARM_SRC_SAM34_SAM_AES_H
+
+/************************************************************************************
+ * Included Files
+ ************************************************************************************/
+
+#include <nuttx/config.h>
+
+#include <stdint.h>
+
+#include "chip.h"
+
+#ifdef CONFIG_ARCH_CHIP_SAM4CM
+#  include "chip/sam4cm_aes.h"
+#else
+#  error "Unknown chip for AES"
+#endif
+
+/************************************************************************************
+ * Definitions
+ ************************************************************************************/
+
+/************************************************************************************
+ * Public Types
+ ************************************************************************************/
+
+/************************************************************************************
+ * Inline Functions
+ ************************************************************************************/
+
+#endif /* __ARCH_ARM_SRC_SAM34_SAM_AES_H */
\ No newline at end of file