[ifxmips]:
[openwrt/svn-archive/archive.git] / target / linux / ifxmips / files / drivers / crypto / ifxmips / ifxmips_deu_danube.c
diff --git a/target/linux/ifxmips/files/drivers/crypto/ifxmips/ifxmips_deu_danube.c b/target/linux/ifxmips/files/drivers/crypto/ifxmips/ifxmips_deu_danube.c
new file mode 100755 (executable)
index 0000000..a8cf8a5
--- /dev/null
@@ -0,0 +1,443 @@
+/*
+ *   This program 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.
+ *
+ *   This program 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., 59 Temple Place, Suite 330, Boston, MA 02111-1307, USA.
+ *
+ *   Copyright (C) 2010 Ralph Hempel <ralph.hempel@lantiq.com>
+ *   Copyright (C) 2009 Mohammad Firdaus
+ */
+
+/*!
+  \defgroup IFX_DEU IFX_DEU_DRIVERS
+  \ingroup API
+  \brief deu driver module
+*/
+
+/*!
+  \file        ifxmips_deu_danube.c
+  \ingroup IFX_DEU
+  \brief board specific deu driver file for danube
+*/
+
+/*!
+  \defgroup BOARD_SPECIFIC_FUNCTIONS IFX_BOARD_SPECIFIC_FUNCTIONS
+  \ingroup IFX_DEU
+  \brief board specific deu functions
+*/
+
+/* Project header files */
+#include <linux/module.h>
+#include <linux/init.h>
+#include <linux/types.h>
+#include <linux/errno.h>
+#include <asm/io.h> //dma_cache_inv
+#include "ifxmips_deu.h"
+
+#ifdef CONFIG_CRYPTO_DEV_IFXMIPS_DMA
+u32 *des_buff_in = NULL;
+u32 *des_buff_out = NULL;
+u32 *aes_buff_in = NULL;
+u32 *aes_buff_out = NULL;
+_ifx_deu_device ifx_deu[1];
+#endif
+
+/* Function Declerations */
+int aes_memory_allocate(int value);
+int des_memory_allocate(int value);
+void memory_release(u32 *addr);
+int aes_chip_init (void);
+void des_chip_init (void);
+int deu_dma_init (void);
+u32 endian_swap(u32 input);
+u32* memory_alignment(const u8 *arg, u32 *buff_alloc, int in_out, int nbytes);
+void dma_memory_copy(u32 *outcopy, u32 *out_dma, u8 *out_arg, int nbytes);
+void __exit ifxdeu_fini_dma(void);
+
+#define DES_3DES_START  IFX_DES_CON
+#define AES_START       IFX_AES_CON
+
+/* Variables definition */
+int ifx_danube_pre_1_4;
+u8 *g_dma_page_ptr = NULL;
+u8 *g_dma_block = NULL;
+u8 *g_dma_block2 = NULL;
+
+
+/*! \fn int deu_dma_init (void)
+ *  \ingroup BOARD_SPECIFIC_FUNCTIONS
+ *  \brief Initialize DMA for DEU usage. DMA specific registers are
+ *         intialized here, including a pointer to the device, memory
+ *         space for the device and DEU-DMA descriptors
+ *  \return -1 if fail, otherwise return 0
+*/
+
+#ifdef CONFIG_CRYPTO_DEV_IFXMIPS_DMA
+int deu_dma_init (void)
+{
+    struct dma_device_info *dma_device = NULL;
+    int i = 0;
+    volatile struct deu_dma_t *dma = (struct deu_dma_t *) IFX_DEU_DMA_CON;
+    struct dma_device_info *deu_dma_device_ptr;
+
+    // get one free page and share between g_dma_block and g_dma_block2
+    printk("PAGE_SIZE = %ld\n", PAGE_SIZE);
+    g_dma_page_ptr = (u8 *)__get_free_page(GFP_KERNEL); // need 16-byte alignment memory block
+    g_dma_block = g_dma_page_ptr; // need 16-byte alignment memory block
+    g_dma_block2 = (u8 *)(g_dma_page_ptr + (PAGE_SIZE >> 1)); // need 16-byte alignment memory block
+
+
+    deu_dma_device_ptr = dma_device_reserve ("DEU");
+    if (!deu_dma_device_ptr) {
+        printk ("DEU: reserve DMA fail!\n");
+        return -1;
+    }
+    ifx_deu[0].dma_device = deu_dma_device_ptr;
+    dma_device = deu_dma_device_ptr;
+    //dma_device->priv = &deu_dma_priv;
+    dma_device->buffer_alloc = &deu_dma_buffer_alloc;
+    dma_device->buffer_free = &deu_dma_buffer_free;
+    dma_device->intr_handler = &deu_dma_intr_handler;
+    dma_device->tx_endianness_mode = IFX_DMA_ENDIAN_TYPE3;
+    dma_device->rx_endianness_mode = IFX_DMA_ENDIAN_TYPE3;
+    dma_device->port_num = 1;
+    dma_device->tx_burst_len = 4;
+    dma_device->max_rx_chan_num = 1;
+    dma_device->max_tx_chan_num = 1;
+    dma_device->port_packet_drop_enable = 0;
+
+    for (i = 0; i < dma_device->max_rx_chan_num; i++) {
+        dma_device->rx_chan[i]->packet_size = DEU_MAX_PACKET_SIZE;
+        dma_device->rx_chan[i]->desc_len = 1;
+        dma_device->rx_chan[i]->control = IFX_DMA_CH_ON;
+        dma_device->rx_chan[i]->byte_offset = 0;
+        dma_device->rx_chan[i]->chan_poll_enable = 1;
+
+    }
+
+    for (i = 0; i < dma_device->max_tx_chan_num; i++) {
+        dma_device->tx_chan[i]->control = IFX_DMA_CH_ON;
+        dma_device->tx_chan[i]->desc_len = 1;
+        dma_device->tx_chan[i]->chan_poll_enable = 1;
+    }
+
+    dma_device->current_tx_chan = 0;
+    dma_device->current_rx_chan = 0;
+
+    dma_device_register (dma_device);
+    for (i = 0; i < dma_device->max_rx_chan_num; i++) {
+        (dma_device->rx_chan[i])->open (dma_device->rx_chan[i]);
+    }
+
+    dma->controlr.BS = 0;
+    dma->controlr.RXCLS = 0;
+    dma->controlr.EN = 1;
+
+
+    *IFX_DMA_PS = 1;
+
+    /* DANUBE PRE 1.4 SOFTWARE FIX */
+    if (ifx_danube_pre_1_4)
+        *IFX_DMA_PCTRL = 0x14;
+    else
+        *IFX_DMA_PCTRL = 0xF14;
+
+    return 0;
+}
+
+/*! \fn u32 *memory_alignment(const u8 *arg, u32 *buffer_alloc, int in_buff, int nbytes)
+ *  \ingroup BOARD_SPECIFIC_FUNCTIONS
+ *  \brief  A fix to align mis-aligned address for Danube version 1.3 chips which has
+ *          memory alignment issues.
+ *  \param arg Pointer to the input / output memory address
+ *  \param buffer_alloc A pointer to the buffer
+ *  \param in_buff Input (if == 1) or Output (if == 0) buffer
+ *  \param nbytes Number of bytes of data
+ *  \return returns arg: if address is aligned, buffer_alloc: if memory address is not aligned
+*/
+
+u32 *memory_alignment(const u8 *arg, u32 *buffer_alloc, int in_buff, int nbytes)
+{
+    if (ifx_danube_pre_1_4) {
+    /* for input buffer */
+        if(in_buff) {
+            if (((u32) arg) & 0xF) {
+                memcpy(buffer_alloc, arg, nbytes);
+                return (u32 *) buffer_alloc;
+            }
+            else
+                return (u32 *) arg;
+        }
+        else {
+    /* for output buffer */
+            if (((u32) arg) & 0x3)
+                return buffer_alloc;
+            else
+                return (u32 *) arg;
+        }
+    }
+
+   return (u32 *) arg;
+}
+
+/*! \fn  void aes_dma_memory_copy(u32 *outcopy, u32 *out_dma, u8 *out_arg, int nbytes)
+ *  \ingroup BOARD_SPECIFIC_FUNCTIONS
+ *  \brief copy the DMA data to the memory address space for AES. The swaping of the 4 bytes
+ *         is done only for Danube version 1.3 (FIX). Otherwise, it is a direct memory copy
+ *         to out_arg pointer
+ *  \param outcopy Pointer to the address to store swapped copy
+ *  \param out_dma A pointer to the memory address that stores the DMA data
+ *  \param out_arg The pointer to the memory address that needs to be copied to
+ *  \param nbytes Number of bytes of data
+*/
+
+void aes_dma_memory_copy(u32 *outcopy, u32 *out_dma, u8 *out_arg, int nbytes)
+{
+    int i = 0;
+    int x = 0;
+
+    /* DANUBE PRE 1.4 SOFTWARE FIX */
+    if (ifx_danube_pre_1_4) {
+        for (i = 0; i < (nbytes / 4); i++) {
+           x = i ^ 0x3;
+           outcopy[i] = out_dma[x];
+
+        }
+        if (((u32) out_arg) & 0x3) {
+            memcpy((u8 *)out_arg, outcopy, nbytes);
+        }
+    }
+    else
+        memcpy (out_arg, out_dma, nbytes);
+}
+
+/*! \fn void des_dma_memory_copy(u32 *outcopy, u32 *out_dma, u8 *out_arg, int nbytes)
+ *  \ingroup BOARD_SPECIFIC_FUNCTIONS
+ *  \brief copy the DMA data to the memory address space for DES. The swaping of the 4 bytes
+ *         is done only for Danube version 1.3 (FIX). Otherwise, it is a direct memory copy
+ *         to out_arg pointer
+ *
+ *  \param outcopy Pointer to the address to store swapped copy
+ *  \param out_dma A pointer to the memory address that stores the DMA data
+ *  \param out_arg The pointer to the memory address that needs to be copied to
+ *  \param nbytes Number of bytes of data
+*/
+
+void des_dma_memory_copy(u32 *outcopy, u32 *out_dma, u8 *out_arg, int nbytes)
+{
+    int i = 0;
+    int x = 0;
+
+    /* DANUBE PRE 1.4 SOFTWARE FIX */
+    if (ifx_danube_pre_1_4) {
+        for (i = 0; i < (nbytes / 4); i++) {
+           x = i ^ 1;
+           outcopy[i] = out_dma[x];
+
+        }
+        if (((u32) out_arg) & 0x3) {
+            memcpy((u8 *)out_arg, outcopy, nbytes);
+        }
+    }
+    else
+        memcpy (out_arg, out_dma, nbytes);
+}
+
+/*! \fn int des_memory_allocate(int value)
+ *  \ingroup BOARD_SPECIFIC_FUNCTIONS
+ *  \brief allocates memory to the necessary memory input/output buffer location, used during
+ *          the DES algorithm DMA transfer (memory alignment issues)
+ *  \param  value value determinds whether the calling of the function is for a input buffer
+ *                or for an output buffer memory allocation
+*/
+
+int des_memory_allocate(int value)
+{
+    if (ifx_danube_pre_1_4) {
+        if (value == BUFFER_IN) {
+            des_buff_in = kmalloc(DEU_MAX_PACKET_SIZE, GFP_ATOMIC);
+            if (!des_buff_in)
+                return -1;
+            else
+                return 0;
+        }
+        else {
+            des_buff_out = kmalloc(DEU_MAX_PACKET_SIZE, GFP_ATOMIC);
+            if (!des_buff_out)
+                return -1;
+            else
+               return 0;
+        }
+    }
+
+    else
+        return 0;
+}
+
+/*! \fn int aes_memory_allocate(int value)
+ *  \ingroup BOARD_SPECIFIC_FUNCTIONS
+ *  \brief allocates memory to the necessary memory input/output buffer location, used during
+ *        the AES algorithm DMA transfer (memory alignment issues)
+ *  \param value value determinds whether the calling of the function is for a input buffer
+ *               or for an output buffer memory allocation
+*/
+
+int aes_memory_allocate(int value)
+{
+    if (ifx_danube_pre_1_4) {
+        if (value == BUFFER_IN) {
+            aes_buff_in = kmalloc(DEU_MAX_PACKET_SIZE, GFP_ATOMIC);
+            if (!aes_buff_in)
+                return -1;
+            else
+                return 0;
+        }
+        else {
+            aes_buff_out = kmalloc(DEU_MAX_PACKET_SIZE, GFP_ATOMIC);
+            if (!aes_buff_out)
+                return -1;
+            else
+               return 0;
+        }
+    }
+
+    else
+        return 0;
+}
+
+/*! \fn void memory_release(u32 *addr)
+ *  \ingroup BOARD_SPECIFIC_FUNCTIONS
+ *  \brief frees previously allocated memory
+ *  \param addr memory address of the buffer that needs to be freed
+*/
+
+void memory_release(u32 *addr)
+{
+    if (addr)
+        kfree(addr);
+    return;
+}
+
+/*! \fn        __exit ifxdeu_fini_dma(void)
+ *  \ingroup BOARD_SPECIFIC_FUNCTIONS
+ *  \brief unregister dma devices after exit
+*/
+
+void __exit ifxdeu_fini_dma(void)
+{
+    if (g_dma_page_ptr)
+        free_page((u32) g_dma_page_ptr);
+    dma_device_release(ifx_deu[0].dma_device);
+    dma_device_unregister(ifx_deu[0].dma_device);
+
+}
+
+#endif /* CONFIG_CRYPTO_DEV_IFXMIPS_DMA */
+
+/*! \fn u32 endian_swap(u32 input)
+ *  \ingroup BOARD_SPECIFIC_FUNCTIONS
+ *  \brief function is not used
+ *  \param input Data input to be swapped
+ *  \return input
+*/
+
+u32 endian_swap(u32 input)
+{
+    return input;
+}
+
+/*! \fn        u32 input_swap(u32 input)
+ *  \ingroup BOARD_SPECIFIC_FUNCTIONS
+ *  \brief Swap the input data if the current chip is Danube version
+ *         1.4 and do nothing to the data if the current chip is
+ *         Danube version 1.3
+ *  \param input data that needs to be swapped
+ *  \return input or swapped input
+*/
+
+u32 input_swap(u32 input)
+{
+    if (!ifx_danube_pre_1_4) {
+        u8 *ptr = (u8 *)&input;
+        return ((ptr[3] << 24) | (ptr[2] << 16) | (ptr[1] << 8) | ptr[0]);
+    }
+    else
+        return input;
+}
+
+
+
+/*! \fn void aes_chip_init (void)
+ *  \ingroup BOARD_SPECIFIC_FUNCTIONS
+ * \brief initialize AES hardware
+*/
+
+int aes_chip_init (void)
+{
+    volatile struct aes_t *aes = (struct aes_t *) AES_START;
+
+#ifndef CONFIG_CRYPTO_DEV_IFXMIPS_DMA
+    //start crypto engine with write to ILR
+    aes->controlr.SM = 1;
+    aes->controlr.ARS = 1;
+#else
+    aes->controlr.SM = 1;
+    aes->controlr.ARS = 1; // 0 for dma
+#endif
+    return 0;
+}
+
+/*! \fn void des_chip_init (void)
+ *  \ingroup BOARD_SPECIFIC_FUNCTIONS
+ *  \brief initialize DES hardware
+*/
+
+void des_chip_init (void)
+{
+        volatile struct des_t *des = (struct des_t *) DES_3DES_START;
+
+#ifndef CONFIG_CRYPTO_DEV_IFXMIPS_DMA
+        // start crypto engine with write to ILR
+        des->controlr.SM = 1;
+        des->controlr.ARS = 1;
+#else
+        des->controlr.SM = 1;
+        des->controlr.ARS = 1; // 0 for dma
+
+#endif
+}
+
+/*! \fn void chip_version (void)
+ *  \ingroup IFX_DES_FUNCTIONS
+ *  \brief To find the version of the chip by looking at the chip ID
+ *  \param ifx_danube_pre_1_4 (sets to 1 if Chip is Danube less than v1.4)
+*/
+
+void chip_version(void)
+{
+    /* DANUBE PRE 1.4 SOFTWARE FIX */
+    int chip_id = 0;
+    chip_id = *IFX_MPS_CHIPID;
+    chip_id >>= 28;
+
+    if (chip_id >= 4) {
+        ifx_danube_pre_1_4 = 0;
+        printk("Danube Chip ver. 1.4 detected. \n");
+    }
+    else {
+        ifx_danube_pre_1_4 = 1;
+        printk("Danube Chip ver. 1.3 or below detected. \n");
+    }
+
+    return;
+}
+