mirror of
git://projects.qi-hardware.com/openwrt-xburst.git
synced 2024-11-16 19:54:04 +02:00
[lantiq] add ltq-deu
git-svn-id: svn://svn.openwrt.org/openwrt/trunk@34689 3c298f89-4303-0410-b956-a3cf2f4a3e73
This commit is contained in:
parent
1742d60189
commit
d03a7228e9
49
package/platform/lantiq/ltq-deu/Makefile
Normal file
49
package/platform/lantiq/ltq-deu/Makefile
Normal file
@ -0,0 +1,49 @@
|
||||
# Copyright (C) 2012 OpenWrt.org
|
||||
#
|
||||
# This is free software, licensed under the GNU General Public License v2.
|
||||
# See /LICENSE for more information.
|
||||
|
||||
include $(TOPDIR)/rules.mk
|
||||
include $(INCLUDE_DIR)/kernel.mk
|
||||
|
||||
PKG_NAME:=ltq-deu
|
||||
PKG_RELEASE:=1
|
||||
PKG_BUILD_DIR:=$(KERNEL_BUILD_DIR)/ltq-deu-$(BUILD_VARIANT)
|
||||
|
||||
PKG_MAINTAINER:=John Crispin <blogic@openwrt.org>
|
||||
|
||||
include $(INCLUDE_DIR)/package.mk
|
||||
|
||||
define KernelPackage/ltq-deu-template
|
||||
SECTION:=sys
|
||||
CATEGORY:=Kernel modules
|
||||
SUBMENU:=Cryptographic API modules
|
||||
TITLE:=deu driver for $(1)
|
||||
URL:=http://www.lantiq.com/
|
||||
VARIANT:=$(1)
|
||||
DEPENDS:=@TARGET_lantiq_xway
|
||||
FILES:=$(PKG_BUILD_DIR)/ltq_deu_$(1).ko $(PKG_BUILD_DIR)/ltq_deu_testmgr.ko
|
||||
AUTOLOAD:=$(call AutoLoad,52,ltq_deu_$(1))
|
||||
endef
|
||||
|
||||
KernelPackage/ltq-deu-danube=$(call KernelPackage/ltq-deu-template,danube)
|
||||
KernelPackage/ltq-deu-ar9=$(call KernelPackage/ltq-deu-template,ar9)
|
||||
KernelPackage/ltq-deu-vr9=$(call KernelPackage/ltq-deu-template,vr9)
|
||||
|
||||
define Build/Prepare
|
||||
$(INSTALL_DIR) $(PKG_BUILD_DIR)
|
||||
$(CP) ./src/* $(PKG_BUILD_DIR)
|
||||
endef
|
||||
|
||||
define Build/Configure
|
||||
endef
|
||||
|
||||
define Build/Compile
|
||||
cd $(LINUX_DIR); \
|
||||
ARCH=mips CROSS_COMPILE="$(KERNEL_CROSS)" \
|
||||
$(MAKE) BUILD_VARIANT=$(BUILD_VARIANT) M=$(PKG_BUILD_DIR) V=1 modules
|
||||
endef
|
||||
|
||||
$(eval $(call KernelPackage,ltq-deu-danube))
|
||||
$(eval $(call KernelPackage,ltq-deu-ar9))
|
||||
$(eval $(call KernelPackage,ltq-deu-vr9))
|
26
package/platform/lantiq/ltq-deu/src/Makefile
Normal file
26
package/platform/lantiq/ltq-deu/src/Makefile
Normal file
@ -0,0 +1,26 @@
|
||||
ifeq ($(BUILD_VARIANT),danube)
|
||||
CFLAGS_MODULE =-DCONFIG_DANUBE -DCONFIG_CRYPTO_DEV_DEU -DCONFIG_CRYPTO_DEV_SPEED_TEST -DCONFIG_CRYPTO_DEV_DES \
|
||||
-DCONFIG_CRYPTO_DEV_AES -DCONFIG_CRYPTO_DEV_SHA1 -DCONFIG_CRYPTO_DEV_MD5
|
||||
obj-m = ltq_deu_danube.o
|
||||
ltq_deu_danube-objs = ifxmips_deu.o ifxmips_deu_danube.o ifxmips_des.o ifxmips_aes.o ifxmips_sha1.o ifxmips_md5.o
|
||||
endif
|
||||
|
||||
ifeq ($(BUILD_VARIANT),ar9)
|
||||
CFLAGS_MODULE = -DCONFIG_AR9 -DCONFIG_CRYPTO_DEV_DEU -DCONFIG_CRYPTO_DEV_SPEED_TEST -DCONFIG_CRYPTO_DEV_DES \
|
||||
-DCONFIG_CRYPTO_DEV_AES -DCONFIG_CRYPTO_DEV_SHA1 -DCONFIG_CRYPTO_DEV_MD5 -DCONFIG_CRYPTO_DEV_ARC4 \
|
||||
-DCONFIG_CRYPTO_DEV_SHA1_HMAC -DCONFIG_CRYPTO_DEV_MD5_HMAC
|
||||
obj-m = ltq_deu_ar9.o
|
||||
ltq_deu_ar9-objs = ifxmips_deu.o ifxmips_deu_ar9.o ifxmips_des.o ifxmips_aes.o ifxmips_arc4.o \
|
||||
ifxmips_sha1.o ifxmips_md5.o ifxmips_sha1_hmac.o ifxmips_md5_hmac.o
|
||||
endif
|
||||
|
||||
ifeq ($(BUILD_VARIANT),vr9)
|
||||
CFLAGS_MODULE = -DCONFIG_VR9 -DCONFIG_CRYPTO_DEV_DEU -DCONFIG_CRYPTO_DEV_SPEED_TEST -DCONFIG_CRYPTO_DEV_DES \
|
||||
-DCONFIG_CRYPTO_DEV_AES -DCONFIG_CRYPTO_DEV_SHA1 -DCONFIG_CRYPTO_DEV_MD5 -DCONFIG_CRYPTO_DEV_ARC4 \
|
||||
-DCONFIG_CRYPTO_DEV_SHA1_HMAC -DCONFIG_CRYPTO_DEV_MD5_HMAC
|
||||
obj-m = ltq_deu_vr9.o
|
||||
ltq_deu_vr9-objs = ifxmips_deu.o ifxmips_deu_vr9.o ifxmips_des.o ifxmips_aes.o ifxmips_arc4.o \
|
||||
ifxmips_sha1.o ifxmips_md5.o ifxmips_sha1_hmac.o ifxmips_md5_hmac.o
|
||||
endif
|
||||
|
||||
obj-m += ltq_deu_testmgr.o
|
904
package/platform/lantiq/ltq-deu/src/ifxmips_aes.c
Normal file
904
package/platform/lantiq/ltq-deu/src/ifxmips_aes.c
Normal file
@ -0,0 +1,904 @@
|
||||
/******************************************************************************
|
||||
**
|
||||
** FILE NAME : ifxmips_aes.c
|
||||
** PROJECT : IFX UEIP
|
||||
** MODULES : DEU Module
|
||||
**
|
||||
** DATE : September 8, 2009
|
||||
** AUTHOR : Mohammad Firdaus
|
||||
** DESCRIPTION : Data Encryption Unit Driver for AES Algorithm
|
||||
** COPYRIGHT : Copyright (c) 2009
|
||||
** Infineon Technologies AG
|
||||
** Am Campeon 1-12, 85579 Neubiberg, Germany
|
||||
**
|
||||
** 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.
|
||||
**
|
||||
** HISTORY
|
||||
** $Date $Author $Comment
|
||||
** 08,Sept 2009 Mohammad Firdaus Initial UEIP release
|
||||
*******************************************************************************/
|
||||
/*!
|
||||
\defgroup IFX_DEU IFX_DEU_DRIVERS
|
||||
\ingroup API
|
||||
\brief ifx DEU driver module
|
||||
*/
|
||||
|
||||
/*!
|
||||
\file ifxmips_aes.c
|
||||
\ingroup IFX_DEU
|
||||
\brief AES Encryption Driver main file
|
||||
*/
|
||||
|
||||
/*!
|
||||
\defgroup IFX_AES_FUNCTIONS IFX_AES_FUNCTIONS
|
||||
\ingroup IFX_DEU
|
||||
\brief IFX AES driver Functions
|
||||
*/
|
||||
|
||||
|
||||
/* Project Header Files */
|
||||
#if defined(CONFIG_MODVERSIONS)
|
||||
#define MODVERSIONS
|
||||
#include <linux/modeversions>
|
||||
#endif
|
||||
|
||||
#include <linux/version.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/init.h>
|
||||
#include <linux/proc_fs.h>
|
||||
#include <linux/fs.h>
|
||||
#include <linux/types.h>
|
||||
#include <linux/errno.h>
|
||||
#include <linux/crypto.h>
|
||||
#include <linux/interrupt.h>
|
||||
#include <linux/delay.h>
|
||||
#include <asm/byteorder.h>
|
||||
#include <crypto/algapi.h>
|
||||
|
||||
#include "ifxmips_deu.h"
|
||||
|
||||
#if defined(CONFIG_DANUBE)
|
||||
#include "ifxmips_deu_danube.h"
|
||||
extern int ifx_danube_pre_1_4;
|
||||
#elif defined(CONFIG_AR9)
|
||||
#include "ifxmips_deu_ar9.h"
|
||||
#elif defined(CONFIG_VR9) || defined(CONFIG_AR10)
|
||||
#include "ifxmips_deu_vr9.h"
|
||||
#else
|
||||
#error "Unkown platform"
|
||||
#endif
|
||||
|
||||
/* DMA related header and variables */
|
||||
|
||||
spinlock_t aes_lock;
|
||||
#define CRTCL_SECT_INIT spin_lock_init(&aes_lock)
|
||||
#define CRTCL_SECT_START spin_lock_irqsave(&aes_lock, flag)
|
||||
#define CRTCL_SECT_END spin_unlock_irqrestore(&aes_lock, flag)
|
||||
|
||||
/* Definition of constants */
|
||||
#define AES_START IFX_AES_CON
|
||||
#define AES_MIN_KEY_SIZE 16
|
||||
#define AES_MAX_KEY_SIZE 32
|
||||
#define AES_BLOCK_SIZE 16
|
||||
#define CTR_RFC3686_NONCE_SIZE 4
|
||||
#define CTR_RFC3686_IV_SIZE 8
|
||||
#define CTR_RFC3686_MAX_KEY_SIZE (AES_MAX_KEY_SIZE + CTR_RFC3686_NONCE_SIZE)
|
||||
|
||||
#ifdef CRYPTO_DEBUG
|
||||
extern char debug_level;
|
||||
#define DPRINTF(level, format, args...) if (level < debug_level) printk(KERN_INFO "[%s %s %d]: " format, __FILE__, __func__, __LINE__, ##args);
|
||||
#else
|
||||
#define DPRINTF(level, format, args...)
|
||||
#endif /* CRYPTO_DEBUG */
|
||||
|
||||
/* Function decleration */
|
||||
int aes_chip_init(void);
|
||||
u32 endian_swap(u32 input);
|
||||
u32 input_swap(u32 input);
|
||||
u32* memory_alignment(const u8 *arg, u32 *buff_alloc, int in_out, int nbytes);
|
||||
void aes_dma_memory_copy(u32 *outcopy, u32 *out_dma, u8 *out_arg, int nbytes);
|
||||
void des_dma_memory_copy(u32 *outcopy, u32 *out_dma, u8 *out_arg, int nbytes);
|
||||
int aes_memory_allocate(int value);
|
||||
int des_memory_allocate(int value);
|
||||
void memory_release(u32 *addr);
|
||||
|
||||
|
||||
extern void ifx_deu_aes (void *ctx_arg, uint8_t *out_arg, const uint8_t *in_arg,
|
||||
uint8_t *iv_arg, size_t nbytes, int encdec, int mode);
|
||||
/* End of function decleration */
|
||||
|
||||
struct aes_ctx {
|
||||
int key_length;
|
||||
u32 buf[AES_MAX_KEY_SIZE];
|
||||
u8 nonce[CTR_RFC3686_NONCE_SIZE];
|
||||
};
|
||||
|
||||
extern int disable_deudma;
|
||||
extern int disable_multiblock;
|
||||
|
||||
/*! \fn int aes_set_key (struct crypto_tfm *tfm, const uint8_t *in_key, unsigned int key_len)
|
||||
* \ingroup IFX_AES_FUNCTIONS
|
||||
* \brief sets the AES keys
|
||||
* \param tfm linux crypto algo transform
|
||||
* \param in_key input key
|
||||
* \param key_len key lengths of 16, 24 and 32 bytes supported
|
||||
* \return -EINVAL - bad key length, 0 - SUCCESS
|
||||
*/
|
||||
int aes_set_key (struct crypto_tfm *tfm, const u8 *in_key, unsigned int key_len)
|
||||
{
|
||||
struct aes_ctx *ctx = crypto_tfm_ctx(tfm);
|
||||
unsigned long *flags = (unsigned long *) &tfm->crt_flags;
|
||||
|
||||
//printk("set_key in %s\n", __FILE__);
|
||||
|
||||
//aes_chip_init();
|
||||
|
||||
if (key_len != 16 && key_len != 24 && key_len != 32) {
|
||||
*flags |= CRYPTO_TFM_RES_BAD_KEY_LEN;
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
ctx->key_length = key_len;
|
||||
DPRINTF(0, "ctx @%p, key_len %d, ctx->key_length %d\n", ctx, key_len, ctx->key_length);
|
||||
memcpy ((u8 *) (ctx->buf), in_key, key_len);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
||||
/*! \fn void ifx_deu_aes (void *ctx_arg, u8 *out_arg, const u8 *in_arg, u8 *iv_arg, size_t nbytes, int encdec, int mode)
|
||||
* \ingroup IFX_AES_FUNCTIONS
|
||||
* \brief main interface to AES hardware
|
||||
* \param ctx_arg crypto algo context
|
||||
* \param out_arg output bytestream
|
||||
* \param in_arg input bytestream
|
||||
* \param iv_arg initialization vector
|
||||
* \param nbytes length of bytestream
|
||||
* \param encdec 1 for encrypt; 0 for decrypt
|
||||
* \param mode operation mode such as ebc, cbc, ctr
|
||||
*
|
||||
*/
|
||||
void ifx_deu_aes (void *ctx_arg, u8 *out_arg, const u8 *in_arg,
|
||||
u8 *iv_arg, size_t nbytes, int encdec, int mode)
|
||||
|
||||
{
|
||||
/*~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~ */
|
||||
volatile struct aes_t *aes = (volatile struct aes_t *) AES_START;
|
||||
struct aes_ctx *ctx = (struct aes_ctx *)ctx_arg;
|
||||
u32 *in_key = ctx->buf;
|
||||
unsigned long flag;
|
||||
/*~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~ */
|
||||
int key_len = ctx->key_length;
|
||||
|
||||
int i = 0;
|
||||
int byte_cnt = nbytes;
|
||||
|
||||
|
||||
CRTCL_SECT_START;
|
||||
/* 128, 192 or 256 bit key length */
|
||||
aes->controlr.K = key_len / 8 - 2;
|
||||
if (key_len == 128 / 8) {
|
||||
aes->K3R = DEU_ENDIAN_SWAP(*((u32 *) in_key + 0));
|
||||
aes->K2R = DEU_ENDIAN_SWAP(*((u32 *) in_key + 1));
|
||||
aes->K1R = DEU_ENDIAN_SWAP(*((u32 *) in_key + 2));
|
||||
aes->K0R = DEU_ENDIAN_SWAP(*((u32 *) in_key + 3));
|
||||
}
|
||||
else if (key_len == 192 / 8) {
|
||||
aes->K5R = DEU_ENDIAN_SWAP(*((u32 *) in_key + 0));
|
||||
aes->K4R = DEU_ENDIAN_SWAP(*((u32 *) in_key + 1));
|
||||
aes->K3R = DEU_ENDIAN_SWAP(*((u32 *) in_key + 2));
|
||||
aes->K2R = DEU_ENDIAN_SWAP(*((u32 *) in_key + 3));
|
||||
aes->K1R = DEU_ENDIAN_SWAP(*((u32 *) in_key + 4));
|
||||
aes->K0R = DEU_ENDIAN_SWAP(*((u32 *) in_key + 5));
|
||||
}
|
||||
else if (key_len == 256 / 8) {
|
||||
aes->K7R = DEU_ENDIAN_SWAP(*((u32 *) in_key + 0));
|
||||
aes->K6R = DEU_ENDIAN_SWAP(*((u32 *) in_key + 1));
|
||||
aes->K5R = DEU_ENDIAN_SWAP(*((u32 *) in_key + 2));
|
||||
aes->K4R = DEU_ENDIAN_SWAP(*((u32 *) in_key + 3));
|
||||
aes->K3R = DEU_ENDIAN_SWAP(*((u32 *) in_key + 4));
|
||||
aes->K2R = DEU_ENDIAN_SWAP(*((u32 *) in_key + 5));
|
||||
aes->K1R = DEU_ENDIAN_SWAP(*((u32 *) in_key + 6));
|
||||
aes->K0R = DEU_ENDIAN_SWAP(*((u32 *) in_key + 7));
|
||||
}
|
||||
else {
|
||||
printk (KERN_ERR "[%s %s %d]: Invalid key_len : %d\n", __FILE__, __func__, __LINE__, key_len);
|
||||
CRTCL_SECT_END;
|
||||
return;// -EINVAL;
|
||||
}
|
||||
|
||||
/* let HW pre-process DEcryption key in any case (even if
|
||||
ENcryption is used). Key Valid (KV) bit is then only
|
||||
checked in decryption routine! */
|
||||
aes->controlr.PNK = 1;
|
||||
|
||||
|
||||
aes->controlr.E_D = !encdec; //encryption
|
||||
aes->controlr.O = mode; //0 ECB 1 CBC 2 OFB 3 CFB 4 CTR
|
||||
|
||||
//aes->controlr.F = 128; //default; only for CFB and OFB modes; change only for customer-specific apps
|
||||
if (mode > 0) {
|
||||
aes->IV3R = DEU_ENDIAN_SWAP(*(u32 *) iv_arg);
|
||||
aes->IV2R = DEU_ENDIAN_SWAP(*((u32 *) iv_arg + 1));
|
||||
aes->IV1R = DEU_ENDIAN_SWAP(*((u32 *) iv_arg + 2));
|
||||
aes->IV0R = DEU_ENDIAN_SWAP(*((u32 *) iv_arg + 3));
|
||||
};
|
||||
|
||||
|
||||
i = 0;
|
||||
while (byte_cnt >= 16) {
|
||||
|
||||
aes->ID3R = INPUT_ENDIAN_SWAP(*((u32 *) in_arg + (i * 4) + 0));
|
||||
aes->ID2R = INPUT_ENDIAN_SWAP(*((u32 *) in_arg + (i * 4) + 1));
|
||||
aes->ID1R = INPUT_ENDIAN_SWAP(*((u32 *) in_arg + (i * 4) + 2));
|
||||
aes->ID0R = INPUT_ENDIAN_SWAP(*((u32 *) in_arg + (i * 4) + 3)); /* start crypto */
|
||||
|
||||
while (aes->controlr.BUS) {
|
||||
// this will not take long
|
||||
}
|
||||
|
||||
*((volatile u32 *) out_arg + (i * 4) + 0) = aes->OD3R;
|
||||
*((volatile u32 *) out_arg + (i * 4) + 1) = aes->OD2R;
|
||||
*((volatile u32 *) out_arg + (i * 4) + 2) = aes->OD1R;
|
||||
*((volatile u32 *) out_arg + (i * 4) + 3) = aes->OD0R;
|
||||
|
||||
i++;
|
||||
byte_cnt -= 16;
|
||||
}
|
||||
|
||||
|
||||
//tc.chen : copy iv_arg back
|
||||
if (mode > 0) {
|
||||
*((u32 *) iv_arg) = DEU_ENDIAN_SWAP(*((u32 *) iv_arg));
|
||||
*((u32 *) iv_arg + 1) = DEU_ENDIAN_SWAP(*((u32 *) iv_arg + 1));
|
||||
*((u32 *) iv_arg + 2) = DEU_ENDIAN_SWAP(*((u32 *) iv_arg + 2));
|
||||
*((u32 *) iv_arg + 3) = DEU_ENDIAN_SWAP(*((u32 *) iv_arg + 3));
|
||||
}
|
||||
|
||||
CRTCL_SECT_END;
|
||||
}
|
||||
|
||||
/*!
|
||||
* \fn int ctr_rfc3686_aes_set_key (struct crypto_tfm *tfm, const uint8_t *in_key, unsigned int key_len)
|
||||
* \ingroup IFX_AES_FUNCTIONS
|
||||
* \brief sets RFC3686 key
|
||||
* \param tfm linux crypto algo transform
|
||||
* \param in_key input key
|
||||
* \param key_len key lengths of 20, 28 and 36 bytes supported; last 4 bytes is nonce
|
||||
* \return 0 - SUCCESS
|
||||
* -EINVAL - bad key length
|
||||
*/
|
||||
int ctr_rfc3686_aes_set_key (struct crypto_tfm *tfm, const uint8_t *in_key, unsigned int key_len)
|
||||
{
|
||||
struct aes_ctx *ctx = crypto_tfm_ctx(tfm);
|
||||
unsigned long *flags = (unsigned long *)&tfm->crt_flags;
|
||||
|
||||
//printk("ctr_rfc3686_aes_set_key in %s\n", __FILE__);
|
||||
|
||||
memcpy(ctx->nonce, in_key + (key_len - CTR_RFC3686_NONCE_SIZE),
|
||||
CTR_RFC3686_NONCE_SIZE);
|
||||
|
||||
key_len -= CTR_RFC3686_NONCE_SIZE; // remove 4 bytes of nonce
|
||||
|
||||
if (key_len != 16 && key_len != 24 && key_len != 32) {
|
||||
*flags |= CRYPTO_TFM_RES_BAD_KEY_LEN;
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
ctx->key_length = key_len;
|
||||
|
||||
memcpy ((u8 *) (ctx->buf), in_key, key_len);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
/*! \fn void ifx_deu_aes (void *ctx_arg, u8 *out_arg, const u8 *in_arg, u8 *iv_arg, u32 nbytes, int encdec, int mode)
|
||||
* \ingroup IFX_AES_FUNCTIONS
|
||||
* \brief main interface with deu hardware in DMA mode
|
||||
* \param ctx_arg crypto algo context
|
||||
* \param out_arg output bytestream
|
||||
* \param in_arg input bytestream
|
||||
* \param iv_arg initialization vector
|
||||
* \param nbytes length of bytestream
|
||||
* \param encdec 1 for encrypt; 0 for decrypt
|
||||
* \param mode operation mode such as ebc, cbc, ctr
|
||||
*/
|
||||
|
||||
|
||||
//definitions from linux/include/crypto.h:
|
||||
//#define CRYPTO_TFM_MODE_ECB 0x00000001
|
||||
//#define CRYPTO_TFM_MODE_CBC 0x00000002
|
||||
//#define CRYPTO_TFM_MODE_CFB 0x00000004
|
||||
//#define CRYPTO_TFM_MODE_CTR 0x00000008
|
||||
//#define CRYPTO_TFM_MODE_OFB 0x00000010 // not even defined
|
||||
//but hardware definition: 0 ECB 1 CBC 2 OFB 3 CFB 4 CTR
|
||||
|
||||
/*! \fn void ifx_deu_aes_ecb (void *ctx, uint8_t *dst, const uint8_t *src, uint8_t *iv, size_t nbytes, int encdec, int inplace)
|
||||
* \ingroup IFX_AES_FUNCTIONS
|
||||
* \brief sets AES hardware to ECB mode
|
||||
* \param ctx crypto algo context
|
||||
* \param dst output bytestream
|
||||
* \param src input bytestream
|
||||
* \param iv initialization vector
|
||||
* \param nbytes length of bytestream
|
||||
* \param encdec 1 for encrypt; 0 for decrypt
|
||||
* \param inplace not used
|
||||
*/
|
||||
void ifx_deu_aes_ecb (void *ctx, uint8_t *dst, const uint8_t *src,
|
||||
uint8_t *iv, size_t nbytes, int encdec, int inplace)
|
||||
{
|
||||
ifx_deu_aes (ctx, dst, src, NULL, nbytes, encdec, 0);
|
||||
}
|
||||
|
||||
/*! \fn void ifx_deu_aes_cbc (void *ctx, uint8_t *dst, const uint8_t *src, uint8_t *iv, size_t nbytes, int encdec, int inplace)
|
||||
* \ingroup IFX_AES_FUNCTIONS
|
||||
* \brief sets AES hardware to CBC mode
|
||||
* \param ctx crypto algo context
|
||||
* \param dst output bytestream
|
||||
* \param src input bytestream
|
||||
* \param iv initialization vector
|
||||
* \param nbytes length of bytestream
|
||||
* \param encdec 1 for encrypt; 0 for decrypt
|
||||
* \param inplace not used
|
||||
*/
|
||||
void ifx_deu_aes_cbc (void *ctx, uint8_t *dst, const uint8_t *src,
|
||||
uint8_t *iv, size_t nbytes, int encdec, int inplace)
|
||||
{
|
||||
ifx_deu_aes (ctx, dst, src, iv, nbytes, encdec, 1);
|
||||
}
|
||||
|
||||
/*! \fn void ifx_deu_aes_ofb (void *ctx, uint8_t *dst, const uint8_t *src, uint8_t *iv, size_t nbytes, int encdec, int inplace)
|
||||
* \ingroup IFX_AES_FUNCTIONS
|
||||
* \brief sets AES hardware to OFB mode
|
||||
* \param ctx crypto algo context
|
||||
* \param dst output bytestream
|
||||
* \param src input bytestream
|
||||
* \param iv initialization vector
|
||||
* \param nbytes length of bytestream
|
||||
* \param encdec 1 for encrypt; 0 for decrypt
|
||||
* \param inplace not used
|
||||
*/
|
||||
void ifx_deu_aes_ofb (void *ctx, uint8_t *dst, const uint8_t *src,
|
||||
uint8_t *iv, size_t nbytes, int encdec, int inplace)
|
||||
{
|
||||
ifx_deu_aes (ctx, dst, src, iv, nbytes, encdec, 2);
|
||||
}
|
||||
|
||||
/*! \fn void ifx_deu_aes_cfb (void *ctx, uint8_t *dst, const uint8_t *src, uint8_t *iv, size_t nbytes, int encdec, int inplace)
|
||||
* \ingroup IFX_AES_FUNCTIONS
|
||||
* \brief sets AES hardware to CFB mode
|
||||
* \param ctx crypto algo context
|
||||
* \param dst output bytestream
|
||||
* \param src input bytestream
|
||||
* \param iv initialization vector
|
||||
* \param nbytes length of bytestream
|
||||
* \param encdec 1 for encrypt; 0 for decrypt
|
||||
* \param inplace not used
|
||||
*/
|
||||
void ifx_deu_aes_cfb (void *ctx, uint8_t *dst, const uint8_t *src,
|
||||
uint8_t *iv, size_t nbytes, int encdec, int inplace)
|
||||
{
|
||||
ifx_deu_aes (ctx, dst, src, iv, nbytes, encdec, 3);
|
||||
}
|
||||
|
||||
/*! \fn void ifx_deu_aes_ctr (void *ctx, uint8_t *dst, const uint8_t *src, uint8_t *iv, size_t nbytes, int encdec, int inplace)
|
||||
* \ingroup IFX_AES_FUNCTIONS
|
||||
* \brief sets AES hardware to CTR mode
|
||||
* \param ctx crypto algo context
|
||||
* \param dst output bytestream
|
||||
* \param src input bytestream
|
||||
* \param iv initialization vector
|
||||
* \param nbytes length of bytestream
|
||||
* \param encdec 1 for encrypt; 0 for decrypt
|
||||
* \param inplace not used
|
||||
*/
|
||||
void ifx_deu_aes_ctr (void *ctx, uint8_t *dst, const uint8_t *src,
|
||||
uint8_t *iv, size_t nbytes, int encdec, int inplace)
|
||||
{
|
||||
ifx_deu_aes (ctx, dst, src, iv, nbytes, encdec, 4);
|
||||
}
|
||||
|
||||
/*! \fn void aes_encrypt (struct crypto_tfm *tfm, uint8_t *out, const uint8_t *in)
|
||||
* \ingroup IFX_AES_FUNCTIONS
|
||||
* \brief encrypt AES_BLOCK_SIZE of data
|
||||
* \param tfm linux crypto algo transform
|
||||
* \param out output bytestream
|
||||
* \param in input bytestream
|
||||
*/
|
||||
void aes_encrypt (struct crypto_tfm *tfm, uint8_t *out, const uint8_t *in)
|
||||
{
|
||||
struct aes_ctx *ctx = crypto_tfm_ctx(tfm);
|
||||
ifx_deu_aes (ctx, out, in, NULL, AES_BLOCK_SIZE,
|
||||
CRYPTO_DIR_ENCRYPT, 0);
|
||||
}
|
||||
|
||||
/*! \fn void aes_decrypt (struct crypto_tfm *tfm, uint8_t *out, const uint8_t *in)
|
||||
* \ingroup IFX_AES_FUNCTIONS
|
||||
* \brief decrypt AES_BLOCK_SIZE of data
|
||||
* \param tfm linux crypto algo transform
|
||||
* \param out output bytestream
|
||||
* \param in input bytestream
|
||||
*/
|
||||
void aes_decrypt (struct crypto_tfm *tfm, uint8_t *out, const uint8_t *in)
|
||||
{
|
||||
struct aes_ctx *ctx = crypto_tfm_ctx(tfm);
|
||||
ifx_deu_aes (ctx, out, in, NULL, AES_BLOCK_SIZE,
|
||||
CRYPTO_DIR_DECRYPT, 0);
|
||||
}
|
||||
|
||||
/*
|
||||
* \brief AES function mappings
|
||||
*/
|
||||
struct crypto_alg ifxdeu_aes_alg = {
|
||||
.cra_name = "aes",
|
||||
.cra_driver_name = "ifxdeu-aes",
|
||||
.cra_flags = CRYPTO_ALG_TYPE_CIPHER,
|
||||
.cra_blocksize = AES_BLOCK_SIZE,
|
||||
.cra_ctxsize = sizeof(struct aes_ctx),
|
||||
.cra_module = THIS_MODULE,
|
||||
.cra_list = LIST_HEAD_INIT(ifxdeu_aes_alg.cra_list),
|
||||
.cra_u = {
|
||||
.cipher = {
|
||||
.cia_min_keysize = AES_MIN_KEY_SIZE,
|
||||
.cia_max_keysize = AES_MAX_KEY_SIZE,
|
||||
.cia_setkey = aes_set_key,
|
||||
.cia_encrypt = aes_encrypt,
|
||||
.cia_decrypt = aes_decrypt,
|
||||
}
|
||||
}
|
||||
};
|
||||
|
||||
/*! \fn int ecb_aes_encrypt(struct blkcipher_desc *desc, struct scatterlist *dst, struct scatterlist *src, unsigned int nbytes)
|
||||
* \ingroup IFX_AES_FUNCTIONS
|
||||
* \brief ECB AES encrypt using linux crypto blkcipher
|
||||
* \param desc blkcipher descriptor
|
||||
* \param dst output scatterlist
|
||||
* \param src input scatterlist
|
||||
* \param nbytes data size in bytes
|
||||
* \return err
|
||||
*/
|
||||
int ecb_aes_encrypt(struct blkcipher_desc *desc,
|
||||
struct scatterlist *dst, struct scatterlist *src,
|
||||
unsigned int nbytes)
|
||||
{
|
||||
struct aes_ctx *ctx = crypto_blkcipher_ctx(desc->tfm);
|
||||
struct blkcipher_walk walk;
|
||||
int err;
|
||||
|
||||
blkcipher_walk_init(&walk, dst, src, nbytes);
|
||||
err = blkcipher_walk_virt(desc, &walk);
|
||||
|
||||
while ((nbytes = walk.nbytes)) {
|
||||
nbytes -= (nbytes % AES_BLOCK_SIZE);
|
||||
ifx_deu_aes_ecb(ctx, walk.dst.virt.addr, walk.src.virt.addr,
|
||||
NULL, nbytes, CRYPTO_DIR_ENCRYPT, 0);
|
||||
nbytes &= AES_BLOCK_SIZE - 1;
|
||||
err = blkcipher_walk_done(desc, &walk, nbytes);
|
||||
}
|
||||
|
||||
return err;
|
||||
}
|
||||
|
||||
/*! \fn int ecb_aes_decrypt(struct blkcipher_desc *desc, struct scatterlist *dst, struct scatterlist *src, unsigned int nbytes)
|
||||
* \ingroup IFX_AES_FUNCTIONS
|
||||
* \brief ECB AES decrypt using linux crypto blkcipher
|
||||
* \param desc blkcipher descriptor
|
||||
* \param dst output scatterlist
|
||||
* \param src input scatterlist
|
||||
* \param nbytes data size in bytes
|
||||
* \return err
|
||||
*/
|
||||
int ecb_aes_decrypt(struct blkcipher_desc *desc,
|
||||
struct scatterlist *dst, struct scatterlist *src,
|
||||
unsigned int nbytes)
|
||||
{
|
||||
struct aes_ctx *ctx = crypto_blkcipher_ctx(desc->tfm);
|
||||
struct blkcipher_walk walk;
|
||||
int err;
|
||||
|
||||
blkcipher_walk_init(&walk, dst, src, nbytes);
|
||||
err = blkcipher_walk_virt(desc, &walk);
|
||||
|
||||
while ((nbytes = walk.nbytes)) {
|
||||
nbytes -= (nbytes % AES_BLOCK_SIZE);
|
||||
ifx_deu_aes_ecb(ctx, walk.dst.virt.addr, walk.src.virt.addr,
|
||||
NULL, nbytes, CRYPTO_DIR_DECRYPT, 0);
|
||||
nbytes &= AES_BLOCK_SIZE - 1;
|
||||
err = blkcipher_walk_done(desc, &walk, nbytes);
|
||||
}
|
||||
|
||||
return err;
|
||||
}
|
||||
|
||||
/*
|
||||
* \brief AES function mappings
|
||||
*/
|
||||
struct crypto_alg ifxdeu_ecb_aes_alg = {
|
||||
.cra_name = "ecb(aes)",
|
||||
.cra_driver_name = "ifxdeu-ecb(aes)",
|
||||
.cra_flags = CRYPTO_ALG_TYPE_BLKCIPHER,
|
||||
.cra_blocksize = AES_BLOCK_SIZE,
|
||||
.cra_ctxsize = sizeof(struct aes_ctx),
|
||||
.cra_type = &crypto_blkcipher_type,
|
||||
.cra_module = THIS_MODULE,
|
||||
.cra_list = LIST_HEAD_INIT(ifxdeu_ecb_aes_alg.cra_list),
|
||||
.cra_u = {
|
||||
.blkcipher = {
|
||||
.min_keysize = AES_MIN_KEY_SIZE,
|
||||
.max_keysize = AES_MAX_KEY_SIZE,
|
||||
.setkey = aes_set_key,
|
||||
.encrypt = ecb_aes_encrypt,
|
||||
.decrypt = ecb_aes_decrypt,
|
||||
}
|
||||
}
|
||||
};
|
||||
|
||||
|
||||
/*! \fn int cbc_aes_encrypt(struct blkcipher_desc *desc, struct scatterlist *dst, struct scatterlist *src, unsigned int nbytes)
|
||||
* \ingroup IFX_AES_FUNCTIONS
|
||||
* \brief CBC AES encrypt using linux crypto blkcipher
|
||||
* \param desc blkcipher descriptor
|
||||
* \param dst output scatterlist
|
||||
* \param src input scatterlist
|
||||
* \param nbytes data size in bytes
|
||||
* \return err
|
||||
*/
|
||||
int cbc_aes_encrypt(struct blkcipher_desc *desc,
|
||||
struct scatterlist *dst, struct scatterlist *src,
|
||||
unsigned int nbytes)
|
||||
{
|
||||
struct aes_ctx *ctx = crypto_blkcipher_ctx(desc->tfm);
|
||||
struct blkcipher_walk walk;
|
||||
int err;
|
||||
|
||||
blkcipher_walk_init(&walk, dst, src, nbytes);
|
||||
err = blkcipher_walk_virt(desc, &walk);
|
||||
|
||||
while ((nbytes = walk.nbytes)) {
|
||||
u8 *iv = walk.iv;
|
||||
nbytes -= (nbytes % AES_BLOCK_SIZE);
|
||||
ifx_deu_aes_cbc(ctx, walk.dst.virt.addr, walk.src.virt.addr,
|
||||
iv, nbytes, CRYPTO_DIR_ENCRYPT, 0);
|
||||
nbytes &= AES_BLOCK_SIZE - 1;
|
||||
err = blkcipher_walk_done(desc, &walk, nbytes);
|
||||
}
|
||||
|
||||
return err;
|
||||
}
|
||||
|
||||
/*! \fn int cbc_aes_decrypt(struct blkcipher_desc *desc, struct scatterlist *dst, struct scatterlist *src, unsigned int nbytes)
|
||||
* \ingroup IFX_AES_FUNCTIONS
|
||||
* \brief CBC AES decrypt using linux crypto blkcipher
|
||||
* \param desc blkcipher descriptor
|
||||
* \param dst output scatterlist
|
||||
* \param src input scatterlist
|
||||
* \param nbytes data size in bytes
|
||||
* \return err
|
||||
*/
|
||||
int cbc_aes_decrypt(struct blkcipher_desc *desc,
|
||||
struct scatterlist *dst, struct scatterlist *src,
|
||||
unsigned int nbytes)
|
||||
{
|
||||
struct aes_ctx *ctx = crypto_blkcipher_ctx(desc->tfm);
|
||||
struct blkcipher_walk walk;
|
||||
int err;
|
||||
|
||||
blkcipher_walk_init(&walk, dst, src, nbytes);
|
||||
err = blkcipher_walk_virt(desc, &walk);
|
||||
|
||||
while ((nbytes = walk.nbytes)) {
|
||||
u8 *iv = walk.iv;
|
||||
nbytes -= (nbytes % AES_BLOCK_SIZE);
|
||||
ifx_deu_aes_cbc(ctx, walk.dst.virt.addr, walk.src.virt.addr,
|
||||
iv, nbytes, CRYPTO_DIR_DECRYPT, 0);
|
||||
nbytes &= AES_BLOCK_SIZE - 1;
|
||||
err = blkcipher_walk_done(desc, &walk, nbytes);
|
||||
}
|
||||
|
||||
return err;
|
||||
}
|
||||
|
||||
/*
|
||||
* \brief AES function mappings
|
||||
*/
|
||||
struct crypto_alg ifxdeu_cbc_aes_alg = {
|
||||
.cra_name = "cbc(aes)",
|
||||
.cra_driver_name = "ifxdeu-cbc(aes)",
|
||||
.cra_flags = CRYPTO_ALG_TYPE_BLKCIPHER,
|
||||
.cra_blocksize = AES_BLOCK_SIZE,
|
||||
.cra_ctxsize = sizeof(struct aes_ctx),
|
||||
.cra_type = &crypto_blkcipher_type,
|
||||
.cra_module = THIS_MODULE,
|
||||
.cra_list = LIST_HEAD_INIT(ifxdeu_cbc_aes_alg.cra_list),
|
||||
.cra_u = {
|
||||
.blkcipher = {
|
||||
.min_keysize = AES_MIN_KEY_SIZE,
|
||||
.max_keysize = AES_MAX_KEY_SIZE,
|
||||
.ivsize = AES_BLOCK_SIZE,
|
||||
.setkey = aes_set_key,
|
||||
.encrypt = cbc_aes_encrypt,
|
||||
.decrypt = cbc_aes_decrypt,
|
||||
}
|
||||
}
|
||||
};
|
||||
|
||||
|
||||
/*! \fn int ctr_basic_aes_encrypt(struct blkcipher_desc *desc, struct scatterlist *dst, struct scatterlist *src, unsigned int nbytes)
|
||||
* \ingroup IFX_AES_FUNCTIONS
|
||||
* \brief Counter mode AES encrypt using linux crypto blkcipher
|
||||
* \param desc blkcipher descriptor
|
||||
* \param dst output scatterlist
|
||||
* \param src input scatterlist
|
||||
* \param nbytes data size in bytes
|
||||
* \return err
|
||||
*/
|
||||
int ctr_basic_aes_encrypt(struct blkcipher_desc *desc,
|
||||
struct scatterlist *dst, struct scatterlist *src,
|
||||
unsigned int nbytes)
|
||||
{
|
||||
struct aes_ctx *ctx = crypto_blkcipher_ctx(desc->tfm);
|
||||
struct blkcipher_walk walk;
|
||||
int err;
|
||||
|
||||
blkcipher_walk_init(&walk, dst, src, nbytes);
|
||||
err = blkcipher_walk_virt(desc, &walk);
|
||||
|
||||
while ((nbytes = walk.nbytes)) {
|
||||
u8 *iv = walk.iv;
|
||||
nbytes -= (nbytes % AES_BLOCK_SIZE);
|
||||
ifx_deu_aes_ctr(ctx, walk.dst.virt.addr, walk.src.virt.addr,
|
||||
iv, nbytes, CRYPTO_DIR_ENCRYPT, 0);
|
||||
nbytes &= AES_BLOCK_SIZE - 1;
|
||||
err = blkcipher_walk_done(desc, &walk, nbytes);
|
||||
}
|
||||
|
||||
return err;
|
||||
}
|
||||
|
||||
/*! \fn int ctr_basic_aes_decrypt(struct blkcipher_desc *desc, struct scatterlist *dst, struct scatterlist *src, unsigned int nbytes)
|
||||
* \ingroup IFX_AES_FUNCTIONS
|
||||
* \brief Counter mode AES decrypt using linux crypto blkcipher
|
||||
* \param desc blkcipher descriptor
|
||||
* \param dst output scatterlist
|
||||
* \param src input scatterlist
|
||||
* \param nbytes data size in bytes
|
||||
* \return err
|
||||
*/
|
||||
int ctr_basic_aes_decrypt(struct blkcipher_desc *desc,
|
||||
struct scatterlist *dst, struct scatterlist *src,
|
||||
unsigned int nbytes)
|
||||
{
|
||||
struct aes_ctx *ctx = crypto_blkcipher_ctx(desc->tfm);
|
||||
struct blkcipher_walk walk;
|
||||
int err;
|
||||
|
||||
blkcipher_walk_init(&walk, dst, src, nbytes);
|
||||
err = blkcipher_walk_virt(desc, &walk);
|
||||
|
||||
while ((nbytes = walk.nbytes)) {
|
||||
u8 *iv = walk.iv;
|
||||
nbytes -= (nbytes % AES_BLOCK_SIZE);
|
||||
ifx_deu_aes_ctr(ctx, walk.dst.virt.addr, walk.src.virt.addr,
|
||||
iv, nbytes, CRYPTO_DIR_DECRYPT, 0);
|
||||
nbytes &= AES_BLOCK_SIZE - 1;
|
||||
err = blkcipher_walk_done(desc, &walk, nbytes);
|
||||
}
|
||||
|
||||
return err;
|
||||
}
|
||||
|
||||
/*
|
||||
* \brief AES function mappings
|
||||
*/
|
||||
struct crypto_alg ifxdeu_ctr_basic_aes_alg = {
|
||||
.cra_name = "ctr(aes)",
|
||||
.cra_driver_name = "ifxdeu-ctr(aes)",
|
||||
.cra_flags = CRYPTO_ALG_TYPE_BLKCIPHER,
|
||||
.cra_blocksize = AES_BLOCK_SIZE,
|
||||
.cra_ctxsize = sizeof(struct aes_ctx),
|
||||
.cra_type = &crypto_blkcipher_type,
|
||||
.cra_module = THIS_MODULE,
|
||||
.cra_list = LIST_HEAD_INIT(ifxdeu_ctr_basic_aes_alg.cra_list),
|
||||
.cra_u = {
|
||||
.blkcipher = {
|
||||
.min_keysize = AES_MIN_KEY_SIZE,
|
||||
.max_keysize = AES_MAX_KEY_SIZE,
|
||||
.ivsize = AES_BLOCK_SIZE,
|
||||
.setkey = aes_set_key,
|
||||
.encrypt = ctr_basic_aes_encrypt,
|
||||
.decrypt = ctr_basic_aes_decrypt,
|
||||
}
|
||||
}
|
||||
};
|
||||
|
||||
|
||||
/*! \fn int ctr_rfc3686_aes_encrypt(struct blkcipher_desc *desc, struct scatterlist *dst, struct scatterlist *src, unsigned int nbytes)
|
||||
* \ingroup IFX_AES_FUNCTIONS
|
||||
* \brief Counter mode AES (rfc3686) encrypt using linux crypto blkcipher
|
||||
* \param desc blkcipher descriptor
|
||||
* \param dst output scatterlist
|
||||
* \param src input scatterlist
|
||||
* \param nbytes data size in bytes
|
||||
* \return err
|
||||
*/
|
||||
int ctr_rfc3686_aes_encrypt(struct blkcipher_desc *desc,
|
||||
struct scatterlist *dst, struct scatterlist *src,
|
||||
unsigned int nbytes)
|
||||
{
|
||||
struct aes_ctx *ctx = crypto_blkcipher_ctx(desc->tfm);
|
||||
struct blkcipher_walk walk;
|
||||
int err;
|
||||
u8 rfc3686_iv[16];
|
||||
|
||||
blkcipher_walk_init(&walk, dst, src, nbytes);
|
||||
err = blkcipher_walk_virt(desc, &walk);
|
||||
|
||||
/* set up counter block */
|
||||
memcpy(rfc3686_iv, ctx->nonce, CTR_RFC3686_NONCE_SIZE);
|
||||
memcpy(rfc3686_iv + CTR_RFC3686_NONCE_SIZE, walk.iv, CTR_RFC3686_IV_SIZE);
|
||||
|
||||
/* initialize counter portion of counter block */
|
||||
*(__be32 *)(rfc3686_iv + CTR_RFC3686_NONCE_SIZE + CTR_RFC3686_IV_SIZE) =
|
||||
cpu_to_be32(1);
|
||||
|
||||
while ((nbytes = walk.nbytes)) {
|
||||
nbytes -= (nbytes % AES_BLOCK_SIZE);
|
||||
ifx_deu_aes_ctr(ctx, walk.dst.virt.addr, walk.src.virt.addr,
|
||||
rfc3686_iv, nbytes, CRYPTO_DIR_ENCRYPT, 0);
|
||||
nbytes &= AES_BLOCK_SIZE - 1;
|
||||
err = blkcipher_walk_done(desc, &walk, nbytes);
|
||||
}
|
||||
|
||||
return err;
|
||||
}
|
||||
|
||||
/*! \fn int ctr_rfc3686_aes_decrypt(struct blkcipher_desc *desc, struct scatterlist *dst, struct scatterlist *src, unsigned int nbytes)
|
||||
* \ingroup IFX_AES_FUNCTIONS
|
||||
* \brief Counter mode AES (rfc3686) decrypt using linux crypto blkcipher
|
||||
* \param desc blkcipher descriptor
|
||||
* \param dst output scatterlist
|
||||
* \param src input scatterlist
|
||||
* \param nbytes data size in bytes
|
||||
* \return err
|
||||
*/
|
||||
int ctr_rfc3686_aes_decrypt(struct blkcipher_desc *desc,
|
||||
struct scatterlist *dst, struct scatterlist *src,
|
||||
unsigned int nbytes)
|
||||
{
|
||||
struct aes_ctx *ctx = crypto_blkcipher_ctx(desc->tfm);
|
||||
struct blkcipher_walk walk;
|
||||
int err;
|
||||
u8 rfc3686_iv[16];
|
||||
|
||||
blkcipher_walk_init(&walk, dst, src, nbytes);
|
||||
err = blkcipher_walk_virt(desc, &walk);
|
||||
|
||||
/* set up counter block */
|
||||
memcpy(rfc3686_iv, ctx->nonce, CTR_RFC3686_NONCE_SIZE);
|
||||
memcpy(rfc3686_iv + CTR_RFC3686_NONCE_SIZE, walk.iv, CTR_RFC3686_IV_SIZE);
|
||||
|
||||
/* initialize counter portion of counter block */
|
||||
*(__be32 *)(rfc3686_iv + CTR_RFC3686_NONCE_SIZE + CTR_RFC3686_IV_SIZE) =
|
||||
cpu_to_be32(1);
|
||||
|
||||
while ((nbytes = walk.nbytes)) {
|
||||
nbytes -= (nbytes % AES_BLOCK_SIZE);
|
||||
ifx_deu_aes_ctr(ctx, walk.dst.virt.addr, walk.src.virt.addr,
|
||||
rfc3686_iv, nbytes, CRYPTO_DIR_DECRYPT, 0);
|
||||
nbytes &= AES_BLOCK_SIZE - 1;
|
||||
err = blkcipher_walk_done(desc, &walk, nbytes);
|
||||
}
|
||||
|
||||
return err;
|
||||
}
|
||||
|
||||
/*
|
||||
* \brief AES function mappings
|
||||
*/
|
||||
struct crypto_alg ifxdeu_ctr_rfc3686_aes_alg = {
|
||||
.cra_name = "rfc3686(ctr(aes))",
|
||||
.cra_driver_name = "ifxdeu-ctr-rfc3686(aes)",
|
||||
.cra_flags = CRYPTO_ALG_TYPE_BLKCIPHER,
|
||||
.cra_blocksize = AES_BLOCK_SIZE,
|
||||
.cra_ctxsize = sizeof(struct aes_ctx),
|
||||
.cra_type = &crypto_blkcipher_type,
|
||||
.cra_module = THIS_MODULE,
|
||||
.cra_list = LIST_HEAD_INIT(ifxdeu_ctr_rfc3686_aes_alg.cra_list),
|
||||
.cra_u = {
|
||||
.blkcipher = {
|
||||
.min_keysize = AES_MIN_KEY_SIZE,
|
||||
.max_keysize = CTR_RFC3686_MAX_KEY_SIZE,
|
||||
.ivsize = CTR_RFC3686_IV_SIZE,
|
||||
.setkey = ctr_rfc3686_aes_set_key,
|
||||
.encrypt = ctr_rfc3686_aes_encrypt,
|
||||
.decrypt = ctr_rfc3686_aes_decrypt,
|
||||
}
|
||||
}
|
||||
};
|
||||
|
||||
|
||||
/*! \fn int __init ifxdeu_init_aes (void)
|
||||
* \ingroup IFX_AES_FUNCTIONS
|
||||
* \brief function to initialize AES driver
|
||||
* \return ret
|
||||
*/
|
||||
int __init ifxdeu_init_aes (void)
|
||||
{
|
||||
int ret = -ENOSYS;
|
||||
|
||||
|
||||
|
||||
#if (LINUX_VERSION_CODE < KERNEL_VERSION(2,6,20))
|
||||
if (!disable_multiblock) {
|
||||
ifxdeu_aes_alg.cra_u.cipher.cia_max_nbytes = AES_BLOCK_SIZE; //(size_t)-1;
|
||||
ifxdeu_aes_alg.cra_u.cipher.cia_req_align = 16;
|
||||
ifxdeu_aes_alg.cra_u.cipher.cia_ecb = ifx_deu_aes_ecb;
|
||||
ifxdeu_aes_alg.cra_u.cipher.cia_cbc = ifx_deu_aes_cbc;
|
||||
ifxdeu_aes_alg.cra_u.cipher.cia_cfb = ifx_deu_aes_cfb;
|
||||
ifxdeu_aes_alg.cra_u.cipher.cia_ofb = ifx_deu_aes_ofb;
|
||||
}
|
||||
#endif
|
||||
|
||||
if ((ret = crypto_register_alg(&ifxdeu_aes_alg)))
|
||||
goto aes_err;
|
||||
|
||||
if ((ret = crypto_register_alg(&ifxdeu_ecb_aes_alg)))
|
||||
goto ecb_aes_err;
|
||||
|
||||
if ((ret = crypto_register_alg(&ifxdeu_cbc_aes_alg)))
|
||||
goto cbc_aes_err;
|
||||
|
||||
if ((ret = crypto_register_alg(&ifxdeu_ctr_basic_aes_alg)))
|
||||
goto ctr_basic_aes_err;
|
||||
|
||||
if ((ret = crypto_register_alg(&ifxdeu_ctr_rfc3686_aes_alg)))
|
||||
goto ctr_rfc3686_aes_err;
|
||||
|
||||
aes_chip_init ();
|
||||
|
||||
CRTCL_SECT_INIT;
|
||||
|
||||
|
||||
printk (KERN_NOTICE "IFX DEU AES initialized%s%s.\n", disable_multiblock ? "" : " (multiblock)", disable_deudma ? "" : " (DMA)");
|
||||
return ret;
|
||||
|
||||
ctr_rfc3686_aes_err:
|
||||
crypto_unregister_alg(&ifxdeu_ctr_rfc3686_aes_alg);
|
||||
printk (KERN_ERR "IFX ctr_rfc3686_aes initialization failed!\n");
|
||||
return ret;
|
||||
ctr_basic_aes_err:
|
||||
crypto_unregister_alg(&ifxdeu_ctr_basic_aes_alg);
|
||||
printk (KERN_ERR "IFX ctr_basic_aes initialization failed!\n");
|
||||
return ret;
|
||||
cbc_aes_err:
|
||||
crypto_unregister_alg(&ifxdeu_cbc_aes_alg);
|
||||
printk (KERN_ERR "IFX cbc_aes initialization failed!\n");
|
||||
return ret;
|
||||
ecb_aes_err:
|
||||
crypto_unregister_alg(&ifxdeu_ecb_aes_alg);
|
||||
printk (KERN_ERR "IFX aes initialization failed!\n");
|
||||
return ret;
|
||||
aes_err:
|
||||
printk(KERN_ERR "IFX DEU AES initialization failed!\n");
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
/*! \fn void __exit ifxdeu_fini_aes (void)
|
||||
* \ingroup IFX_AES_FUNCTIONS
|
||||
* \brief unregister aes driver
|
||||
*/
|
||||
void __exit ifxdeu_fini_aes (void)
|
||||
{
|
||||
crypto_unregister_alg (&ifxdeu_aes_alg);
|
||||
crypto_unregister_alg (&ifxdeu_ecb_aes_alg);
|
||||
crypto_unregister_alg (&ifxdeu_cbc_aes_alg);
|
||||
crypto_unregister_alg (&ifxdeu_ctr_basic_aes_alg);
|
||||
crypto_unregister_alg (&ifxdeu_ctr_rfc3686_aes_alg);
|
||||
|
||||
}
|
||||
|
||||
|
389
package/platform/lantiq/ltq-deu/src/ifxmips_arc4.c
Normal file
389
package/platform/lantiq/ltq-deu/src/ifxmips_arc4.c
Normal file
@ -0,0 +1,389 @@
|
||||
/******************************************************************************
|
||||
**
|
||||
** FILE NAME : ifxmips_arc4.c
|
||||
** PROJECT : IFX UEIP
|
||||
** MODULES : DEU Module
|
||||
**
|
||||
** DATE : September 8, 2009
|
||||
** AUTHOR : Mohammad Firdaus
|
||||
** DESCRIPTION : Data Encryption Unit Driver for ARC4 Algorithm
|
||||
** COPYRIGHT : Copyright (c) 2009
|
||||
** Infineon Technologies AG
|
||||
** Am Campeon 1-12, 85579 Neubiberg, Germany
|
||||
**
|
||||
** 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.
|
||||
**
|
||||
** HISTORY
|
||||
** $Date $Author $Comment
|
||||
** 08 Sept 2009 Mohammad Firdaus Initial UEIP release
|
||||
*******************************************************************************/
|
||||
|
||||
/*!
|
||||
\defgroup IFX_DEU IFX_DEU_DRIVERS
|
||||
\ingroup API
|
||||
\brief ifx deu driver module
|
||||
*/
|
||||
|
||||
/*!
|
||||
\file ifxmips_arc4.c
|
||||
\ingroup IFX_DEU
|
||||
\brief ARC4 encryption DEU driver file
|
||||
*/
|
||||
|
||||
/*!
|
||||
\defgroup IFX_ARC4_FUNCTIONS IFX_ARC4_FUNCTIONS
|
||||
\ingroup IFX_DEU
|
||||
\brief IFX deu driver functions
|
||||
*/
|
||||
|
||||
/* Project header */
|
||||
#include <linux/version.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/init.h>
|
||||
#include <linux/types.h>
|
||||
#include <linux/errno.h>
|
||||
#include <linux/crypto.h>
|
||||
#include <crypto/algapi.h>
|
||||
#include <linux/interrupt.h>
|
||||
#include <asm/byteorder.h>
|
||||
#include <linux/delay.h>
|
||||
|
||||
/* Board specific header files */
|
||||
#ifdef CONFIG_AR9
|
||||
#include "ifxmips_deu_ar9.h"
|
||||
#endif
|
||||
#ifdef CONFIG_VR9
|
||||
#include "ifxmips_deu_vr9.h"
|
||||
#endif
|
||||
|
||||
static spinlock_t lock;
|
||||
#define CRTCL_SECT_INIT spin_lock_init(&lock)
|
||||
#define CRTCL_SECT_START spin_lock_irqsave(&lock, flag)
|
||||
#define CRTCL_SECT_END spin_unlock_irqrestore(&lock, flag)
|
||||
|
||||
/* Preprocessor declerations */
|
||||
#define ARC4_MIN_KEY_SIZE 1
|
||||
//#define ARC4_MAX_KEY_SIZE 256
|
||||
#define ARC4_MAX_KEY_SIZE 16
|
||||
#define ARC4_BLOCK_SIZE 1
|
||||
#define ARC4_START IFX_ARC4_CON
|
||||
#ifdef CRYPTO_DEBUG
|
||||
extern char debug_level;
|
||||
#define DPRINTF(level, format, args...) if (level < debug_level) printk(KERN_INFO "[%s %s %d]: " format, __FILE__, __func__, __LINE__, ##args);
|
||||
#else
|
||||
#define DPRINTF(level, format, args...)
|
||||
#endif
|
||||
|
||||
/*
|
||||
* \brief arc4 private structure
|
||||
*/
|
||||
struct arc4_ctx {
|
||||
int key_length;
|
||||
u8 buf[120];
|
||||
};
|
||||
|
||||
extern int disable_deudma;
|
||||
extern int disable_multiblock;
|
||||
|
||||
|
||||
/*! \fn static void _deu_arc4 (void *ctx_arg, u8 *out_arg, const u8 *in_arg, u8 *iv_arg, u32 nbytes, int encdec, int mode)
|
||||
\ingroup IFX_ARC4_FUNCTIONS
|
||||
\brief main interface to ARC4 hardware
|
||||
\param ctx_arg crypto algo context
|
||||
\param out_arg output bytestream
|
||||
\param in_arg input bytestream
|
||||
\param iv_arg initialization vector
|
||||
\param nbytes length of bytestream
|
||||
\param encdec 1 for encrypt; 0 for decrypt
|
||||
\param mode operation mode such as ebc, cbc, ctr
|
||||
*/
|
||||
static void _deu_arc4 (void *ctx_arg, u8 *out_arg, const u8 *in_arg,
|
||||
u8 *iv_arg, u32 nbytes, int encdec, int mode)
|
||||
{
|
||||
volatile struct arc4_t *arc4 = (struct arc4_t *) ARC4_START;
|
||||
|
||||
int i = 0;
|
||||
unsigned long flag;
|
||||
|
||||
#if 1 // need to handle nbytes not multiple of 16
|
||||
volatile u32 tmp_array32[4];
|
||||
volatile u8 *tmp_ptr8;
|
||||
int remaining_bytes, j;
|
||||
#endif
|
||||
|
||||
CRTCL_SECT_START;
|
||||
|
||||
arc4->IDLEN = nbytes;
|
||||
|
||||
#if 1
|
||||
while (i < nbytes) {
|
||||
arc4->ID3R = *((u32 *) in_arg + (i>>2) + 0);
|
||||
arc4->ID2R = *((u32 *) in_arg + (i>>2) + 1);
|
||||
arc4->ID1R = *((u32 *) in_arg + (i>>2) + 2);
|
||||
arc4->ID0R = *((u32 *) in_arg + (i>>2) + 3);
|
||||
|
||||
arc4->controlr.GO = 1;
|
||||
|
||||
while (arc4->controlr.BUS) {
|
||||
// this will not take long
|
||||
}
|
||||
|
||||
#if 1
|
||||
// need to handle nbytes not multiple of 16
|
||||
tmp_array32[0] = arc4->OD3R;
|
||||
tmp_array32[1] = arc4->OD2R;
|
||||
tmp_array32[2] = arc4->OD1R;
|
||||
tmp_array32[3] = arc4->OD0R;
|
||||
|
||||
remaining_bytes = nbytes - i;
|
||||
if (remaining_bytes > 16)
|
||||
remaining_bytes = 16;
|
||||
|
||||
tmp_ptr8 = (u8 *)&tmp_array32[0];
|
||||
for (j = 0; j < remaining_bytes; j++)
|
||||
*out_arg++ = *tmp_ptr8++;
|
||||
#else
|
||||
*((u32 *) out_arg + (i>>2) + 0) = arc4->OD3R;
|
||||
*((u32 *) out_arg + (i>>2) + 1) = arc4->OD2R;
|
||||
*((u32 *) out_arg + (i>>2) + 2) = arc4->OD1R;
|
||||
*((u32 *) out_arg + (i>>2) + 3) = arc4->OD0R;
|
||||
#endif
|
||||
|
||||
i += 16;
|
||||
}
|
||||
#else // dma
|
||||
|
||||
#endif // dma
|
||||
|
||||
CRTCL_SECT_END;
|
||||
}
|
||||
|
||||
/*! \fn arc4_chip_init (void)
|
||||
\ingroup IFX_ARC4_FUNCTIONS
|
||||
\brief initialize arc4 hardware
|
||||
*/
|
||||
static void arc4_chip_init (void)
|
||||
{
|
||||
//do nothing
|
||||
}
|
||||
|
||||
/*! \fn static int arc4_set_key(struct crypto_tfm *tfm, const u8 *in_key, unsigned int key_len)
|
||||
\ingroup IFX_ARC4_FUNCTIONS
|
||||
\brief sets ARC4 key
|
||||
\param tfm linux crypto algo transform
|
||||
\param in_key input key
|
||||
\param key_len key lengths less than or equal to 16 bytes supported
|
||||
*/
|
||||
static int arc4_set_key(struct crypto_tfm *tfm, const u8 *inkey,
|
||||
unsigned int key_len)
|
||||
{
|
||||
//struct arc4_ctx *ctx = crypto_tfm_ctx(tfm);
|
||||
volatile struct arc4_t *arc4 = (struct arc4_t *) ARC4_START;
|
||||
u32 *in_key = (u32 *)inkey;
|
||||
|
||||
// must program all bits at one go?!!!
|
||||
//#if 1
|
||||
*IFX_ARC4_CON = ( (1<<31) | ((key_len - 1)<<27) | (1<<26) | (3<<16) );
|
||||
//NDC=1,ENDI=1,GO=0,KSAE=1,SM=0
|
||||
|
||||
arc4->K3R = *((u32 *) in_key + 0);
|
||||
arc4->K2R = *((u32 *) in_key + 1);
|
||||
arc4->K1R = *((u32 *) in_key + 2);
|
||||
arc4->K0R = *((u32 *) in_key + 3);
|
||||
|
||||
#if 0 // arc4 is a ugly state machine, KSAE can only be set once per session
|
||||
ctx->key_length = key_len;
|
||||
|
||||
memcpy ((u8 *) (ctx->buf), in_key, key_len);
|
||||
#endif
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
/*! \fn static void _deu_arc4_ecb(void *ctx, uint8_t *dst, const uint8_t *src, uint8_t *iv, size_t nbytes, int encdec, int inplace)
|
||||
\ingroup IFX_ARC4_FUNCTIONS
|
||||
\brief sets ARC4 hardware to ECB mode
|
||||
\param ctx crypto algo context
|
||||
\param dst output bytestream
|
||||
\param src input bytestream
|
||||
\param iv initialization vector
|
||||
\param nbytes length of bytestream
|
||||
\param encdec 1 for encrypt; 0 for decrypt
|
||||
\param inplace not used
|
||||
*/
|
||||
static void _deu_arc4_ecb(void *ctx, uint8_t *dst, const uint8_t *src,
|
||||
uint8_t *iv, size_t nbytes, int encdec, int inplace)
|
||||
{
|
||||
_deu_arc4 (ctx, dst, src, NULL, nbytes, encdec, 0);
|
||||
}
|
||||
|
||||
/*! \fn static void arc4_crypt(struct crypto_tfm *tfm, u8 *out, const u8 *in)
|
||||
\ingroup IFX_ARC4_FUNCTIONS
|
||||
\brief encrypt/decrypt ARC4_BLOCK_SIZE of data
|
||||
\param tfm linux crypto algo transform
|
||||
\param out output bytestream
|
||||
\param in input bytestream
|
||||
*/
|
||||
static void arc4_crypt(struct crypto_tfm *tfm, u8 *out, const u8 *in)
|
||||
{
|
||||
struct arc4_ctx *ctx = crypto_tfm_ctx(tfm);
|
||||
|
||||
_deu_arc4 (ctx, out, in, NULL, ARC4_BLOCK_SIZE,
|
||||
CRYPTO_DIR_DECRYPT, 0);
|
||||
|
||||
}
|
||||
|
||||
/*
|
||||
* \brief ARC4 function mappings
|
||||
*/
|
||||
static struct crypto_alg ifxdeu_arc4_alg = {
|
||||
.cra_name = "arc4",
|
||||
.cra_driver_name = "ifxdeu-arc4",
|
||||
.cra_flags = CRYPTO_ALG_TYPE_CIPHER,
|
||||
.cra_blocksize = ARC4_BLOCK_SIZE,
|
||||
.cra_ctxsize = sizeof(struct arc4_ctx),
|
||||
.cra_module = THIS_MODULE,
|
||||
.cra_list = LIST_HEAD_INIT(ifxdeu_arc4_alg.cra_list),
|
||||
.cra_u = {
|
||||
.cipher = {
|
||||
.cia_min_keysize = ARC4_MIN_KEY_SIZE,
|
||||
.cia_max_keysize = ARC4_MAX_KEY_SIZE,
|
||||
.cia_setkey = arc4_set_key,
|
||||
.cia_encrypt = arc4_crypt,
|
||||
.cia_decrypt = arc4_crypt,
|
||||
}
|
||||
}
|
||||
};
|
||||
|
||||
/*! \fn static int ecb_arc4_encrypt(struct blkcipher_desc *desc, struct scatterlist *dst, struct scatterlist *src, unsigned int nbytes)
|
||||
\ingroup IFX_ARC4_FUNCTIONS
|
||||
\brief ECB ARC4 encrypt using linux crypto blkcipher
|
||||
\param desc blkcipher descriptor
|
||||
\param dst output scatterlist
|
||||
\param src input scatterlist
|
||||
\param nbytes data size in bytes
|
||||
*/
|
||||
static int ecb_arc4_encrypt(struct blkcipher_desc *desc,
|
||||
struct scatterlist *dst, struct scatterlist *src,
|
||||
unsigned int nbytes)
|
||||
{
|
||||
struct arc4_ctx *ctx = crypto_blkcipher_ctx(desc->tfm);
|
||||
struct blkcipher_walk walk;
|
||||
int err;
|
||||
|
||||
DPRINTF(1, "\n");
|
||||
blkcipher_walk_init(&walk, dst, src, nbytes);
|
||||
err = blkcipher_walk_virt(desc, &walk);
|
||||
|
||||
while ((nbytes = walk.nbytes)) {
|
||||
_deu_arc4_ecb(ctx, walk.dst.virt.addr, walk.src.virt.addr,
|
||||
NULL, nbytes, CRYPTO_DIR_ENCRYPT, 0);
|
||||
nbytes &= ARC4_BLOCK_SIZE - 1;
|
||||
err = blkcipher_walk_done(desc, &walk, nbytes);
|
||||
}
|
||||
|
||||
return err;
|
||||
}
|
||||
|
||||
/*! \fn static int ecb_arc4_decrypt(struct blkcipher_desc *desc, struct scatterlist *dst, struct scatterlist *src, unsigned int nbytes)
|
||||
\ingroup IFX_ARC4_FUNCTIONS
|
||||
\brief ECB ARC4 decrypt using linux crypto blkcipher
|
||||
\param desc blkcipher descriptor
|
||||
\param dst output scatterlist
|
||||
\param src input scatterlist
|
||||
\param nbytes data size in bytes
|
||||
*/
|
||||
static int ecb_arc4_decrypt(struct blkcipher_desc *desc,
|
||||
struct scatterlist *dst, struct scatterlist *src,
|
||||
unsigned int nbytes)
|
||||
{
|
||||
struct arc4_ctx *ctx = crypto_blkcipher_ctx(desc->tfm);
|
||||
struct blkcipher_walk walk;
|
||||
int err;
|
||||
|
||||
DPRINTF(1, "\n");
|
||||
blkcipher_walk_init(&walk, dst, src, nbytes);
|
||||
err = blkcipher_walk_virt(desc, &walk);
|
||||
|
||||
while ((nbytes = walk.nbytes)) {
|
||||
_deu_arc4_ecb(ctx, walk.dst.virt.addr, walk.src.virt.addr,
|
||||
NULL, nbytes, CRYPTO_DIR_DECRYPT, 0);
|
||||
nbytes &= ARC4_BLOCK_SIZE - 1;
|
||||
err = blkcipher_walk_done(desc, &walk, nbytes);
|
||||
}
|
||||
|
||||
return err;
|
||||
}
|
||||
|
||||
/*
|
||||
* \brief ARC4 function mappings
|
||||
*/
|
||||
static struct crypto_alg ifxdeu_ecb_arc4_alg = {
|
||||
.cra_name = "ecb(arc4)",
|
||||
.cra_driver_name = "ifxdeu-ecb(arc4)",
|
||||
.cra_flags = CRYPTO_ALG_TYPE_BLKCIPHER,
|
||||
.cra_blocksize = ARC4_BLOCK_SIZE,
|
||||
.cra_ctxsize = sizeof(struct arc4_ctx),
|
||||
.cra_type = &crypto_blkcipher_type,
|
||||
.cra_module = THIS_MODULE,
|
||||
.cra_list = LIST_HEAD_INIT(ifxdeu_ecb_arc4_alg.cra_list),
|
||||
.cra_u = {
|
||||
.blkcipher = {
|
||||
.min_keysize = ARC4_MIN_KEY_SIZE,
|
||||
.max_keysize = ARC4_MAX_KEY_SIZE,
|
||||
.setkey = arc4_set_key,
|
||||
.encrypt = ecb_arc4_encrypt,
|
||||
.decrypt = ecb_arc4_decrypt,
|
||||
}
|
||||
}
|
||||
};
|
||||
|
||||
/*! \fn int __init ifxdeu_init_arc4(void)
|
||||
\ingroup IFX_ARC4_FUNCTIONS
|
||||
\brief initialize arc4 driver
|
||||
*/
|
||||
int __init ifxdeu_init_arc4(void)
|
||||
{
|
||||
int ret = -ENOSYS;
|
||||
|
||||
|
||||
if ((ret = crypto_register_alg(&ifxdeu_arc4_alg)))
|
||||
goto arc4_err;
|
||||
|
||||
if ((ret = crypto_register_alg(&ifxdeu_ecb_arc4_alg)))
|
||||
goto ecb_arc4_err;
|
||||
|
||||
arc4_chip_init ();
|
||||
|
||||
CRTCL_SECT_INIT;
|
||||
|
||||
printk (KERN_NOTICE "IFX DEU ARC4 initialized%s%s.\n", disable_multiblock ? "" : " (multiblock)", disable_deudma ? "" : " (DMA)");
|
||||
return ret;
|
||||
|
||||
arc4_err:
|
||||
crypto_unregister_alg(&ifxdeu_arc4_alg);
|
||||
printk(KERN_ERR "IFX arc4 initialization failed!\n");
|
||||
return ret;
|
||||
ecb_arc4_err:
|
||||
crypto_unregister_alg(&ifxdeu_ecb_arc4_alg);
|
||||
printk (KERN_ERR "IFX ecb_arc4 initialization failed!\n");
|
||||
return ret;
|
||||
|
||||
}
|
||||
|
||||
/*! \fn void __exit ifxdeu_fini_arc4(void)
|
||||
\ingroup IFX_ARC4_FUNCTIONS
|
||||
\brief unregister arc4 driver
|
||||
*/
|
||||
void __exit ifxdeu_fini_arc4(void)
|
||||
{
|
||||
crypto_unregister_alg (&ifxdeu_arc4_alg);
|
||||
crypto_unregister_alg (&ifxdeu_ecb_arc4_alg);
|
||||
|
||||
|
||||
}
|
||||
|
||||
|
1137
package/platform/lantiq/ltq-deu/src/ifxmips_async_aes.c
Normal file
1137
package/platform/lantiq/ltq-deu/src/ifxmips_async_aes.c
Normal file
File diff suppressed because it is too large
Load Diff
954
package/platform/lantiq/ltq-deu/src/ifxmips_async_des.c
Normal file
954
package/platform/lantiq/ltq-deu/src/ifxmips_async_des.c
Normal file
@ -0,0 +1,954 @@
|
||||
/******************************************************************************
|
||||
**
|
||||
** FILE NAME : ifxmips_async_des.c
|
||||
** PROJECT : IFX UEIP
|
||||
** MODULES : DEU Module
|
||||
**
|
||||
** DATE : October 11, 2010
|
||||
** AUTHOR : Mohammad Firdaus
|
||||
** DESCRIPTION : Data Encryption Unit Driver for DES Algorithm
|
||||
** COPYRIGHT : Copyright (c) 2010
|
||||
** Infineon Technologies AG
|
||||
** Am Campeon 1-12, 85579 Neubiberg, Germany
|
||||
**
|
||||
** 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.
|
||||
**
|
||||
** HISTORY
|
||||
** $Date $Author $Comment
|
||||
** 08,Sept 2009 Mohammad Firdaus Initial UEIP release
|
||||
** 11, Oct 2010 Mohammad Firdaus Kernel Port incl. Async. Ablkcipher mode
|
||||
** 21,March 2011 Mohammad Firdaus Changes for Kernel 2.6.32 and IPSec integration
|
||||
*******************************************************************************/
|
||||
/*!
|
||||
\defgroup IFX_DEU IFX_DEU_DRIVERS
|
||||
\ingroup API
|
||||
\brief ifx DEU driver module
|
||||
*/
|
||||
|
||||
/*!
|
||||
\file ifxmips_async_des.c
|
||||
\ingroup IFX_DEU
|
||||
\brief DES Encryption Driver main file
|
||||
*/
|
||||
|
||||
/*!
|
||||
\defgroup IFX_DES_FUNCTIONS IFX_DES_FUNCTIONS
|
||||
\ingroup IFX_DEU
|
||||
\brief IFX DES driver Functions
|
||||
*/
|
||||
|
||||
#include <linux/wait.h>
|
||||
#include <linux/crypto.h>
|
||||
#include <linux/kernel.h>
|
||||
#include <linux/interrupt.h>
|
||||
#include <linux/spinlock.h>
|
||||
#include <linux/list.h>
|
||||
#include <crypto/ctr.h>
|
||||
#include <crypto/aes.h>
|
||||
#include <crypto/algapi.h>
|
||||
#include <crypto/scatterwalk.h>
|
||||
|
||||
#include <asm/ifx/ifx_regs.h>
|
||||
#include <asm/ifx/ifx_types.h>
|
||||
#include <asm/ifx/common_routines.h>
|
||||
#include <asm/ifx/irq.h>
|
||||
#include <asm/ifx/ifx_pmu.h>
|
||||
#include <asm/ifx/ifx_gpio.h>
|
||||
#include <asm/kmap_types.h>
|
||||
|
||||
#include "ifxmips_deu.h"
|
||||
|
||||
#if defined(CONFIG_DANUBE)
|
||||
#include "ifxmips_deu_danube.h"
|
||||
extern int ifx_danube_pre_1_4;
|
||||
#elif defined(CONFIG_AR9)
|
||||
#include "ifxmips_deu_ar9.h"
|
||||
#elif defined(CONFIG_VR9) || defined(CONFIG_AR10)
|
||||
#include "ifxmips_deu_vr9.h"
|
||||
#else
|
||||
#error "Unkown platform"
|
||||
#endif
|
||||
|
||||
/* DMA specific header and variables */
|
||||
|
||||
spinlock_t des_lock;
|
||||
#define CRTCL_SECT_INIT spin_lock_init(&des_lock)
|
||||
#define CRTCL_SECT_START spin_lock_irqsave(&des_lock, flag)
|
||||
#define CRTCL_SECT_END spin_unlock_irqrestore(&des_lock, flag)
|
||||
|
||||
/* Preprocessor declerations */
|
||||
#ifdef CRYPTO_DEBUG
|
||||
extern char debug_level;
|
||||
#define DPRINTF(level, format, args...) if (level < debug_level) printk(KERN_INFO "[%s %s %d]: " format, __FILE__, __func__, __LINE__, ##args);
|
||||
#else
|
||||
#define DPRINTF(level, format, args...)
|
||||
#endif
|
||||
//#define DES_3DES_START IFX_DES_CON
|
||||
#define DES_KEY_SIZE 8
|
||||
#define DES_EXPKEY_WORDS 32
|
||||
#define DES_BLOCK_SIZE 8
|
||||
#define DES3_EDE_KEY_SIZE (3 * DES_KEY_SIZE)
|
||||
#define DES3_EDE_EXPKEY_WORDS (3 * DES_EXPKEY_WORDS)
|
||||
#define DES3_EDE_BLOCK_SIZE DES_BLOCK_SIZE
|
||||
|
||||
/* Function Declaration to prevent warning messages */
|
||||
void des_chip_init (void);
|
||||
u32 endian_swap(u32 input);
|
||||
u32 input_swap(u32 input);
|
||||
int aes_memory_allocate(int value);
|
||||
int des_memory_allocate(int value);
|
||||
void memory_release(u32 *buffer);
|
||||
u32* memory_alignment(const u8 *arg, u32 *buff_alloc, int in_out, int nbytes);
|
||||
void aes_dma_memory_copy(u32 *outcopy, u32 *out_dma, u8 *out_arg, int nbytes);
|
||||
void des_dma_memory_copy(u32 *outcopy, u32 *out_dma, u8 *out_arg, int nbytes);
|
||||
|
||||
static int lq_deu_des_core (void *ctx_arg, u8 *out_arg, const u8 *in_arg,
|
||||
u8 *iv_arg, u32 nbytes, int encdec, int mode);
|
||||
|
||||
struct des_ctx {
|
||||
int controlr_M;
|
||||
int key_length;
|
||||
u8 iv[DES_BLOCK_SIZE];
|
||||
u32 expkey[DES3_EDE_EXPKEY_WORDS];
|
||||
};
|
||||
|
||||
|
||||
static int disable_multiblock = 0;
|
||||
#if LINUX_VERSION_CODE >= KERNEL_VERSION(2,4,0)
|
||||
module_param(disable_multiblock, int, 0);
|
||||
#else
|
||||
MODULE_PARM_DESC(disable_multiblock, "Disable encryption of whole multiblock buffers");
|
||||
#endif
|
||||
|
||||
static int disable_deudma = 1;
|
||||
|
||||
struct des_container {
|
||||
u8 *iv;
|
||||
u8 *dst_buf;
|
||||
u8 *src_buf;
|
||||
int mode;
|
||||
int encdec;
|
||||
int complete;
|
||||
int flag;
|
||||
|
||||
u32 bytes_processed;
|
||||
u32 nbytes;
|
||||
|
||||
struct ablkcipher_request arequest;
|
||||
};
|
||||
|
||||
des_priv_t *des_queue;
|
||||
extern deu_drv_priv_t deu_dma_priv;
|
||||
|
||||
void hexdump1(unsigned char *buf, unsigned int len)
|
||||
{
|
||||
print_hex_dump(KERN_CONT, "", DUMP_PREFIX_OFFSET,
|
||||
16, 1,
|
||||
buf, len, false);
|
||||
}
|
||||
|
||||
|
||||
/*! \fn int lq_des_setkey(struct crypto_ablkcipher *tfm, const u8 *key, unsigned int keylen)
|
||||
* \ingroup IFX_DES_FUNCTIONS
|
||||
* \brief sets DES key
|
||||
* \param tfm linux crypto algo transform
|
||||
* \param key input key
|
||||
* \param keylen key length
|
||||
*/
|
||||
static int lq_des_setkey(struct crypto_ablkcipher *tfm, const u8 *key,
|
||||
unsigned int keylen)
|
||||
{
|
||||
struct des_ctx *dctx = crypto_ablkcipher_ctx(tfm);
|
||||
|
||||
//printk("setkey in %s\n", __FILE__);
|
||||
|
||||
dctx->controlr_M = 0; // des
|
||||
dctx->key_length = keylen;
|
||||
|
||||
memcpy ((u8 *) (dctx->expkey), key, keylen);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
/*! \fn int lq_des3_ede_setkey(struct crypto_ablkcipher *tfm, const u8 *key, unsigned int keylen)
|
||||
* \ingroup IFX_DES_FUNCTIONS
|
||||
* \brief sets DES key
|
||||
* \param tfm linux crypto algo transform
|
||||
* \param key input key
|
||||
* \param keylen key length
|
||||
*/
|
||||
|
||||
static int lq_des3_ede_setkey(struct crypto_ablkcipher *tfm, const u8 *in_key,
|
||||
unsigned int keylen)
|
||||
{
|
||||
struct des_ctx *dctx = crypto_ablkcipher_ctx(tfm);
|
||||
|
||||
//printk("setkey in %s\n", __FILE__);
|
||||
|
||||
dctx->controlr_M = keylen/8 + 1; // des
|
||||
dctx->key_length = keylen;
|
||||
|
||||
memcpy ((u8 *) (dctx->expkey), in_key, keylen);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
/*! \fn void ifx_deu_des_core(void *ctx_arg, u8 *out_arg, const u8 *in_arg, u8 *iv_arg, u32 nbytes, int encdec, int mode)
|
||||
* \ingroup IFX_DES_FUNCTIONS
|
||||
* \brief main interface to DES hardware
|
||||
* \param ctx_arg crypto algo context
|
||||
* \param out_arg output bytestream
|
||||
* \param in_arg input bytestream
|
||||
* \param iv_arg initialization vector
|
||||
* \param nbytes length of bytestream
|
||||
* \param encdec 1 for encrypt; 0 for decrypt
|
||||
* \param mode operation mode such as ebc, cbc
|
||||
*/
|
||||
|
||||
static int lq_deu_des_core (void *ctx_arg, u8 *out_arg, const u8 *in_arg,
|
||||
u8 *iv_arg, u32 nbytes, int encdec, int mode)
|
||||
{
|
||||
volatile struct des_t *des = (struct des_t *) DES_3DES_START;
|
||||
struct des_ctx *dctx = ctx_arg;
|
||||
u32 *key = dctx->expkey;
|
||||
unsigned long flag;
|
||||
|
||||
int i = 0;
|
||||
int nblocks = 0;
|
||||
|
||||
CRTCL_SECT_START;
|
||||
|
||||
des->controlr.M = dctx->controlr_M;
|
||||
if (dctx->controlr_M == 0) // des
|
||||
{
|
||||
des->K1HR = DEU_ENDIAN_SWAP(*((u32 *) key + 0));
|
||||
des->K1LR = DEU_ENDIAN_SWAP(*((u32 *) key + 1));
|
||||
|
||||
}
|
||||
else {
|
||||
/* Hardware Section */
|
||||
switch (dctx->key_length) {
|
||||
case 24:
|
||||
des->K3HR = DEU_ENDIAN_SWAP(*((u32 *) key + 4));
|
||||
des->K3LR = DEU_ENDIAN_SWAP(*((u32 *) key + 5));
|
||||
/* no break; */
|
||||
|
||||
case 16:
|
||||
des->K2HR = DEU_ENDIAN_SWAP(*((u32 *) key + 2));
|
||||
des->K2LR = DEU_ENDIAN_SWAP(*((u32 *) key + 3));
|
||||
|
||||
/* no break; */
|
||||
case 8:
|
||||
des->K1HR = DEU_ENDIAN_SWAP(*((u32 *) key + 0));
|
||||
des->K1LR = DEU_ENDIAN_SWAP(*((u32 *) key + 1));
|
||||
break;
|
||||
|
||||
default:
|
||||
CRTCL_SECT_END;
|
||||
return -EINVAL;
|
||||
}
|
||||
}
|
||||
|
||||
des->controlr.E_D = !encdec; //encryption
|
||||
des->controlr.O = mode; //0 ECB 1 CBC 2 OFB 3 CFB 4 CTR hexdump(prin,sizeof(*des));
|
||||
|
||||
if (mode > 0) {
|
||||
des->IVHR = DEU_ENDIAN_SWAP(*(u32 *) iv_arg);
|
||||
des->IVLR = DEU_ENDIAN_SWAP(*((u32 *) iv_arg + 1));
|
||||
};
|
||||
|
||||
/* memory alignment issue */
|
||||
dword_mem_aligned_in = (u32 *) DEU_DWORD_REORDERING(in_arg, des_buff_in, BUFFER_IN, nbytes);
|
||||
|
||||
deu_priv->deu_rx_buf = (u32 *) out_arg;
|
||||
deu_priv->deu_rx_len = nbytes;
|
||||
|
||||
dma->controlr.ALGO = 0; //DES
|
||||
des->controlr.DAU = 0;
|
||||
dma->controlr.BS = 0;
|
||||
dma->controlr.EN = 1;
|
||||
|
||||
while (des->controlr.BUS) {
|
||||
};
|
||||
|
||||
wlen = dma_device_write (dma_device, (u8 *) dword_mem_aligned_in, nbytes, NULL);
|
||||
if (wlen != nbytes) {
|
||||
dma->controlr.EN = 0;
|
||||
CRTCL_SECT_END;
|
||||
printk (KERN_ERR "[%s %s %d]: dma_device_write fail!\n", __FILE__, __func__, __LINE__);
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
|
||||
/* Prepare Rx buf length used in dma psuedo interrupt */
|
||||
outcopy = (u32 *) DEU_DWORD_REORDERING(out_arg, des_buff_out, BUFFER_OUT, nbytes);
|
||||
deu_priv->outcopy = outcopy;
|
||||
deu_priv->event_src = DES_ASYNC_EVENT;
|
||||
|
||||
if (mode > 0) {
|
||||
*(u32 *) iv_arg = DEU_ENDIAN_SWAP(des->IVHR);
|
||||
*((u32 *) iv_arg + 1) = DEU_ENDIAN_SWAP(des->IVLR);
|
||||
};
|
||||
|
||||
CRTCL_SECT_END;
|
||||
|
||||
return -EINPROGRESS;
|
||||
|
||||
}
|
||||
|
||||
static int count_sgs(struct scatterlist *sl, unsigned int total_bytes)
|
||||
{
|
||||
int i = 0;
|
||||
|
||||
do {
|
||||
total_bytes -= sl[i].length;
|
||||
i++;
|
||||
|
||||
} while (total_bytes > 0);
|
||||
|
||||
return i;
|
||||
}
|
||||
|
||||
/* \fn static inline struct des_container *des_container_cast (
|
||||
* struct scatterlist *dst)
|
||||
* \ingroup IFX_DES_FUNCTIONS
|
||||
* \brief Locate the structure des_container in memory.
|
||||
* \param *areq Pointer to memory location where ablkcipher_request is located
|
||||
* \return *des_cointainer The function pointer to des_container
|
||||
*/
|
||||
|
||||
static inline struct des_container *des_container_cast(
|
||||
struct ablkcipher_request *areq)
|
||||
{
|
||||
return container_of(areq, struct des_container, arequest);
|
||||
}
|
||||
|
||||
/* \fn static void lq_sg_complete(struct des_container *des_con)
|
||||
* \ingroup IFX_DES_FUNCTIONS
|
||||
* \brief Free the used up memory after encryt/decrypt.
|
||||
*/
|
||||
|
||||
static void lq_sg_complete(struct des_container *des_con)
|
||||
{
|
||||
unsigned long queue_flag;
|
||||
|
||||
spin_lock_irqsave(&des_queue->lock, queue_flag);
|
||||
kfree(des_con);
|
||||
spin_unlock_irqrestore(&des_queue->lock, queue_flag);
|
||||
}
|
||||
|
||||
/* \fn void lq_sg_init(struct scatterlist *src,
|
||||
* struct scatterlist *dst)
|
||||
* \ingroup IFX_DES_FUNCTIONS
|
||||
* \brief Maps the scatterlists into a source/destination page.
|
||||
* \param *src Pointer to the source scatterlist
|
||||
* \param *dst Pointer to the destination scatterlist
|
||||
*/
|
||||
|
||||
static void lq_sg_init(struct des_container *des_con, struct scatterlist *src,
|
||||
struct scatterlist *dst)
|
||||
{
|
||||
struct page *dst_page, *src_page;
|
||||
|
||||
src_page = sg_virt(src);
|
||||
des_con->src_buf = (char *) src_page;
|
||||
|
||||
dst_page = sg_virt(dst);
|
||||
des_con->dst_buf = (char *) dst_page;
|
||||
}
|
||||
|
||||
/* \fn static int process_next_packet(struct des_container *des_con, struct ablkcipher_request *areq,
|
||||
* int state)
|
||||
* \ingroup IFX_DES_FUNCTIONS
|
||||
* \brief Process the next packet after dequeuing the packet from crypto queue
|
||||
* \param *des_con Pointer to DES container structure
|
||||
* \param *areq Pointer to ablkcipher_request container
|
||||
* \param state State of the packet (scattered packet or new packet to be processed)
|
||||
* \return -EINVAL: DEU failure, -EINPROGRESS: DEU encrypt/decrypt in progress, 1: no scatterlist left
|
||||
*/
|
||||
|
||||
static int process_next_packet(struct des_container *des_con, struct ablkcipher_request *areq,
|
||||
int state)
|
||||
{
|
||||
u8 *iv;
|
||||
int mode, encdec, err = -EINVAL;
|
||||
u32 remain, inc, chunk_size, nbytes;
|
||||
struct scatterlist *src = NULL;
|
||||
struct scatterlist *dst = NULL;
|
||||
struct crypto_ablkcipher *cipher;
|
||||
struct des_ctx *ctx;
|
||||
unsigned long queue_flag;
|
||||
|
||||
spin_lock_irqsave(&des_queue->lock, queue_flag);
|
||||
|
||||
mode = des_con->mode;
|
||||
encdec = des_con->encdec;
|
||||
iv = des_con->iv;
|
||||
|
||||
if (state & PROCESS_SCATTER) {
|
||||
src = scatterwalk_sg_next(areq->src);
|
||||
dst = scatterwalk_sg_next(areq->dst);
|
||||
|
||||
if (!src || !dst) {
|
||||
spin_unlock_irqrestore(&des_queue->lock, queue_flag);
|
||||
return 1;
|
||||
}
|
||||
}
|
||||
else if (state & PROCESS_NEW_PACKET) {
|
||||
src = areq->src;
|
||||
dst = areq->dst;
|
||||
}
|
||||
|
||||
remain = des_con->bytes_processed;
|
||||
chunk_size = src->length;
|
||||
|
||||
//printk("debug ln: %d, func: %s, reqsize: %d, scattersize: %d\n",
|
||||
// __LINE__, __func__, areq->nbytes, chunk_size);
|
||||
|
||||
if (remain > DEU_MAX_PACKET_SIZE)
|
||||
inc = DEU_MAX_PACKET_SIZE;
|
||||
else if(remain > chunk_size)
|
||||
inc = chunk_size;
|
||||
else
|
||||
inc = remain;
|
||||
|
||||
remain -= inc;
|
||||
des_con->nbytes = inc;
|
||||
|
||||
if (state & PROCESS_SCATTER) {
|
||||
des_con->src_buf += des_con->nbytes;
|
||||
des_con->dst_buf += des_con->nbytes;
|
||||
}
|
||||
|
||||
lq_sg_init(des_con, src, dst);
|
||||
|
||||
nbytes = des_con->nbytes;
|
||||
|
||||
cipher = crypto_ablkcipher_reqtfm(areq);
|
||||
ctx = crypto_ablkcipher_ctx(cipher);
|
||||
|
||||
if (des_queue->hw_status == DES_IDLE) {
|
||||
des_queue->hw_status = DES_STARTED;
|
||||
}
|
||||
|
||||
des_con->bytes_processed -= des_con->nbytes;
|
||||
err = ablkcipher_enqueue_request(&des_queue->list, &des_con->arequest);
|
||||
if (err == -EBUSY) {
|
||||
printk("Failed to enqueue request, ln: %d, err: %d\n",
|
||||
__LINE__, err);
|
||||
spin_unlock_irqrestore(&des_queue->lock, queue_flag);
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
spin_unlock_irqrestore(&des_queue->lock, queue_flag);
|
||||
err = lq_deu_des_core(ctx, des_con->dst_buf, des_con->src_buf, iv, nbytes, encdec, mode);
|
||||
|
||||
return err;
|
||||
}
|
||||
|
||||
/* \fn static void process_queue(unsigned long data)
|
||||
* \ingroup IFX_DES_FUNCTIONS
|
||||
* \brief Process next packet in queue
|
||||
* \param data not used
|
||||
* \return
|
||||
*/
|
||||
|
||||
static void process_queue(unsigned long data)
|
||||
{
|
||||
DEU_WAKEUP_EVENT(deu_dma_priv.deu_thread_wait, DES_ASYNC_EVENT,
|
||||
deu_dma_priv.des_event_flags);
|
||||
|
||||
}
|
||||
|
||||
/* \fn static int des_crypto_thread (void *data)
|
||||
* \ingroup IFX_DES_FUNCTIONS
|
||||
* \brief DES thread that handles crypto requests from upper layer & DMA
|
||||
* \param *data Not used
|
||||
* \return -EINVAL: DEU failure, -EBUSY: DEU HW busy, 0: exit thread
|
||||
*/
|
||||
|
||||
static int des_crypto_thread(void *data)
|
||||
{
|
||||
struct des_container *des_con = NULL;
|
||||
struct ablkcipher_request *areq = NULL;
|
||||
int err;
|
||||
unsigned long queue_flag;
|
||||
|
||||
daemonize("lq_des_thread");
|
||||
|
||||
while (1)
|
||||
{
|
||||
DEU_WAIT_EVENT(deu_dma_priv.deu_thread_wait, DES_ASYNC_EVENT,
|
||||
deu_dma_priv.des_event_flags);
|
||||
spin_lock_irqsave(&des_queue->lock, queue_flag);
|
||||
|
||||
/* wait to prevent starting a crypto session before
|
||||
* exiting the dma interrupt thread.
|
||||
*/
|
||||
|
||||
if (des_queue->hw_status == DES_STARTED) {
|
||||
areq = ablkcipher_dequeue_request(&des_queue->list);
|
||||
des_con = des_container_cast(areq);
|
||||
des_queue->hw_status = DES_BUSY;
|
||||
}
|
||||
else if (des_queue->hw_status == DES_IDLE) {
|
||||
areq = ablkcipher_dequeue_request(&des_queue->list);
|
||||
des_con = des_container_cast(areq);
|
||||
des_queue->hw_status = DES_STARTED;
|
||||
}
|
||||
else if (des_queue->hw_status == DES_BUSY) {
|
||||
areq = ablkcipher_dequeue_request(&des_queue->list);
|
||||
des_con = des_container_cast(areq);
|
||||
}
|
||||
else if (des_queue->hw_status == DES_COMPLETED) {
|
||||
areq->base.complete(&areq->base, 0);
|
||||
lq_sg_complete(des_con);
|
||||
des_queue->hw_status = DES_IDLE;
|
||||
spin_unlock_irqrestore(&des_queue->lock, queue_flag);
|
||||
return 0;
|
||||
}
|
||||
spin_unlock_irqrestore(&des_queue->lock, queue_flag);
|
||||
|
||||
if ((des_con->bytes_processed == 0)) {
|
||||
goto des_done;
|
||||
}
|
||||
|
||||
if (!des_con) {
|
||||
goto des_done;
|
||||
}
|
||||
|
||||
if (des_con->flag & PROCESS_NEW_PACKET) {
|
||||
des_con->flag = PROCESS_SCATTER;
|
||||
err = process_next_packet(des_con, areq, PROCESS_NEW_PACKET);
|
||||
}
|
||||
else
|
||||
err = process_next_packet(des_con, areq, PROCESS_SCATTER);
|
||||
|
||||
if (err == -EINVAL) {
|
||||
areq->base.complete(&areq->base, err);
|
||||
lq_sg_complete(des_con);
|
||||
printk("src/dst returned -EINVAL in func: %s\n", __func__);
|
||||
}
|
||||
else if (err > 0) {
|
||||
printk("src/dst returned zero in func: %s\n", __func__);
|
||||
goto des_done;
|
||||
}
|
||||
|
||||
continue;
|
||||
|
||||
des_done:
|
||||
//printk("debug line - %d, func: %s, qlen: %d\n", __LINE__, __func__, des_queue->list.qlen);
|
||||
areq->base.complete(&areq->base, 0);
|
||||
lq_sg_complete(des_con);
|
||||
|
||||
spin_lock_irqsave(&des_queue->lock, queue_flag);
|
||||
if (des_queue->list.qlen > 0) {
|
||||
spin_unlock_irqrestore(&des_queue->lock, queue_flag);
|
||||
tasklet_schedule(&des_queue->des_task);
|
||||
}
|
||||
else {
|
||||
des_queue->hw_status = DES_IDLE;
|
||||
spin_unlock_irqrestore(&des_queue->lock, queue_flag);
|
||||
}
|
||||
} // while(1)
|
||||
|
||||
return 0;
|
||||
|
||||
}
|
||||
|
||||
/* \fn static int lq_des_queue_mgr(struct des_ctx *ctx, struct ablkcipher_request *areq,
|
||||
u8 *iv, int encdec, int mode)
|
||||
* \ingroup IFX_DES_FUNCTIONS
|
||||
* \brief starts the process of queuing DEU requests
|
||||
* \param *ctx crypto algo contax
|
||||
* \param *areq Pointer to the balkcipher requests
|
||||
* \param *iv Pointer to intput vector location
|
||||
* \param dir Encrypt/Decrypt
|
||||
* \mode The mode DES algo is running
|
||||
* \return 0 if success
|
||||
*/
|
||||
|
||||
static int lq_queue_mgr(struct des_ctx *ctx, struct ablkcipher_request *areq,
|
||||
u8 *iv, int encdec, int mode)
|
||||
{
|
||||
int err = -EINVAL;
|
||||
unsigned long queue_flag;
|
||||
struct scatterlist *src = areq->src;
|
||||
struct scatterlist *dst = areq->dst;
|
||||
struct des_container *des_con = NULL;
|
||||
u32 remain, inc, nbytes = areq->nbytes;
|
||||
u32 chunk_bytes = src->length;
|
||||
|
||||
des_con = (struct des_container *)kmalloc(sizeof(struct des_container),
|
||||
GFP_KERNEL);
|
||||
|
||||
if (!(des_con)) {
|
||||
printk("Cannot allocate memory for AES container, fn %s, ln %d\n",
|
||||
__func__, __LINE__);
|
||||
return -ENOMEM;
|
||||
}
|
||||
|
||||
/* DES encrypt/decrypt mode */
|
||||
if (mode == 5) {
|
||||
nbytes = DES_BLOCK_SIZE;
|
||||
chunk_bytes = DES_BLOCK_SIZE;
|
||||
mode = 0;
|
||||
}
|
||||
|
||||
des_con->bytes_processed = nbytes;
|
||||
des_con->arequest = (*areq);
|
||||
remain = nbytes;
|
||||
|
||||
//printk("debug - Line: %d, func: %s, reqsize: %d, scattersize: %d\n",
|
||||
// __LINE__, __func__, nbytes, chunk_bytes);
|
||||
|
||||
if (remain > DEU_MAX_PACKET_SIZE)
|
||||
inc = DEU_MAX_PACKET_SIZE;
|
||||
else if(remain > chunk_bytes)
|
||||
inc = chunk_bytes;
|
||||
else
|
||||
inc = remain;
|
||||
|
||||
remain -= inc;
|
||||
lq_sg_init(des_con, src, dst);
|
||||
|
||||
if (remain <= 0 ) {
|
||||
des_con->complete = 1;
|
||||
}
|
||||
else
|
||||
des_con->complete = 0;
|
||||
|
||||
des_con->nbytes = inc;
|
||||
des_con->iv = iv;
|
||||
des_con->mode = mode;
|
||||
des_con->encdec = encdec;
|
||||
|
||||
spin_lock_irqsave(&des_queue->lock, queue_flag);
|
||||
|
||||
if (des_queue->hw_status == DES_STARTED || des_queue->hw_status == DES_BUSY ||
|
||||
des_queue->list.qlen > 0) {
|
||||
|
||||
des_con->flag = PROCESS_NEW_PACKET;
|
||||
err = ablkcipher_enqueue_request(&des_queue->list, &des_con->arequest);
|
||||
if (err == -EBUSY) {
|
||||
spin_unlock_irqrestore(&des_queue->lock, queue_flag);
|
||||
printk("Fail to enqueue ablkcipher request ln: %d, err: %d\n",
|
||||
__LINE__, err);
|
||||
return err;
|
||||
}
|
||||
|
||||
spin_unlock_irqrestore(&des_queue->lock, queue_flag);
|
||||
return -EINPROGRESS;
|
||||
|
||||
}
|
||||
else if (des_queue->hw_status == DES_IDLE) {
|
||||
des_queue->hw_status = DES_STARTED;
|
||||
}
|
||||
|
||||
des_con->flag = PROCESS_SCATTER;
|
||||
des_con->bytes_processed -= des_con->nbytes;
|
||||
|
||||
err = ablkcipher_enqueue_request(&des_queue->list, &des_con->arequest);
|
||||
if (err == -EBUSY) {
|
||||
printk("Fail to enqueue ablkcipher request ln: %d, err: %d\n",
|
||||
__LINE__, err);
|
||||
|
||||
spin_unlock_irqrestore(&des_queue->lock, queue_flag);
|
||||
return err;
|
||||
}
|
||||
|
||||
spin_unlock_irqrestore(&des_queue->lock, queue_flag);
|
||||
return lq_deu_des_core(ctx, des_con->dst_buf, des_con->src_buf, iv, inc, encdec, mode);
|
||||
|
||||
}
|
||||
|
||||
/* \fn static int lq_des_encrypt(struct ablkcipher_request *areq)
|
||||
* \ingroup IFX_DES_FUNCTIONS
|
||||
* \brief Decrypt function for DES algo
|
||||
* \param *areq Pointer to ablkcipher request in memory
|
||||
* \return 0 is success, -EINPROGRESS if encryting, EINVAL if failure
|
||||
*/
|
||||
|
||||
static int lq_des_encrypt(struct ablkcipher_request *areq)
|
||||
{
|
||||
struct crypto_ablkcipher *cipher = crypto_ablkcipher_reqtfm(areq);
|
||||
struct des_ctx *ctx = crypto_ablkcipher_ctx(cipher);
|
||||
|
||||
return lq_queue_mgr(ctx, areq, NULL, CRYPTO_DIR_ENCRYPT, 5);
|
||||
|
||||
}
|
||||
|
||||
/* \fn static int lq_des_decrypt(struct ablkcipher_request *areq)
|
||||
* \ingroup IFX_DES_FUNCTIONS
|
||||
* \brief Decrypt function for DES algo
|
||||
* \param *areq Pointer to ablkcipher request in memory
|
||||
* \return 0 is success, -EINPROGRESS if encryting, EINVAL if failure
|
||||
*/
|
||||
|
||||
static int lq_des_decrypt(struct ablkcipher_request *areq)
|
||||
{
|
||||
struct crypto_ablkcipher *cipher = crypto_ablkcipher_reqtfm(areq);
|
||||
struct des_ctx *ctx = crypto_ablkcipher_ctx(cipher);
|
||||
|
||||
return lq_queue_mgr(ctx, areq, NULL, CRYPTO_DIR_DECRYPT, 5);
|
||||
}
|
||||
|
||||
/* \fn static int lq_ecb_des_encrypt(struct ablkcipher_request *areq)
|
||||
* \ingroup IFX_DES_FUNCTIONS
|
||||
* \brief Decrypt function for DES algo
|
||||
* \param *areq Pointer to ablkcipher request in memory
|
||||
* \return 0 is success, -EINPROGRESS if encryting, EINVAL if failure
|
||||
*/
|
||||
|
||||
static int lq_ecb_des_encrypt(struct ablkcipher_request *areq)
|
||||
{
|
||||
struct crypto_ablkcipher *cipher = crypto_ablkcipher_reqtfm(areq);
|
||||
struct des_ctx *ctx = crypto_ablkcipher_ctx(cipher);
|
||||
|
||||
return lq_queue_mgr(ctx, areq, areq->info, CRYPTO_DIR_ENCRYPT, 0);
|
||||
}
|
||||
|
||||
/* \fn static int lq_ecb_des_decrypt(struct ablkcipher_request *areq)
|
||||
* \ingroup IFX_DES_FUNCTIONS
|
||||
* \brief Decrypt function for DES algo
|
||||
* \param *areq Pointer to ablkcipher request in memory
|
||||
* \return 0 is success, -EINPROGRESS if encryting, EINVAL if failure
|
||||
*/
|
||||
static int lq_ecb_des_decrypt(struct ablkcipher_request *areq)
|
||||
{
|
||||
struct crypto_ablkcipher *cipher = crypto_ablkcipher_reqtfm(areq);
|
||||
struct des_ctx *ctx = crypto_ablkcipher_ctx(cipher);
|
||||
|
||||
return lq_queue_mgr(ctx, areq, areq->info, CRYPTO_DIR_DECRYPT, 0);
|
||||
|
||||
}
|
||||
|
||||
/* \fn static int lq_cbc_ecb_des_encrypt(struct ablkcipher_request *areq)
|
||||
* \ingroup IFX_DES_FUNCTIONS
|
||||
* \brief Decrypt function for DES algo
|
||||
* \param *areq Pointer to ablkcipher request in memory
|
||||
* \return 0 is success, -EINPROGRESS if encryting, EINVAL if failure
|
||||
*/
|
||||
|
||||
static int lq_cbc_des_encrypt(struct ablkcipher_request *areq)
|
||||
{
|
||||
struct crypto_ablkcipher *cipher = crypto_ablkcipher_reqtfm(areq);
|
||||
struct des_ctx *ctx = crypto_ablkcipher_ctx(cipher);
|
||||
|
||||
return lq_queue_mgr(ctx, areq, areq->info, CRYPTO_DIR_ENCRYPT, 1);
|
||||
}
|
||||
/* \fn static int lq_cbc_des_decrypt(struct ablkcipher_request *areq)
|
||||
* \ingroup IFX_DES_FUNCTIONS
|
||||
* \brief Decrypt function for DES algo
|
||||
* \param *areq Pointer to ablkcipher request in memory
|
||||
* \return 0 is success, -EINPROGRESS if encryting, EINVAL if failure
|
||||
*/
|
||||
|
||||
static int lq_cbc_des_decrypt(struct ablkcipher_request *areq)
|
||||
{
|
||||
struct crypto_ablkcipher *cipher = crypto_ablkcipher_reqtfm(areq);
|
||||
struct des_ctx *ctx = crypto_ablkcipher_ctx(cipher);
|
||||
|
||||
return lq_queue_mgr(ctx, areq, areq->info, CRYPTO_DIR_DECRYPT, 1);
|
||||
}
|
||||
|
||||
struct lq_des_alg {
|
||||
struct crypto_alg alg;
|
||||
};
|
||||
|
||||
/* DES Supported algo array */
|
||||
static struct lq_des_alg des_drivers_alg [] = {
|
||||
{
|
||||
.alg = {
|
||||
.cra_name = "des",
|
||||
.cra_driver_name = "lqdeu-des",
|
||||
.cra_flags = CRYPTO_ALG_TYPE_ABLKCIPHER | CRYPTO_ALG_ASYNC,
|
||||
.cra_blocksize = DES_BLOCK_SIZE,
|
||||
.cra_ctxsize = sizeof(struct des_ctx),
|
||||
.cra_type = &crypto_ablkcipher_type,
|
||||
.cra_priority = 300,
|
||||
.cra_module = THIS_MODULE,
|
||||
.cra_ablkcipher = {
|
||||
.setkey = lq_des_setkey,
|
||||
.encrypt = lq_des_encrypt,
|
||||
.decrypt = lq_des_decrypt,
|
||||
.geniv = "eseqiv",
|
||||
.min_keysize = DES_KEY_SIZE,
|
||||
.max_keysize = DES_KEY_SIZE,
|
||||
.ivsize = DES_BLOCK_SIZE,
|
||||
}
|
||||
}
|
||||
|
||||
},{
|
||||
.alg = {
|
||||
.cra_name = "ecb(des)",
|
||||
.cra_driver_name = "lqdeu-ecb(des)",
|
||||
.cra_flags = CRYPTO_ALG_TYPE_ABLKCIPHER | CRYPTO_ALG_ASYNC,
|
||||
.cra_blocksize = DES_BLOCK_SIZE,
|
||||
.cra_ctxsize = sizeof(struct des_ctx),
|
||||
.cra_type = &crypto_ablkcipher_type,
|
||||
.cra_priority = 300,
|
||||
.cra_module = THIS_MODULE,
|
||||
.cra_ablkcipher = {
|
||||
.setkey = lq_des_setkey,
|
||||
.encrypt = lq_ecb_des_encrypt,
|
||||
.decrypt = lq_ecb_des_decrypt,
|
||||
.geniv = "eseqiv",
|
||||
.min_keysize = DES_KEY_SIZE,
|
||||
.max_keysize = DES_KEY_SIZE,
|
||||
.ivsize = DES_BLOCK_SIZE,
|
||||
}
|
||||
}
|
||||
},{
|
||||
.alg = {
|
||||
.cra_name = "cbc(des)",
|
||||
.cra_driver_name = "lqdeu-cbc(des)",
|
||||
.cra_flags = CRYPTO_ALG_TYPE_ABLKCIPHER | CRYPTO_ALG_ASYNC,
|
||||
.cra_blocksize = DES_BLOCK_SIZE,
|
||||
.cra_ctxsize = sizeof(struct des_ctx),
|
||||
.cra_type = &crypto_ablkcipher_type,
|
||||
.cra_priority = 300,
|
||||
.cra_module = THIS_MODULE,
|
||||
.cra_ablkcipher = {
|
||||
.setkey = lq_des_setkey,
|
||||
.encrypt = lq_cbc_des_encrypt,
|
||||
.decrypt = lq_cbc_des_decrypt,
|
||||
.geniv = "eseqiv",
|
||||
.min_keysize = DES3_EDE_KEY_SIZE,
|
||||
.max_keysize = DES3_EDE_KEY_SIZE,
|
||||
.ivsize = DES3_EDE_BLOCK_SIZE,
|
||||
}
|
||||
}
|
||||
},{
|
||||
.alg = {
|
||||
.cra_name = "des3_ede",
|
||||
.cra_driver_name = "lqdeu-des3_ede",
|
||||
.cra_flags = CRYPTO_ALG_TYPE_ABLKCIPHER | CRYPTO_ALG_ASYNC,
|
||||
.cra_blocksize = DES_BLOCK_SIZE,
|
||||
.cra_ctxsize = sizeof(struct des_ctx),
|
||||
.cra_type = &crypto_ablkcipher_type,
|
||||
.cra_priority = 300,
|
||||
.cra_module = THIS_MODULE,
|
||||
.cra_ablkcipher = {
|
||||
.setkey = lq_des3_ede_setkey,
|
||||
.encrypt = lq_des_encrypt,
|
||||
.decrypt = lq_des_decrypt,
|
||||
.geniv = "eseqiv",
|
||||
.min_keysize = DES_KEY_SIZE,
|
||||
.max_keysize = DES_KEY_SIZE,
|
||||
.ivsize = DES_BLOCK_SIZE,
|
||||
}
|
||||
}
|
||||
},{
|
||||
.alg = {
|
||||
.cra_name = "ecb(des3_ede)",
|
||||
.cra_driver_name = "lqdeu-ecb(des3_ede)",
|
||||
.cra_flags = CRYPTO_ALG_TYPE_ABLKCIPHER | CRYPTO_ALG_ASYNC,
|
||||
.cra_blocksize = DES_BLOCK_SIZE,
|
||||
.cra_ctxsize = sizeof(struct des_ctx),
|
||||
.cra_type = &crypto_ablkcipher_type,
|
||||
.cra_priority = 300,
|
||||
.cra_module = THIS_MODULE,
|
||||
.cra_ablkcipher = {
|
||||
.setkey = lq_des3_ede_setkey,
|
||||
.encrypt = lq_ecb_des_encrypt,
|
||||
.decrypt = lq_ecb_des_decrypt,
|
||||
.geniv = "eseqiv",
|
||||
.min_keysize = DES3_EDE_KEY_SIZE,
|
||||
.max_keysize = DES3_EDE_KEY_SIZE,
|
||||
.ivsize = DES3_EDE_BLOCK_SIZE,
|
||||
}
|
||||
}
|
||||
},{
|
||||
.alg = {
|
||||
.cra_name = "cbc(des3_ede)",
|
||||
.cra_driver_name = "lqdeu-cbc(des3_ede)",
|
||||
.cra_flags = CRYPTO_ALG_TYPE_ABLKCIPHER | CRYPTO_ALG_ASYNC,
|
||||
.cra_blocksize = DES_BLOCK_SIZE,
|
||||
.cra_ctxsize = sizeof(struct des_ctx),
|
||||
.cra_type = &crypto_ablkcipher_type,
|
||||
.cra_priority = 300,
|
||||
.cra_module = THIS_MODULE,
|
||||
.cra_ablkcipher = {
|
||||
.setkey = lq_des3_ede_setkey,
|
||||
.encrypt = lq_cbc_des_encrypt,
|
||||
.decrypt = lq_cbc_des_decrypt,
|
||||
.geniv = "eseqiv",
|
||||
.min_keysize = DES3_EDE_KEY_SIZE,
|
||||
.max_keysize = DES3_EDE_KEY_SIZE,
|
||||
.ivsize = DES3_EDE_BLOCK_SIZE,
|
||||
}
|
||||
}
|
||||
}
|
||||
};
|
||||
|
||||
/*! \fn int __init lqdeu_async_des_init (void)
|
||||
* \ingroup IFX_DES_FUNCTIONS
|
||||
* \brief initialize des driver
|
||||
*/
|
||||
int __init lqdeu_async_des_init (void)
|
||||
{
|
||||
int i, j, ret = -EINVAL;
|
||||
|
||||
#if (LINUX_VERSION_CODE < KERNEL_VERSION(2,6,20))
|
||||
if (!disable_multiblock) {
|
||||
ifxdeu_des_alg.cra_u.cipher.cia_max_nbytes = DES_BLOCK_SIZE; //(size_t)-1;
|
||||
ifxdeu_des_alg.cra_u.cipher.cia_req_align = 16;
|
||||
ifxdeu_des_alg.cra_u.cipher.cia_ecb = ifx_deu_des_ecb;
|
||||
ifxdeu_des_alg.cra_u.cipher.cia_cbc = ifx_deu_des_cbc;
|
||||
ifxdeu_des_alg.cra_u.cipher.cia_cfb = ifx_deu_des_cfb;
|
||||
ifxdeu_des_alg.cra_u.cipher.cia_ofb = ifx_deu_des_ofb;
|
||||
}
|
||||
#endif
|
||||
for (i = 0; i < ARRAY_SIZE(des_drivers_alg); i++) {
|
||||
ret = crypto_register_alg(&des_drivers_alg[i].alg);
|
||||
//printk("driver: %s\n", des_drivers_alg[i].alg.cra_name);
|
||||
if (ret)
|
||||
goto des_err;
|
||||
}
|
||||
|
||||
des_chip_init();
|
||||
CRTCL_SECT_INIT;
|
||||
|
||||
|
||||
printk (KERN_NOTICE "IFX DEU DES initialized%s%s.\n", disable_multiblock ? "" : " (multiblock)", disable_deudma ? "" : " (DMA)");
|
||||
return ret;
|
||||
|
||||
des_err:
|
||||
for (j = 0; j < i; j++)
|
||||
crypto_unregister_alg(&des_drivers_alg[i].alg);
|
||||
|
||||
printk(KERN_ERR "Lantiq %s driver initialization failed!\n", (char *)&des_drivers_alg[i].alg.cra_driver_name);
|
||||
return ret;
|
||||
|
||||
cbc_des3_ede_err:
|
||||
for (i = 0; i < ARRAY_SIZE(des_drivers_alg); i++) {
|
||||
if (!strcmp((char *)&des_drivers_alg[i].alg.cra_name, "cbc(des3_ede)"))
|
||||
crypto_unregister_alg(&des_drivers_alg[i].alg);
|
||||
}
|
||||
|
||||
printk(KERN_ERR "Lantiq %s driver initialization failed!\n", (char *)&des_drivers_alg[i].alg.cra_driver_name);
|
||||
return ret;
|
||||
}
|
||||
|
||||
/*! \fn void __exit lqdeu_fini_async_des (void)
|
||||
* \ingroup IFX_DES_FUNCTIONS
|
||||
* \brief unregister des driver
|
||||
*/
|
||||
void __exit lqdeu_fini_async_des (void)
|
||||
{
|
||||
int i;
|
||||
|
||||
for (i = 0; i < ARRAY_SIZE(des_drivers_alg); i++)
|
||||
crypto_unregister_alg(&des_drivers_alg[i].alg);
|
||||
|
||||
des_queue->hw_status = DES_COMPLETED;
|
||||
DEU_WAKEUP_EVENT(deu_dma_priv.deu_thread_wait, DES_ASYNC_EVENT,
|
||||
deu_dma_priv.des_event_flags);
|
||||
|
||||
kfree(des_queue);
|
||||
}
|
||||
|
768
package/platform/lantiq/ltq-deu/src/ifxmips_des.c
Normal file
768
package/platform/lantiq/ltq-deu/src/ifxmips_des.c
Normal file
@ -0,0 +1,768 @@
|
||||
/******************************************************************************
|
||||
**
|
||||
** FILE NAME : ifxmips_des.c
|
||||
** PROJECT : IFX UEIP
|
||||
** MODULES : DEU Module
|
||||
**
|
||||
** DATE : September 8, 2009
|
||||
** AUTHOR : Mohammad Firdaus
|
||||
** DESCRIPTION : Data Encryption Unit Driver for DES Algorithm
|
||||
** COPYRIGHT : Copyright (c) 2009
|
||||
** Infineon Technologies AG
|
||||
** Am Campeon 1-12, 85579 Neubiberg, Germany
|
||||
**
|
||||
** 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.
|
||||
**
|
||||
** HISTORY
|
||||
** $Date $Author $Comment
|
||||
** 08 Sept 2009 Mohammad Firdaus Initial UEIP release
|
||||
*******************************************************************************/
|
||||
|
||||
/*!
|
||||
\defgroup IFX_DEU IFX_DEU_DRIVERS
|
||||
\ingroup API
|
||||
\brief ifx deu driver
|
||||
*/
|
||||
|
||||
/*!
|
||||
\file ifxmips_des.c
|
||||
\ingroup IFX_DEU
|
||||
\brief DES encryption DEU driver file
|
||||
*/
|
||||
|
||||
/*!
|
||||
\defgroup IFX_DES_FUNCTIONS IFX_DES_FUNCTIONS
|
||||
\ingroup IFX_DEU
|
||||
\brief IFX DES Encryption functions
|
||||
*/
|
||||
|
||||
/* Project Header Files */
|
||||
#include <linux/version.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/init.h>
|
||||
#include <linux/types.h>
|
||||
#include <linux/errno.h>
|
||||
#include <linux/crypto.h>
|
||||
#include <linux/interrupt.h>
|
||||
#include <linux/delay.h>
|
||||
#include <asm/byteorder.h>
|
||||
#include <crypto/algapi.h>
|
||||
#include "ifxmips_deu.h"
|
||||
|
||||
#if defined(CONFIG_DANUBE)
|
||||
#include "ifxmips_deu_danube.h"
|
||||
extern int ifx_danube_pre_1_4;
|
||||
#elif defined(CONFIG_AR9)
|
||||
#include "ifxmips_deu_ar9.h"
|
||||
#elif defined(CONFIG_VR9) || defined(CONFIG_AR10)
|
||||
#include "ifxmips_deu_vr9.h"
|
||||
#else
|
||||
#error "Unkown platform"
|
||||
#endif
|
||||
|
||||
/* DMA specific header and variables */
|
||||
|
||||
#if 0
|
||||
#define CRTCL_SECT_INIT
|
||||
#define CRTCL_SECT_START
|
||||
#define CRTCL_SECT_END
|
||||
#else
|
||||
spinlock_t des_lock;
|
||||
#define CRTCL_SECT_INIT spin_lock_init(&des_lock)
|
||||
#define CRTCL_SECT_START spin_lock_irqsave(&des_lock, flag)
|
||||
#define CRTCL_SECT_END spin_unlock_irqrestore(&des_lock, flag)
|
||||
#endif
|
||||
|
||||
/* Preprocessor declerations */
|
||||
#ifdef CRYPTO_DEBUG
|
||||
extern char debug_level;
|
||||
#define DPRINTF(level, format, args...) if (level < debug_level) printk(KERN_INFO "[%s %s %d]: " format, __FILE__, __func__, __LINE__, ##args);
|
||||
#else
|
||||
#define DPRINTF(level, format, args...)
|
||||
#endif
|
||||
#define DES_3DES_START IFX_DES_CON
|
||||
#define DES_KEY_SIZE 8
|
||||
#define DES_EXPKEY_WORDS 32
|
||||
#define DES_BLOCK_SIZE 8
|
||||
#define DES3_EDE_KEY_SIZE (3 * DES_KEY_SIZE)
|
||||
#define DES3_EDE_EXPKEY_WORDS (3 * DES_EXPKEY_WORDS)
|
||||
#define DES3_EDE_BLOCK_SIZE DES_BLOCK_SIZE
|
||||
|
||||
/* Function Declaration to prevent warning messages */
|
||||
void des_chip_init (void);
|
||||
u32 endian_swap(u32 input);
|
||||
u32 input_swap(u32 input);
|
||||
int aes_memory_allocate(int value);
|
||||
int des_memory_allocate(int value);
|
||||
void memory_release(u32 *buffer);
|
||||
u32* memory_alignment(const u8 *arg, u32 *buff_alloc, int in_out, int nbytes);
|
||||
void aes_dma_memory_copy(u32 *outcopy, u32 *out_dma, u8 *out_arg, int nbytes);
|
||||
void des_dma_memory_copy(u32 *outcopy, u32 *out_dma, u8 *out_arg, int nbytes);
|
||||
|
||||
void ifx_deu_des (void *ctx_arg, u8 *out_arg, const u8 *in_arg,
|
||||
u8 *iv_arg, u32 nbytes, int encdec, int mode);
|
||||
|
||||
struct des_ctx {
|
||||
int controlr_M;
|
||||
int key_length;
|
||||
u8 iv[DES_BLOCK_SIZE];
|
||||
u32 expkey[DES3_EDE_EXPKEY_WORDS];
|
||||
};
|
||||
|
||||
extern int disable_multiblock;
|
||||
extern int disable_deudma;
|
||||
|
||||
|
||||
/*! \fn int des_setkey(struct crypto_tfm *tfm, const u8 *key, unsigned int keylen)
|
||||
* \ingroup IFX_DES_FUNCTIONS
|
||||
* \brief sets DES key
|
||||
* \param tfm linux crypto algo transform
|
||||
* \param key input key
|
||||
* \param keylen key length
|
||||
*/
|
||||
int des_setkey(struct crypto_tfm *tfm, const u8 *key,
|
||||
unsigned int keylen)
|
||||
{
|
||||
struct des_ctx *dctx = crypto_tfm_ctx(tfm);
|
||||
|
||||
//printk("setkey in %s\n", __FILE__);
|
||||
|
||||
dctx->controlr_M = 0; // des
|
||||
dctx->key_length = keylen;
|
||||
|
||||
memcpy ((u8 *) (dctx->expkey), key, keylen);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
||||
/*! \fn void ifx_deu_des(void *ctx_arg, u8 *out_arg, const u8 *in_arg, u8 *iv_arg, u32 nbytes, int encdec, int mode)
|
||||
* \ingroup IFX_DES_FUNCTIONS
|
||||
* \brief main interface to DES hardware
|
||||
* \param ctx_arg crypto algo context
|
||||
* \param out_arg output bytestream
|
||||
* \param in_arg input bytestream
|
||||
* \param iv_arg initialization vector
|
||||
* \param nbytes length of bytestream
|
||||
* \param encdec 1 for encrypt; 0 for decrypt
|
||||
* \param mode operation mode such as ebc, cbc
|
||||
*/
|
||||
|
||||
void ifx_deu_des (void *ctx_arg, u8 *out_arg, const u8 *in_arg,
|
||||
u8 *iv_arg, u32 nbytes, int encdec, int mode)
|
||||
{
|
||||
volatile struct des_t *des = (struct des_t *) DES_3DES_START;
|
||||
struct des_ctx *dctx = ctx_arg;
|
||||
u32 *key = dctx->expkey;
|
||||
unsigned long flag;
|
||||
|
||||
int i = 0;
|
||||
int nblocks = 0;
|
||||
|
||||
CRTCL_SECT_START;
|
||||
|
||||
des->controlr.M = dctx->controlr_M;
|
||||
if (dctx->controlr_M == 0) // des
|
||||
{
|
||||
des->K1HR = DEU_ENDIAN_SWAP(*((u32 *) key + 0));
|
||||
des->K1LR = DEU_ENDIAN_SWAP(*((u32 *) key + 1));
|
||||
|
||||
}
|
||||
else {
|
||||
/* Hardware Section */
|
||||
switch (dctx->key_length) {
|
||||
case 24:
|
||||
des->K3HR = DEU_ENDIAN_SWAP(*((u32 *) key + 4));
|
||||
des->K3LR = DEU_ENDIAN_SWAP(*((u32 *) key + 5));
|
||||
/* no break; */
|
||||
|
||||
case 16:
|
||||
des->K2HR = DEU_ENDIAN_SWAP(*((u32 *) key + 2));
|
||||
des->K2LR = DEU_ENDIAN_SWAP(*((u32 *) key + 3));
|
||||
|
||||
/* no break; */
|
||||
case 8:
|
||||
des->K1HR = DEU_ENDIAN_SWAP(*((u32 *) key + 0));
|
||||
des->K1LR = DEU_ENDIAN_SWAP(*((u32 *) key + 1));
|
||||
break;
|
||||
|
||||
default:
|
||||
CRTCL_SECT_END;
|
||||
return;
|
||||
}
|
||||
}
|
||||
|
||||
des->controlr.E_D = !encdec; //encryption
|
||||
des->controlr.O = mode; //0 ECB 1 CBC 2 OFB 3 CFB 4 CTR hexdump(prin,sizeof(*des));
|
||||
|
||||
if (mode > 0) {
|
||||
des->IVHR = DEU_ENDIAN_SWAP(*(u32 *) iv_arg);
|
||||
des->IVLR = DEU_ENDIAN_SWAP(*((u32 *) iv_arg + 1));
|
||||
};
|
||||
|
||||
nblocks = nbytes / 4;
|
||||
|
||||
for (i = 0; i < nblocks; i += 2) {
|
||||
/* wait for busy bit to clear */
|
||||
|
||||
/*--- Workaround ----------------------------------------------------
|
||||
do a dummy read to the busy flag because it is not raised early
|
||||
enough in CFB/OFB 3DES modes */
|
||||
#ifdef CRYPTO_DEBUG
|
||||
printk ("ihr: %x\n", (*((u32 *) in_arg + i)));
|
||||
printk ("ilr: %x\n", (*((u32 *) in_arg + 1 + i)));
|
||||
#endif
|
||||
des->IHR = INPUT_ENDIAN_SWAP(*((u32 *) in_arg + i));
|
||||
des->ILR = INPUT_ENDIAN_SWAP(*((u32 *) in_arg + 1 + i)); /* start crypto */
|
||||
|
||||
while (des->controlr.BUS) {
|
||||
// this will not take long
|
||||
}
|
||||
|
||||
*((u32 *) out_arg + 0 + i) = des->OHR;
|
||||
*((u32 *) out_arg + 1 + i) = des->OLR;
|
||||
|
||||
}
|
||||
|
||||
|
||||
|
||||
if (mode > 0) {
|
||||
*(u32 *) iv_arg = DEU_ENDIAN_SWAP(des->IVHR);
|
||||
*((u32 *) iv_arg + 1) = DEU_ENDIAN_SWAP(des->IVLR);
|
||||
};
|
||||
|
||||
CRTCL_SECT_END;
|
||||
}
|
||||
|
||||
//definitions from linux/include/crypto.h:
|
||||
//#define CRYPTO_TFM_MODE_ECB 0x00000001
|
||||
//#define CRYPTO_TFM_MODE_CBC 0x00000002
|
||||
//#define CRYPTO_TFM_MODE_CFB 0x00000004
|
||||
//#define CRYPTO_TFM_MODE_CTR 0x00000008
|
||||
//#define CRYPTO_TFM_MODE_OFB 0x00000010 // not even defined
|
||||
//but hardware definition: 0 ECB 1 CBC 2 OFB 3 CFB 4 CTR
|
||||
|
||||
/*! \fn void ifx_deu_des(void *ctx_arg, u8 *out_arg, const u8 *in_arg, u8 *iv_arg, u32 nbytes, int encdec, int mode)
|
||||
* \ingroup IFX_DES_FUNCTIONS
|
||||
* \brief main interface to DES hardware
|
||||
* \param ctx_arg crypto algo context
|
||||
* \param out_arg output bytestream
|
||||
* \param in_arg input bytestream
|
||||
* \param iv_arg initialization vector
|
||||
* \param nbytes length of bytestream
|
||||
* \param encdec 1 for encrypt; 0 for decrypt
|
||||
* \param mode operation mode such as ebc, cbc
|
||||
*/
|
||||
|
||||
|
||||
|
||||
/*! \fn void ifx_deu_des_ecb (void *ctx, uint8_t *dst, const uint8_t *src, uint8_t *iv, size_t nbytes, int encdec, int inplace)
|
||||
* \ingroup IFX_DES_FUNCTIONS
|
||||
* \brief sets DES hardware to ECB mode
|
||||
* \param ctx crypto algo context
|
||||
* \param dst output bytestream
|
||||
* \param src input bytestream
|
||||
* \param iv initialization vector
|
||||
* \param nbytes length of bytestream
|
||||
* \param encdec 1 for encrypt; 0 for decrypt
|
||||
* \param inplace not used
|
||||
*/
|
||||
|
||||
void ifx_deu_des_ecb (void *ctx, uint8_t *dst, const uint8_t *src,
|
||||
uint8_t *iv, size_t nbytes, int encdec, int inplace)
|
||||
{
|
||||
ifx_deu_des (ctx, dst, src, NULL, nbytes, encdec, 0);
|
||||
}
|
||||
|
||||
/*! \fn void ifx_deu_des_cbc (void *ctx, uint8_t *dst, const uint8_t *src, uint8_t *iv, size_t nbytes, int encdec, int inplace)
|
||||
* \ingroup IFX_DES_FUNCTIONS
|
||||
* \brief sets DES hardware to CBC mode
|
||||
* \param ctx crypto algo context
|
||||
* \param dst output bytestream
|
||||
* \param src input bytestream
|
||||
* \param iv initialization vector
|
||||
* \param nbytes length of bytestream
|
||||
* \param encdec 1 for encrypt; 0 for decrypt
|
||||
* \param inplace not used
|
||||
*/
|
||||
void ifx_deu_des_cbc (void *ctx, uint8_t *dst, const uint8_t *src,
|
||||
uint8_t *iv, size_t nbytes, int encdec, int inplace)
|
||||
{
|
||||
ifx_deu_des (ctx, dst, src, iv, nbytes, encdec, 1);
|
||||
}
|
||||
|
||||
/*! \fn void ifx_deu_des_ofb (void *ctx, uint8_t *dst, const uint8_t *src, uint8_t *iv, size_t nbytes, int encdec, int inplace)
|
||||
* \ingroup IFX_DES_FUNCTIONS
|
||||
* \brief sets DES hardware to OFB mode
|
||||
* \param ctx crypto algo context
|
||||
* \param dst output bytestream
|
||||
* \param src input bytestream
|
||||
* \param iv initialization vector
|
||||
* \param nbytes length of bytestream
|
||||
* \param encdec 1 for encrypt; 0 for decrypt
|
||||
* \param inplace not used
|
||||
*/
|
||||
void ifx_deu_des_ofb (void *ctx, uint8_t *dst, const uint8_t *src,
|
||||
uint8_t *iv, size_t nbytes, int encdec, int inplace)
|
||||
{
|
||||
ifx_deu_des (ctx, dst, src, iv, nbytes, encdec, 2);
|
||||
}
|
||||
|
||||
/*! \fn void ifx_deu_des_cfb (void *ctx, uint8_t *dst, const uint8_t *src, uint8_t *iv, size_t nbytes, int encdec, int inplace)
|
||||
\ingroup IFX_DES_FUNCTIONS
|
||||
\brief sets DES hardware to CFB mode
|
||||
\param ctx crypto algo context
|
||||
\param dst output bytestream
|
||||
\param src input bytestream
|
||||
\param iv initialization vector
|
||||
\param nbytes length of bytestream
|
||||
\param encdec 1 for encrypt; 0 for decrypt
|
||||
\param inplace not used
|
||||
*/
|
||||
void ifx_deu_des_cfb (void *ctx, uint8_t *dst, const uint8_t *src,
|
||||
uint8_t *iv, size_t nbytes, int encdec, int inplace)
|
||||
{
|
||||
ifx_deu_des (ctx, dst, src, iv, nbytes, encdec, 3);
|
||||
}
|
||||
|
||||
/*! \fn void ifx_deu_des_ctr (void *ctx, uint8_t *dst, const uint8_t *src, uint8_t *iv, size_t nbytes, int encdec, int inplace)
|
||||
* \ingroup IFX_DES_FUNCTIONS
|
||||
* \brief sets DES hardware to CTR mode
|
||||
* \param ctx crypto algo context
|
||||
* \param dst output bytestream
|
||||
* \param src input bytestream
|
||||
* \param iv initialization vector
|
||||
* \param nbytes length of bytestream
|
||||
* \param encdec 1 for encrypt; 0 for decrypt
|
||||
* \param inplace not used
|
||||
*/
|
||||
void ifx_deu_des_ctr (void *ctx, uint8_t *dst, const uint8_t *src,
|
||||
uint8_t *iv, size_t nbytes, int encdec, int inplace)
|
||||
{
|
||||
ifx_deu_des (ctx, dst, src, iv, nbytes, encdec, 4);
|
||||
}
|
||||
|
||||
/*! \fn void des_encrypt (struct crypto_tfm *tfm, uint8_t *out, const uint8_t *in)
|
||||
* \ingroup IFX_DES_FUNCTIONS
|
||||
* \brief encrypt DES_BLOCK_SIZE of data
|
||||
* \param tfm linux crypto algo transform
|
||||
* \param out output bytestream
|
||||
* \param in input bytestream
|
||||
*/
|
||||
void des_encrypt (struct crypto_tfm *tfm, uint8_t * out, const uint8_t * in)
|
||||
{
|
||||
struct des_ctx *ctx = crypto_tfm_ctx(tfm);
|
||||
ifx_deu_des (ctx, out, in, NULL, DES_BLOCK_SIZE,
|
||||
CRYPTO_DIR_ENCRYPT, 0);
|
||||
|
||||
}
|
||||
|
||||
/*! \fn void des_decrypt (struct crypto_tfm *tfm, uint8_t *out, const uint8_t *in)
|
||||
* \ingroup IFX_DES_FUNCTIONS
|
||||
* \brief encrypt DES_BLOCK_SIZE of data
|
||||
* \param tfm linux crypto algo transform
|
||||
* \param out output bytestream
|
||||
* \param in input bytestream
|
||||
*/
|
||||
void des_decrypt (struct crypto_tfm *tfm, uint8_t * out, const uint8_t * in)
|
||||
{
|
||||
struct des_ctx *ctx = crypto_tfm_ctx(tfm);
|
||||
ifx_deu_des (ctx, out, in, NULL, DES_BLOCK_SIZE,
|
||||
CRYPTO_DIR_DECRYPT, 0);
|
||||
}
|
||||
|
||||
/*
|
||||
* \brief RFC2451:
|
||||
*
|
||||
* For DES-EDE3, there is no known need to reject weak or
|
||||
* complementation keys. Any weakness is obviated by the use of
|
||||
* multiple keys.
|
||||
*
|
||||
* However, if the first two or last two independent 64-bit keys are
|
||||
* equal (k1 == k2 or k2 == k3), then the DES3 operation is simply the
|
||||
* same as DES. Implementers MUST reject keys that exhibit this
|
||||
* property.
|
||||
*
|
||||
*/
|
||||
|
||||
/*! \fn int des3_ede_setkey(struct crypto_tfm *tfm, const u8 *key, unsigned int keylen)
|
||||
* \ingroup IFX_DES_FUNCTIONS
|
||||
* \brief sets 3DES key
|
||||
* \param tfm linux crypto algo transform
|
||||
* \param key input key
|
||||
* \param keylen key length
|
||||
*/
|
||||
int des3_ede_setkey(struct crypto_tfm *tfm, const u8 *key,
|
||||
unsigned int keylen)
|
||||
{
|
||||
struct des_ctx *dctx = crypto_tfm_ctx(tfm);
|
||||
|
||||
//printk("setkey in %s\n", __FILE__);
|
||||
|
||||
dctx->controlr_M = keylen / 8 + 1; // 3DES EDE1 / EDE2 / EDE3 Mode
|
||||
dctx->key_length = keylen;
|
||||
|
||||
memcpy ((u8 *) (dctx->expkey), key, keylen);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
/*
|
||||
* \brief DES function mappings
|
||||
*/
|
||||
struct crypto_alg ifxdeu_des_alg = {
|
||||
.cra_name = "des",
|
||||
.cra_driver_name = "ifxdeu-des",
|
||||
.cra_flags = CRYPTO_ALG_TYPE_CIPHER,
|
||||
.cra_blocksize = DES_BLOCK_SIZE,
|
||||
.cra_ctxsize = sizeof(struct des_ctx),
|
||||
.cra_module = THIS_MODULE,
|
||||
.cra_alignmask = 3,
|
||||
.cra_list = LIST_HEAD_INIT(ifxdeu_des_alg.cra_list),
|
||||
.cra_u = { .cipher = {
|
||||
.cia_min_keysize = DES_KEY_SIZE,
|
||||
.cia_max_keysize = DES_KEY_SIZE,
|
||||
.cia_setkey = des_setkey,
|
||||
.cia_encrypt = des_encrypt,
|
||||
.cia_decrypt = des_decrypt } }
|
||||
};
|
||||
|
||||
/*
|
||||
* \brief DES function mappings
|
||||
*/
|
||||
struct crypto_alg ifxdeu_des3_ede_alg = {
|
||||
.cra_name = "des3_ede",
|
||||
.cra_driver_name = "ifxdeu-des3_ede",
|
||||
.cra_flags = CRYPTO_ALG_TYPE_CIPHER,
|
||||
.cra_blocksize = DES_BLOCK_SIZE,
|
||||
.cra_ctxsize = sizeof(struct des_ctx),
|
||||
.cra_module = THIS_MODULE,
|
||||
.cra_alignmask = 3,
|
||||
.cra_list = LIST_HEAD_INIT(ifxdeu_des3_ede_alg.cra_list),
|
||||
.cra_u = { .cipher = {
|
||||
.cia_min_keysize = DES_KEY_SIZE,
|
||||
.cia_max_keysize = DES_KEY_SIZE,
|
||||
.cia_setkey = des3_ede_setkey,
|
||||
.cia_encrypt = des_encrypt,
|
||||
.cia_decrypt = des_decrypt } }
|
||||
};
|
||||
|
||||
/*! \fn int ecb_des_encrypt(struct blkcipher_desc *desc, struct scatterlist *dst, struct scatterlist *src, unsigned int nbytes)
|
||||
* \ingroup IFX_DES_FUNCTIONS
|
||||
* \brief ECB DES encrypt using linux crypto blkcipher
|
||||
* \param desc blkcipher descriptor
|
||||
* \param dst output scatterlist
|
||||
* \param src input scatterlist
|
||||
* \param nbytes data size in bytes
|
||||
*/
|
||||
int ecb_des_encrypt(struct blkcipher_desc *desc,
|
||||
struct scatterlist *dst, struct scatterlist *src,
|
||||
unsigned int nbytes)
|
||||
{
|
||||
struct des_ctx *ctx = crypto_blkcipher_ctx(desc->tfm);
|
||||
struct blkcipher_walk walk;
|
||||
int err;
|
||||
|
||||
blkcipher_walk_init(&walk, dst, src, nbytes);
|
||||
err = blkcipher_walk_virt(desc, &walk);
|
||||
|
||||
while ((nbytes = walk.nbytes)) {
|
||||
nbytes -= (nbytes % DES_BLOCK_SIZE);
|
||||
ifx_deu_des_ecb(ctx, walk.dst.virt.addr, walk.src.virt.addr,
|
||||
NULL, nbytes, CRYPTO_DIR_ENCRYPT, 0);
|
||||
nbytes &= DES_BLOCK_SIZE - 1;
|
||||
err = blkcipher_walk_done(desc, &walk, nbytes);
|
||||
}
|
||||
|
||||
return err;
|
||||
}
|
||||
|
||||
/*! \fn int ecb_des_decrypt(struct blkcipher_desc *desc, struct scatterlist *dst, struct scatterlist *src, unsigned int nbytes)
|
||||
* \ingroup IFX_DES_FUNCTIONS
|
||||
* \brief ECB DES decrypt using linux crypto blkcipher
|
||||
* \param desc blkcipher descriptor
|
||||
* \param dst output scatterlist
|
||||
* \param src input scatterlist
|
||||
* \param nbytes data size in bytes
|
||||
* \return err
|
||||
*/
|
||||
int ecb_des_decrypt(struct blkcipher_desc *desc,
|
||||
struct scatterlist *dst, struct scatterlist *src,
|
||||
unsigned int nbytes)
|
||||
{
|
||||
struct des_ctx *ctx = crypto_blkcipher_ctx(desc->tfm);
|
||||
struct blkcipher_walk walk;
|
||||
int err;
|
||||
|
||||
DPRINTF(1, "\n");
|
||||
blkcipher_walk_init(&walk, dst, src, nbytes);
|
||||
err = blkcipher_walk_virt(desc, &walk);
|
||||
|
||||
while ((nbytes = walk.nbytes)) {
|
||||
nbytes -= (nbytes % DES_BLOCK_SIZE);
|
||||
ifx_deu_des_ecb(ctx, walk.dst.virt.addr, walk.src.virt.addr,
|
||||
NULL, nbytes, CRYPTO_DIR_DECRYPT, 0);
|
||||
nbytes &= DES_BLOCK_SIZE - 1;
|
||||
err = blkcipher_walk_done(desc, &walk, nbytes);
|
||||
}
|
||||
|
||||
return err;
|
||||
}
|
||||
|
||||
/*
|
||||
* \brief DES function mappings
|
||||
*/
|
||||
struct crypto_alg ifxdeu_ecb_des_alg = {
|
||||
.cra_name = "ecb(des)",
|
||||
.cra_driver_name = "ifxdeu-ecb(des)",
|
||||
.cra_flags = CRYPTO_ALG_TYPE_BLKCIPHER,
|
||||
.cra_blocksize = DES_BLOCK_SIZE,
|
||||
.cra_ctxsize = sizeof(struct des_ctx),
|
||||
.cra_type = &crypto_blkcipher_type,
|
||||
.cra_module = THIS_MODULE,
|
||||
.cra_list = LIST_HEAD_INIT(ifxdeu_ecb_des_alg.cra_list),
|
||||
.cra_u = {
|
||||
.blkcipher = {
|
||||
.min_keysize = DES_KEY_SIZE,
|
||||
.max_keysize = DES_KEY_SIZE,
|
||||
.setkey = des_setkey,
|
||||
.encrypt = ecb_des_encrypt,
|
||||
.decrypt = ecb_des_decrypt,
|
||||
}
|
||||
}
|
||||
};
|
||||
|
||||
/*
|
||||
* \brief DES function mappings
|
||||
*/
|
||||
struct crypto_alg ifxdeu_ecb_des3_ede_alg = {
|
||||
.cra_name = "ecb(des3_ede)",
|
||||
.cra_driver_name = "ifxdeu-ecb(des3_ede)",
|
||||
.cra_flags = CRYPTO_ALG_TYPE_BLKCIPHER,
|
||||
.cra_blocksize = DES3_EDE_BLOCK_SIZE,
|
||||
.cra_ctxsize = sizeof(struct des_ctx),
|
||||
.cra_type = &crypto_blkcipher_type,
|
||||
.cra_module = THIS_MODULE,
|
||||
.cra_list = LIST_HEAD_INIT(ifxdeu_ecb_des3_ede_alg.cra_list),
|
||||
.cra_u = {
|
||||
.blkcipher = {
|
||||
.min_keysize = DES3_EDE_KEY_SIZE,
|
||||
.max_keysize = DES3_EDE_KEY_SIZE,
|
||||
.setkey = des3_ede_setkey,
|
||||
.encrypt = ecb_des_encrypt,
|
||||
.decrypt = ecb_des_decrypt,
|
||||
}
|
||||
}
|
||||
};
|
||||
|
||||
/*! \fn int cbc_des_encrypt(struct blkcipher_desc *desc, struct scatterlist *dst, struct scatterlist *src, unsigned int nbytes)
|
||||
* \ingroup IFX_DES_FUNCTIONS
|
||||
* \brief CBC DES encrypt using linux crypto blkcipher
|
||||
* \param desc blkcipher descriptor
|
||||
* \param dst output scatterlist
|
||||
* \param src input scatterlist
|
||||
* \param nbytes data size in bytes
|
||||
* \return err
|
||||
*/
|
||||
int cbc_des_encrypt(struct blkcipher_desc *desc,
|
||||
struct scatterlist *dst, struct scatterlist *src,
|
||||
unsigned int nbytes)
|
||||
{
|
||||
struct des_ctx *ctx = crypto_blkcipher_ctx(desc->tfm);
|
||||
struct blkcipher_walk walk;
|
||||
int err;
|
||||
|
||||
DPRINTF(1, "\n");
|
||||
blkcipher_walk_init(&walk, dst, src, nbytes);
|
||||
err = blkcipher_walk_virt(desc, &walk);
|
||||
|
||||
while ((nbytes = walk.nbytes)) {
|
||||
u8 *iv = walk.iv;
|
||||
nbytes -= (nbytes % DES_BLOCK_SIZE);
|
||||
ifx_deu_des_cbc(ctx, walk.dst.virt.addr, walk.src.virt.addr,
|
||||
iv, nbytes, CRYPTO_DIR_ENCRYPT, 0);
|
||||
nbytes &= DES_BLOCK_SIZE - 1;
|
||||
err = blkcipher_walk_done(desc, &walk, nbytes);
|
||||
}
|
||||
|
||||
return err;
|
||||
}
|
||||
|
||||
/*! \fn int cbc_des_decrypt(struct blkcipher_desc *desc, struct scatterlist *dst, struct scatterlist *src, unsigned int nbytes)
|
||||
* \ingroup IFX_DES_FUNCTIONS
|
||||
* \brief CBC DES decrypt using linux crypto blkcipher
|
||||
* \param desc blkcipher descriptor
|
||||
* \param dst output scatterlist
|
||||
* \param src input scatterlist
|
||||
* \param nbytes data size in bytes
|
||||
* \return err
|
||||
*/
|
||||
int cbc_des_decrypt(struct blkcipher_desc *desc,
|
||||
struct scatterlist *dst, struct scatterlist *src,
|
||||
unsigned int nbytes)
|
||||
{
|
||||
struct des_ctx *ctx = crypto_blkcipher_ctx(desc->tfm);
|
||||
struct blkcipher_walk walk;
|
||||
int err;
|
||||
|
||||
DPRINTF(1, "\n");
|
||||
blkcipher_walk_init(&walk, dst, src, nbytes);
|
||||
err = blkcipher_walk_virt(desc, &walk);
|
||||
|
||||
while ((nbytes = walk.nbytes)) {
|
||||
u8 *iv = walk.iv;
|
||||
nbytes -= (nbytes % DES_BLOCK_SIZE);
|
||||
ifx_deu_des_cbc(ctx, walk.dst.virt.addr, walk.src.virt.addr,
|
||||
iv, nbytes, CRYPTO_DIR_DECRYPT, 0);
|
||||
nbytes &= DES_BLOCK_SIZE - 1;
|
||||
err = blkcipher_walk_done(desc, &walk, nbytes);
|
||||
}
|
||||
|
||||
return err;
|
||||
}
|
||||
|
||||
/*
|
||||
* \brief DES function mappings
|
||||
*/
|
||||
struct crypto_alg ifxdeu_cbc_des_alg = {
|
||||
.cra_name = "cbc(des)",
|
||||
.cra_driver_name = "ifxdeu-cbc(des)",
|
||||
.cra_flags = CRYPTO_ALG_TYPE_BLKCIPHER,
|
||||
.cra_blocksize = DES_BLOCK_SIZE,
|
||||
.cra_ctxsize = sizeof(struct des_ctx),
|
||||
.cra_type = &crypto_blkcipher_type,
|
||||
.cra_module = THIS_MODULE,
|
||||
.cra_list = LIST_HEAD_INIT(ifxdeu_cbc_des_alg.cra_list),
|
||||
.cra_u = {
|
||||
.blkcipher = {
|
||||
.min_keysize = DES_KEY_SIZE,
|
||||
.max_keysize = DES_KEY_SIZE,
|
||||
.ivsize = DES_BLOCK_SIZE,
|
||||
.setkey = des_setkey,
|
||||
.encrypt = cbc_des_encrypt,
|
||||
.decrypt = cbc_des_decrypt,
|
||||
}
|
||||
}
|
||||
};
|
||||
|
||||
/*
|
||||
* \brief DES function mappings
|
||||
*/
|
||||
struct crypto_alg ifxdeu_cbc_des3_ede_alg = {
|
||||
.cra_name = "cbc(des3_ede)",
|
||||
.cra_driver_name = "ifxdeu-cbc(des3_ede)",
|
||||
.cra_flags = CRYPTO_ALG_TYPE_BLKCIPHER,
|
||||
.cra_blocksize = DES3_EDE_BLOCK_SIZE,
|
||||
.cra_ctxsize = sizeof(struct des_ctx),
|
||||
.cra_type = &crypto_blkcipher_type,
|
||||
.cra_module = THIS_MODULE,
|
||||
.cra_list = LIST_HEAD_INIT(ifxdeu_cbc_des3_ede_alg.cra_list),
|
||||
.cra_u = {
|
||||
.blkcipher = {
|
||||
.min_keysize = DES3_EDE_KEY_SIZE,
|
||||
.max_keysize = DES3_EDE_KEY_SIZE,
|
||||
.ivsize = DES_BLOCK_SIZE,
|
||||
.setkey = des3_ede_setkey,
|
||||
.encrypt = cbc_des_encrypt,
|
||||
.decrypt = cbc_des_decrypt,
|
||||
}
|
||||
}
|
||||
};
|
||||
|
||||
/*! \fn int __init ifxdeu_init_des (void)
|
||||
* \ingroup IFX_DES_FUNCTIONS
|
||||
* \brief initialize des driver
|
||||
*/
|
||||
int __init ifxdeu_init_des (void)
|
||||
{
|
||||
int ret = -ENOSYS;
|
||||
|
||||
|
||||
#if (LINUX_VERSION_CODE < KERNEL_VERSION(2,6,20))
|
||||
if (!disable_multiblock) {
|
||||
ifxdeu_des_alg.cra_u.cipher.cia_max_nbytes = DES_BLOCK_SIZE; //(size_t)-1;
|
||||
ifxdeu_des_alg.cra_u.cipher.cia_req_align = 16;
|
||||
ifxdeu_des_alg.cra_u.cipher.cia_ecb = ifx_deu_des_ecb;
|
||||
ifxdeu_des_alg.cra_u.cipher.cia_cbc = ifx_deu_des_cbc;
|
||||
ifxdeu_des_alg.cra_u.cipher.cia_cfb = ifx_deu_des_cfb;
|
||||
ifxdeu_des_alg.cra_u.cipher.cia_ofb = ifx_deu_des_ofb;
|
||||
}
|
||||
#endif
|
||||
|
||||
ret = crypto_register_alg(&ifxdeu_des_alg);
|
||||
if (ret < 0)
|
||||
goto des_err;
|
||||
|
||||
ret = crypto_register_alg(&ifxdeu_ecb_des_alg);
|
||||
if (ret < 0)
|
||||
goto ecb_des_err;
|
||||
|
||||
ret = crypto_register_alg(&ifxdeu_cbc_des_alg);
|
||||
if (ret < 0)
|
||||
goto cbc_des_err;
|
||||
|
||||
ret = crypto_register_alg(&ifxdeu_des3_ede_alg);
|
||||
if (ret < 0)
|
||||
goto des3_ede_err;
|
||||
|
||||
ret = crypto_register_alg(&ifxdeu_ecb_des3_ede_alg);
|
||||
if (ret < 0)
|
||||
goto ecb_des3_ede_err;
|
||||
|
||||
ret = crypto_register_alg(&ifxdeu_cbc_des3_ede_alg);
|
||||
if (ret < 0)
|
||||
goto cbc_des3_ede_err;
|
||||
|
||||
des_chip_init();
|
||||
CRTCL_SECT_INIT;
|
||||
|
||||
|
||||
|
||||
printk (KERN_NOTICE "IFX DEU DES initialized%s%s.\n", disable_multiblock ? "" : " (multiblock)", disable_deudma ? "" : " (DMA)");
|
||||
return ret;
|
||||
|
||||
des_err:
|
||||
crypto_unregister_alg(&ifxdeu_des_alg);
|
||||
printk(KERN_ERR "IFX des initialization failed!\n");
|
||||
return ret;
|
||||
ecb_des_err:
|
||||
crypto_unregister_alg(&ifxdeu_ecb_des_alg);
|
||||
printk (KERN_ERR "IFX ecb_des initialization failed!\n");
|
||||
return ret;
|
||||
cbc_des_err:
|
||||
crypto_unregister_alg(&ifxdeu_cbc_des_alg);
|
||||
printk (KERN_ERR "IFX cbc_des initialization failed!\n");
|
||||
return ret;
|
||||
des3_ede_err:
|
||||
crypto_unregister_alg(&ifxdeu_des3_ede_alg);
|
||||
printk(KERN_ERR "IFX des3_ede initialization failed!\n");
|
||||
return ret;
|
||||
ecb_des3_ede_err:
|
||||
crypto_unregister_alg(&ifxdeu_ecb_des3_ede_alg);
|
||||
printk (KERN_ERR "IFX ecb_des3_ede initialization failed!\n");
|
||||
return ret;
|
||||
cbc_des3_ede_err:
|
||||
crypto_unregister_alg(&ifxdeu_cbc_des3_ede_alg);
|
||||
printk (KERN_ERR "IFX cbc_des3_ede initialization failed!\n");
|
||||
return ret;
|
||||
|
||||
}
|
||||
|
||||
/*! \fn void __exit ifxdeu_fini_des (void)
|
||||
* \ingroup IFX_DES_FUNCTIONS
|
||||
* \brief unregister des driver
|
||||
*/
|
||||
void __exit ifxdeu_fini_des (void)
|
||||
{
|
||||
crypto_unregister_alg (&ifxdeu_des_alg);
|
||||
crypto_unregister_alg (&ifxdeu_ecb_des_alg);
|
||||
crypto_unregister_alg (&ifxdeu_cbc_des_alg);
|
||||
crypto_unregister_alg (&ifxdeu_des3_ede_alg);
|
||||
crypto_unregister_alg (&ifxdeu_ecb_des3_ede_alg);
|
||||
crypto_unregister_alg (&ifxdeu_cbc_des3_ede_alg);
|
||||
|
||||
}
|
||||
|
210
package/platform/lantiq/ltq-deu/src/ifxmips_deu.c
Normal file
210
package/platform/lantiq/ltq-deu/src/ifxmips_deu.c
Normal file
@ -0,0 +1,210 @@
|
||||
/******************************************************************************
|
||||
**
|
||||
** FILE NAME : ifxmips_deu.c
|
||||
** PROJECT : IFX UEIP
|
||||
** MODULES : DEU Module for Danube
|
||||
**
|
||||
** DATE : September 8, 2009
|
||||
** AUTHOR : Mohammad Firdaus
|
||||
** DESCRIPTION : Data Encryption Unit Driver
|
||||
** COPYRIGHT : Copyright (c) 2009
|
||||
** Infineon Technologies AG
|
||||
** Am Campeon 1-12, 85579 Neubiberg, Germany
|
||||
**
|
||||
** 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.
|
||||
**
|
||||
** HISTORY
|
||||
** $Date $Author $Comment
|
||||
** 08,Sept 2009 Mohammad Firdaus Initial UEIP release
|
||||
*******************************************************************************/
|
||||
|
||||
/*!
|
||||
\defgroup IFX_DEU IFX_DEU_DRIVERS
|
||||
\ingroup API
|
||||
\brief ifx deu driver module
|
||||
*/
|
||||
|
||||
/*!
|
||||
\file ifxmips_deu.c
|
||||
\ingroup IFX_DEU
|
||||
\brief main deu driver file
|
||||
*/
|
||||
|
||||
/*!
|
||||
\defgroup IFX_DEU_FUNCTIONS IFX_DEU_FUNCTIONS
|
||||
\ingroup IFX_DEU
|
||||
\brief IFX DEU functions
|
||||
*/
|
||||
|
||||
/* Project header */
|
||||
#include <linux/version.h>
|
||||
#if defined(CONFIG_MODVERSIONS)
|
||||
#define MODVERSIONS
|
||||
#include <linux/modversions.h>
|
||||
#endif
|
||||
#include <linux/module.h>
|
||||
#include <linux/init.h>
|
||||
#include <linux/types.h>
|
||||
#include <linux/errno.h>
|
||||
#include <linux/crypto.h>
|
||||
#include <linux/proc_fs.h>
|
||||
#include <linux/platform_device.h>
|
||||
#include <linux/fs.h> /* Stuff about file systems that we need */
|
||||
#include <asm/byteorder.h>
|
||||
#include "ifxmips_deu.h"
|
||||
|
||||
#include <lantiq_soc.h>
|
||||
|
||||
#if defined(CONFIG_DANUBE)
|
||||
#include "ifxmips_deu_danube.h"
|
||||
#elif defined(CONFIG_AR9)
|
||||
#include "ifxmips_deu_ar9.h"
|
||||
#elif defined(CONFIG_VR9) || defined(CONFIG_AR10)
|
||||
#include "ifxmips_deu_vr9.h"
|
||||
#else
|
||||
#error "Platform unknown!"
|
||||
#endif /* CONFIG_xxxx */
|
||||
|
||||
int disable_deudma = 1;
|
||||
|
||||
void chip_version(void);
|
||||
|
||||
/*! \fn static int __init deu_init (void)
|
||||
* \ingroup IFX_DEU_FUNCTIONS
|
||||
* \brief link all modules that have been selected in kernel config for ifx hw crypto support
|
||||
* \return ret
|
||||
*/
|
||||
|
||||
static int __devinit ltq_deu_probe(struct platform_device *pdev)
|
||||
{
|
||||
int ret = -ENOSYS;
|
||||
|
||||
|
||||
START_DEU_POWER;
|
||||
|
||||
#define IFX_DEU_DRV_VERSION "2.0.0"
|
||||
printk(KERN_INFO "Infineon Technologies DEU driver version %s \n", IFX_DEU_DRV_VERSION);
|
||||
|
||||
FIND_DEU_CHIP_VERSION;
|
||||
|
||||
#if defined(CONFIG_CRYPTO_DEV_DES)
|
||||
if ((ret = ifxdeu_init_des ())) {
|
||||
printk (KERN_ERR "IFX DES initialization failed!\n");
|
||||
}
|
||||
#endif
|
||||
#if defined(CONFIG_CRYPTO_DEV_AES)
|
||||
if ((ret = ifxdeu_init_aes ())) {
|
||||
printk (KERN_ERR "IFX AES initialization failed!\n");
|
||||
}
|
||||
|
||||
#endif
|
||||
#if defined(CONFIG_CRYPTO_DEV_ARC4)
|
||||
if ((ret = ifxdeu_init_arc4 ())) {
|
||||
printk (KERN_ERR "IFX ARC4 initialization failed!\n");
|
||||
}
|
||||
|
||||
#endif
|
||||
#if defined(CONFIG_CRYPTO_DEV_SHA1)
|
||||
if ((ret = ifxdeu_init_sha1 ())) {
|
||||
printk (KERN_ERR "IFX SHA1 initialization failed!\n");
|
||||
}
|
||||
#endif
|
||||
#if defined(CONFIG_CRYPTO_DEV_MD5)
|
||||
if ((ret = ifxdeu_init_md5 ())) {
|
||||
printk (KERN_ERR "IFX MD5 initialization failed!\n");
|
||||
}
|
||||
|
||||
#endif
|
||||
#if defined(CONFIG_CRYPTO_DEV_SHA1_HMAC)
|
||||
if ((ret = ifxdeu_init_sha1_hmac ())) {
|
||||
printk (KERN_ERR "IFX SHA1_HMAC initialization failed!\n");
|
||||
}
|
||||
#endif
|
||||
#if defined(CONFIG_CRYPTO_DEV_MD5_HMAC)
|
||||
if ((ret = ifxdeu_init_md5_hmac ())) {
|
||||
printk (KERN_ERR "IFX MD5_HMAC initialization failed!\n");
|
||||
}
|
||||
#endif
|
||||
|
||||
|
||||
|
||||
return ret;
|
||||
|
||||
}
|
||||
|
||||
/*! \fn static void __exit deu_fini (void)
|
||||
* \ingroup IFX_DEU_FUNCTIONS
|
||||
* \brief remove the loaded crypto algorithms
|
||||
*/
|
||||
static int __devexit ltq_deu_remove(struct platform_device *pdev)
|
||||
{
|
||||
//#ifdef CONFIG_CRYPTO_DEV_PWR_SAVE_MODE
|
||||
#if defined(CONFIG_CRYPTO_DEV_DES)
|
||||
ifxdeu_fini_des ();
|
||||
#endif
|
||||
#if defined(CONFIG_CRYPTO_DEV_AES)
|
||||
ifxdeu_fini_aes ();
|
||||
#endif
|
||||
#if defined(CONFIG_CRYPTO_DEV_ARC4)
|
||||
ifxdeu_fini_arc4 ();
|
||||
#endif
|
||||
#if defined(CONFIG_CRYPTO_DEV_SHA1)
|
||||
ifxdeu_fini_sha1 ();
|
||||
#endif
|
||||
#if defined(CONFIG_CRYPTO_DEV_MD5)
|
||||
ifxdeu_fini_md5 ();
|
||||
#endif
|
||||
#if defined(CONFIG_CRYPTO_DEV_SHA1_HMAC)
|
||||
ifxdeu_fini_sha1_hmac ();
|
||||
#endif
|
||||
#if defined(CONFIG_CRYPTO_DEV_MD5_HMAC)
|
||||
ifxdeu_fini_md5_hmac ();
|
||||
#endif
|
||||
printk("DEU has exited successfully\n");
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
||||
int disable_multiblock = 0;
|
||||
|
||||
#if LINUX_VERSION_CODE >= KERNEL_VERSION(2,4,0)
|
||||
module_param(disable_multiblock,int,0);
|
||||
|
||||
#else
|
||||
//MODULE_PARM (disable_multiblock, "i");
|
||||
MODULE_PARM_DESC (disable_multiblock,
|
||||
"Disable encryption of whole multiblock buffers.");
|
||||
#endif
|
||||
|
||||
static const struct of_device_id ltq_deu_match[] = {
|
||||
#ifdef CONFIG_DANUBE
|
||||
{ .compatible = "lantiq,deu-danube"},
|
||||
#elif defined CONFIG_AR9
|
||||
{ .compatible = "lantiq,deu-arx100"},
|
||||
#elif defined CONFIG_VR9
|
||||
{ .compatible = "lantiq,deu-xrx200"},
|
||||
#endif
|
||||
{},
|
||||
};
|
||||
MODULE_DEVICE_TABLE(of, ltq_deu_match);
|
||||
|
||||
|
||||
static struct platform_driver ltq_deu_driver = {
|
||||
.probe = ltq_deu_probe,
|
||||
.remove = __devexit_p(ltq_deu_remove),
|
||||
.driver = {
|
||||
.name = "deu",
|
||||
.owner = THIS_MODULE,
|
||||
.of_match_table = ltq_deu_match,
|
||||
},
|
||||
};
|
||||
|
||||
module_platform_driver(ltq_deu_driver);
|
||||
|
||||
MODULE_DESCRIPTION ("Infineon DEU crypto engine support.");
|
||||
MODULE_LICENSE ("GPL");
|
||||
MODULE_AUTHOR ("Mohammad Firdaus");
|
232
package/platform/lantiq/ltq-deu/src/ifxmips_deu.h
Normal file
232
package/platform/lantiq/ltq-deu/src/ifxmips_deu.h
Normal file
@ -0,0 +1,232 @@
|
||||
/******************************************************************************
|
||||
**
|
||||
** FILE NAME : ifxmips_deu.h
|
||||
** DESCRIPTION : Data Encryption Unit Driver
|
||||
** COPYRIGHT : Copyright (c) 2009
|
||||
** Infineon Technologies AG
|
||||
** Am Campeon 1-12, 85579 Neubiberg, Germany
|
||||
**
|
||||
** 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.
|
||||
**
|
||||
** HISTORY
|
||||
** $Date $Author $Comment
|
||||
** 08,Sept 2009 Mohammad Firdaus Initial UEIP release
|
||||
*******************************************************************************/
|
||||
/*!
|
||||
\defgroup IFX_DEU IFX_DEU_DRIVERS
|
||||
\ingroup API
|
||||
\brief ifx deu driver module
|
||||
*/
|
||||
|
||||
/*!
|
||||
\file ifxmips_deu.h
|
||||
\brief main deu driver header file
|
||||
*/
|
||||
|
||||
/*!
|
||||
\defgroup IFX_DEU_DEFINITIONS IFX_DEU_DEFINITIONS
|
||||
\ingroup IFX_DEU
|
||||
\brief ifx deu definitions
|
||||
*/
|
||||
|
||||
|
||||
#ifndef IFXMIPS_DEU_H
|
||||
#define IFXMIPS_DEU_H
|
||||
|
||||
#include <crypto/algapi.h>
|
||||
#include <linux/interrupt.h>
|
||||
|
||||
#define IFXDEU_ALIGNMENT 16
|
||||
|
||||
#define IFX_DEU_BASE_ADDR (KSEG1 | 0x1E103100)
|
||||
#define IFX_DEU_CLK ((volatile u32 *)(IFX_DEU_BASE_ADDR + 0x0000))
|
||||
#define IFX_DES_CON ((volatile u32 *)(IFX_DEU_BASE_ADDR + 0x0010))
|
||||
#define IFX_AES_CON ((volatile u32 *)(IFX_DEU_BASE_ADDR + 0x0050))
|
||||
#define IFX_HASH_CON ((volatile u32 *)(IFX_DEU_BASE_ADDR + 0x00B0))
|
||||
#define IFX_ARC4_CON ((volatile u32 *)(IFX_DEU_BASE_ADDR + 0x0100))
|
||||
|
||||
#define PFX "ifxdeu: "
|
||||
#define CLC_START IFX_DEU_CLK
|
||||
#define IFXDEU_CRA_PRIORITY 300
|
||||
#define IFXDEU_COMPOSITE_PRIORITY 400
|
||||
//#define KSEG1 0xA0000000
|
||||
#define IFX_PMU_ENABLE 1
|
||||
#define IFX_PMU_DISABLE 0
|
||||
|
||||
#define CRYPTO_DIR_ENCRYPT 1
|
||||
#define CRYPTO_DIR_DECRYPT 0
|
||||
|
||||
#define AES_IDLE 0
|
||||
#define AES_BUSY 1
|
||||
#define AES_STARTED 2
|
||||
#define AES_COMPLETED 3
|
||||
#define DES_IDLE 0
|
||||
#define DES_BUSY 1
|
||||
#define DES_STARTED 2
|
||||
#define DES_COMPLETED 3
|
||||
|
||||
#define PROCESS_SCATTER 1
|
||||
#define PROCESS_NEW_PACKET 2
|
||||
|
||||
#define PMU_DEU BIT(20)
|
||||
#define START_DEU_POWER \
|
||||
do { \
|
||||
volatile struct clc_controlr_t *clc = (struct clc_controlr_t *) CLC_START; \
|
||||
ltq_pmu_enable(PMU_DEU); \
|
||||
clc->FSOE = 0; \
|
||||
clc->SBWE = 0; \
|
||||
clc->SPEN = 0; \
|
||||
clc->SBWE = 0; \
|
||||
clc->DISS = 0; \
|
||||
clc->DISR = 0; \
|
||||
} while(0)
|
||||
|
||||
#define STOP_DEU_POWER \
|
||||
do { \
|
||||
volatile struct clc_controlr_t *clc = (struct clc_controlr_t *) CLC_START; \
|
||||
ltq_pmu_disable(PMU_DEU); \
|
||||
clc->FSOE = 1; \
|
||||
clc->SBWE = 1; \
|
||||
clc->SPEN = 1; \
|
||||
clc->SBWE = 1; \
|
||||
clc->DISS = 1; \
|
||||
clc->DISR = 1; \
|
||||
} while (0)
|
||||
|
||||
/*
|
||||
* Not used anymore in UEIP (use IFX_DES_CON, IFX_AES_CON, etc instead)
|
||||
* #define DEU_BASE (KSEG1+0x1E103100)
|
||||
* #define DES_CON (DEU_BASE+0x10)
|
||||
* #define AES_CON (DEU_BASE+0x50)
|
||||
* #define HASH_CON (DEU_BASE+0xB0)
|
||||
* #define DMA_CON (DEU_BASE+0xEC)
|
||||
* #define INT_CON (DEU_BASE+0xF4)
|
||||
* #define ARC4_CON (DEU_BASE+0x100)
|
||||
*/
|
||||
|
||||
|
||||
int __init ifxdeu_init_des (void);
|
||||
int __init ifxdeu_init_aes (void);
|
||||
int __init ifxdeu_init_arc4 (void);
|
||||
int __init ifxdeu_init_sha1 (void);
|
||||
int __init ifxdeu_init_md5 (void);
|
||||
int __init ifxdeu_init_sha1_hmac (void);
|
||||
int __init ifxdeu_init_md5_hmac (void);
|
||||
int __init lqdeu_async_aes_init(void);
|
||||
int __init lqdeu_async_des_init(void);
|
||||
|
||||
void __exit ifxdeu_fini_des (void);
|
||||
void __exit ifxdeu_fini_aes (void);
|
||||
void __exit ifxdeu_fini_arc4 (void);
|
||||
void __exit ifxdeu_fini_sha1 (void);
|
||||
void __exit ifxdeu_fini_md5 (void);
|
||||
void __exit ifxdeu_fini_sha1_hmac (void);
|
||||
void __exit ifxdeu_fini_md5_hmac (void);
|
||||
void __exit ifxdeu_fini_dma(void);
|
||||
void __exit lqdeu_fini_async_aes(void);
|
||||
void __exit lqdeu_fini_async_des(void);
|
||||
void __exit deu_fini (void);
|
||||
int deu_dma_init (void);
|
||||
|
||||
|
||||
|
||||
#define DEU_WAKELIST_INIT(queue) \
|
||||
init_waitqueue_head(&queue)
|
||||
|
||||
#define DEU_WAIT_EVENT_TIMEOUT(queue, event, flags, timeout) \
|
||||
do { \
|
||||
wait_event_interruptible_timeout((queue), \
|
||||
test_bit((event), &(flags)), (timeout)); \
|
||||
clear_bit((event), &(flags)); \
|
||||
}while (0)
|
||||
|
||||
|
||||
#define DEU_WAKEUP_EVENT(queue, event, flags) \
|
||||
do { \
|
||||
set_bit((event), &(flags)); \
|
||||
wake_up_interruptible(&(queue)); \
|
||||
}while (0)
|
||||
|
||||
#define DEU_WAIT_EVENT(queue, event, flags) \
|
||||
do { \
|
||||
wait_event_interruptible(queue, \
|
||||
test_bit((event), &(flags))); \
|
||||
clear_bit((event), &(flags)); \
|
||||
}while (0)
|
||||
|
||||
typedef struct deu_drv_priv {
|
||||
wait_queue_head_t deu_thread_wait;
|
||||
#define DEU_EVENT 1
|
||||
#define DES_ASYNC_EVENT 2
|
||||
#define AES_ASYNC_EVENT 3
|
||||
volatile long des_event_flags;
|
||||
volatile long aes_event_flags;
|
||||
volatile long deu_event_flags;
|
||||
int event_src;
|
||||
u32 *deu_rx_buf;
|
||||
u32 *outcopy;
|
||||
u32 deu_rx_len;
|
||||
|
||||
struct aes_priv *aes_dataptr;
|
||||
struct des_priv *des_dataptr;
|
||||
}deu_drv_priv_t;
|
||||
|
||||
|
||||
/**
|
||||
* struct aes_priv_t - ASYNC AES
|
||||
* @lock: spinlock lock
|
||||
* @lock_flag: flag for spinlock activities
|
||||
* @list: crypto queue API list
|
||||
* @hw_status: DEU hw status flag
|
||||
* @aes_wait_flag: flag for sleep queue
|
||||
* @aes_wait_queue: queue attributes for aes
|
||||
* @bytes_processed: number of bytes to process by DEU
|
||||
* @aes_pid: pid number for AES thread
|
||||
* @aes_sync: atomic wait sync for AES
|
||||
*
|
||||
*/
|
||||
|
||||
typedef struct {
|
||||
spinlock_t lock;
|
||||
struct crypto_queue list;
|
||||
unsigned int hw_status;
|
||||
volatile long aes_wait_flag;
|
||||
wait_queue_head_t aes_wait_queue;
|
||||
|
||||
pid_t aes_pid;
|
||||
|
||||
struct tasklet_struct aes_task;
|
||||
|
||||
} aes_priv_t;
|
||||
|
||||
/**
|
||||
* struct des_priv_t - ASYNC DES
|
||||
* @lock: spinlock lock
|
||||
* @list: crypto queue API list
|
||||
* @hw_status: DEU hw status flag
|
||||
* @des_wait_flag: flag for sleep queue
|
||||
* @des_wait_queue: queue attributes for des
|
||||
* @des_pid: pid number for DES thread
|
||||
* @des_sync: atomic wait sync for DES
|
||||
*
|
||||
*/
|
||||
|
||||
typedef struct {
|
||||
spinlock_t lock;
|
||||
struct crypto_queue list;
|
||||
unsigned int hw_status;
|
||||
volatile long des_wait_flag;
|
||||
wait_queue_head_t des_wait_queue;
|
||||
|
||||
pid_t des_pid;
|
||||
|
||||
struct tasklet_struct des_task;
|
||||
|
||||
} des_priv_t;
|
||||
|
||||
#endif /* IFXMIPS_DEU_H */
|
||||
|
||||
|
135
package/platform/lantiq/ltq-deu/src/ifxmips_deu_ar9.c
Normal file
135
package/platform/lantiq/ltq-deu/src/ifxmips_deu_ar9.c
Normal file
@ -0,0 +1,135 @@
|
||||
/******************************************************************************
|
||||
**
|
||||
** FILE NAME : ifxmips_deu_ar9.c
|
||||
** PROJECT : IFX UEIP
|
||||
** MODULES : DEU Module for AR9
|
||||
**
|
||||
** DATE : September 8, 2009
|
||||
** AUTHOR : Mohammad Firdaus
|
||||
** DESCRIPTION : Data Encryption Unit Driver
|
||||
** COPYRIGHT : Copyright (c) 2009
|
||||
** Infineon Technologies AG
|
||||
** Am Campeon 1-12, 85579 Neubiberg, Germany
|
||||
**
|
||||
** 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.
|
||||
**
|
||||
** HISTORY
|
||||
** $Date $Author $Comment
|
||||
** 08,Sept 2009 Mohammad Firdaus Initial UEIP release
|
||||
*******************************************************************************/
|
||||
/*!
|
||||
\defgroup IFX_DEU IFX_DEU_DRIVERS
|
||||
\ingroup API
|
||||
\brief ifx deu driver module
|
||||
*/
|
||||
|
||||
/*!
|
||||
\file ifxmips_deu_ar9.c
|
||||
\brief ifx deu board specific driver file for ar9
|
||||
*/
|
||||
|
||||
/*!
|
||||
\defgroup BOARD_SPECIFIC_FUNCTIONS IFX_BOARD_SPECIFIC_FUNCTIONS
|
||||
\ingroup IFX_DEU
|
||||
\brief board specific 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_dma.h"
|
||||
#include "ifxmips_deu_ar9.h"
|
||||
|
||||
/* Function decleration */
|
||||
void 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 aes_dma_memory_copy(u32 *outcopy, u32 *out_dma, u8 *out_arg, int nbytes);
|
||||
void des_dma_memory_copy(u32 *outcopy, u32 *out_dma, u8 *out_arg, int nbytes);
|
||||
void deu_dma_priv_init(void);
|
||||
void __exit ifxdeu_fini_dma(void);
|
||||
|
||||
#define DES_3DES_START IFX_DES_CON
|
||||
#define AES_START IFX_AES_CON
|
||||
#define CLC_START IFX_DEU_CLK
|
||||
|
||||
/* Variables */
|
||||
|
||||
u8 *g_dma_page_ptr = NULL;
|
||||
u8 *g_dma_block = NULL;
|
||||
u8 *g_dma_block2 = NULL;
|
||||
|
||||
deu_drv_priv_t deu_dma_priv;
|
||||
|
||||
|
||||
/*! \fn u32 endian_swap(u32 input)
|
||||
* \ingroup BOARD_SPECIFIC_FUNCTIONS
|
||||
* \brief Swap data given to the function
|
||||
* \param input Data input to be swapped
|
||||
* \return either the swapped data or the input data depending on whether it is in DMA mode or FPI mode
|
||||
*/
|
||||
u32 endian_swap(u32 input)
|
||||
{
|
||||
return input;
|
||||
}
|
||||
|
||||
/*! \fn u32 input_swap(u32 input)
|
||||
* \ingroup BOARD_SPECIFIC_FUNCTIONS
|
||||
* \brief Not used
|
||||
* \return input
|
||||
*/
|
||||
|
||||
u32 input_swap(u32 input)
|
||||
{
|
||||
return input;
|
||||
}
|
||||
|
||||
/*! \fn void aes_chip_init (void)
|
||||
* \ingroup BOARD_SPECIFIC_FUNCTIONS
|
||||
* \brief initialize AES hardware
|
||||
*/
|
||||
|
||||
void aes_chip_init (void)
|
||||
{
|
||||
volatile struct aes_t *aes = (struct aes_t *) AES_START;
|
||||
|
||||
aes->controlr.SM = 1;
|
||||
aes->controlr.ARS = 1;
|
||||
|
||||
}
|
||||
|
||||
/*! \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;
|
||||
|
||||
// start crypto engine with write to ILR
|
||||
des->controlr.SM = 1;
|
||||
asm("sync");
|
||||
des->controlr.ARS = 1;
|
||||
|
||||
}
|
||||
|
||||
/*! \fn void chip_version(void)
|
||||
* \ingroup BOARD_SPECIFIC_FUNCTIONS
|
||||
* \brief not used!
|
||||
*/
|
||||
|
||||
void chip_version(void)
|
||||
{
|
||||
return;
|
||||
}
|
||||
|
299
package/platform/lantiq/ltq-deu/src/ifxmips_deu_ar9.h
Normal file
299
package/platform/lantiq/ltq-deu/src/ifxmips_deu_ar9.h
Normal file
@ -0,0 +1,299 @@
|
||||
/******************************************************************************
|
||||
**
|
||||
** FILE NAME : ifxmips_deu_ar9.h
|
||||
** PROJECT : IFX UEIP
|
||||
** MODULES : DEU Module for AR9
|
||||
**
|
||||
** DATE : September 8, 2009
|
||||
** AUTHOR : Mohammad Firdaus
|
||||
** DESCRIPTION : Data Encryption Unit Driver
|
||||
** COPYRIGHT : Copyright (c) 2009
|
||||
** Infineon Technologies AG
|
||||
** Am Campeon 1-12, 85579 Neubiberg, Germany
|
||||
**
|
||||
** 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.
|
||||
**
|
||||
** HISTORY
|
||||
** $Date $Author $Comment
|
||||
** 08,Sept 2009 Mohammad Firdaus Initial UEIP release
|
||||
*******************************************************************************/
|
||||
/*!
|
||||
\defgroup IFX_DEU IFX_DEU_DRIVERS
|
||||
\ingroup API
|
||||
\brief deu driver module
|
||||
*/
|
||||
|
||||
/*!
|
||||
\defgroup IFX_DEU_DEFINITIONS IFX_DEU_DEFINITIONS
|
||||
\ingroup IFX_DEU
|
||||
\brief ifx deu definitions
|
||||
*/
|
||||
|
||||
/*!
|
||||
\file ifxmips_deu_ar9.h
|
||||
\brief deu driver header file
|
||||
*/
|
||||
|
||||
|
||||
#ifndef IFXMIPS_DEU_AR9_H
|
||||
#define IFXMIPS_DEU_AR9_H
|
||||
|
||||
/* Project Header Files */
|
||||
#include <linux/version.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/init.h>
|
||||
#include <linux/types.h>
|
||||
#include <linux/errno.h>
|
||||
#include <linux/crypto.h>
|
||||
#include <linux/interrupt.h>
|
||||
#include <linux/delay.h>
|
||||
#include <asm/byteorder.h>
|
||||
#include <crypto/algapi.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/mm.h>
|
||||
#include <asm/scatterlist.h>
|
||||
#include <linux/skbuff.h>
|
||||
#include <linux/netdevice.h>
|
||||
#include "ifxmips_deu.h"
|
||||
|
||||
|
||||
/* SHA CONSTANTS */
|
||||
#define HASH_CON_VALUE 0x0700002C
|
||||
|
||||
#define INPUT_ENDIAN_SWAP(input) input_swap(input)
|
||||
#define DEU_ENDIAN_SWAP(input) endian_swap(input)
|
||||
#define DELAY_PERIOD 10
|
||||
#define FIND_DEU_CHIP_VERSION chip_version()
|
||||
#define CLC_START IFX_DEU_CLK
|
||||
|
||||
#define AES_INIT 0
|
||||
#define DES_INIT 1
|
||||
#define ARC4_INIT 2
|
||||
#define SHA1_INIT 3
|
||||
#define MD5_INIT 4
|
||||
#define SHA1_HMAC_INIT 5
|
||||
#define MD5_HMAC_INIT 6
|
||||
|
||||
#define AES_START IFX_AES_CON
|
||||
#define DES_3DES_START IFX_DES_CON
|
||||
|
||||
#define WAIT_AES_DMA_READY() \
|
||||
do { \
|
||||
int i; \
|
||||
volatile struct deu_dma_t *dma = (struct deu_dma_t *) IFX_DEU_DMA_CON; \
|
||||
volatile struct aes_t *aes = (volatile struct aes_t *) AES_START; \
|
||||
for (i = 0; i < 10; i++) \
|
||||
udelay(DELAY_PERIOD); \
|
||||
while (dma->controlr.BSY) {}; \
|
||||
while (aes->controlr.BUS) {}; \
|
||||
} while (0)
|
||||
|
||||
#define WAIT_DES_DMA_READY() \
|
||||
do { \
|
||||
int i; \
|
||||
volatile struct deu_dma_t *dma = (struct deu_dma_t *) IFX_DEU_DMA_CON; \
|
||||
volatile struct des_t *des = (struct des_t *) DES_3DES_START; \
|
||||
for (i = 0; i < 10; i++) \
|
||||
udelay(DELAY_PERIOD); \
|
||||
while (dma->controlr.BSY) {}; \
|
||||
while (des->controlr.BUS) {}; \
|
||||
} while (0)
|
||||
|
||||
#define AES_DMA_MISC_CONFIG() \
|
||||
do { \
|
||||
volatile struct aes_t *aes = (volatile struct aes_t *) AES_START; \
|
||||
aes->controlr.KRE = 1; \
|
||||
aes->controlr.GO = 1; \
|
||||
} while(0)
|
||||
|
||||
#define SHA_HASH_INIT \
|
||||
do { \
|
||||
volatile struct deu_hash_t *hash = (struct deu_hash_t *) HASH_START; \
|
||||
hash->controlr.SM = 1; \
|
||||
hash->controlr.ALGO = 0; \
|
||||
hash->controlr.INIT = 1; \
|
||||
} while(0)
|
||||
|
||||
/* DEU Common Structures for AR9*/
|
||||
|
||||
struct clc_controlr_t {
|
||||
u32 Res:26;
|
||||
u32 FSOE:1;
|
||||
u32 SBWE:1;
|
||||
u32 EDIS:1;
|
||||
u32 SPEN:1;
|
||||
u32 DISS:1;
|
||||
u32 DISR:1;
|
||||
|
||||
};
|
||||
|
||||
struct des_t {
|
||||
struct des_controlr { //10h
|
||||
u32 KRE:1;
|
||||
u32 reserved1:5;
|
||||
u32 GO:1;
|
||||
u32 STP:1;
|
||||
u32 Res2:6;
|
||||
u32 NDC:1;
|
||||
u32 ENDI:1;
|
||||
u32 Res3:2;
|
||||
u32 F:3;
|
||||
u32 O:3;
|
||||
u32 BUS:1;
|
||||
u32 DAU:1;
|
||||
u32 ARS:1;
|
||||
u32 SM:1;
|
||||
u32 E_D:1;
|
||||
u32 M:3;
|
||||
|
||||
} controlr;
|
||||
u32 IHR; //14h
|
||||
u32 ILR; //18h
|
||||
u32 K1HR; //1c
|
||||
u32 K1LR; //
|
||||
u32 K2HR;
|
||||
u32 K2LR;
|
||||
u32 K3HR;
|
||||
u32 K3LR; //30h
|
||||
u32 IVHR; //34h
|
||||
u32 IVLR; //38
|
||||
u32 OHR; //3c
|
||||
u32 OLR; //40
|
||||
};
|
||||
|
||||
struct aes_t {
|
||||
struct aes_controlr {
|
||||
|
||||
u32 KRE:1;
|
||||
u32 reserved1:4;
|
||||
u32 PNK:1;
|
||||
u32 GO:1;
|
||||
u32 STP:1;
|
||||
u32 reserved2:6;
|
||||
u32 NDC:1;
|
||||
u32 ENDI:1;
|
||||
u32 reserved3:2;
|
||||
u32 F:3; //fbs
|
||||
u32 O:3; //om
|
||||
u32 BUS:1; //bsy
|
||||
u32 DAU:1;
|
||||
u32 ARS:1;
|
||||
u32 SM:1;
|
||||
u32 E_D:1;
|
||||
u32 KV:1;
|
||||
u32 K:2; //KL
|
||||
|
||||
} controlr;
|
||||
u32 ID3R; //80h
|
||||
u32 ID2R; //84h
|
||||
u32 ID1R; //88h
|
||||
u32 ID0R; //8Ch
|
||||
u32 K7R; //90h
|
||||
u32 K6R; //94h
|
||||
u32 K5R; //98h
|
||||
u32 K4R; //9Ch
|
||||
u32 K3R; //A0h
|
||||
u32 K2R; //A4h
|
||||
u32 K1R; //A8h
|
||||
u32 K0R; //ACh
|
||||
u32 IV3R; //B0h
|
||||
u32 IV2R; //B4h
|
||||
u32 IV1R; //B8h
|
||||
u32 IV0R; //BCh
|
||||
u32 OD3R; //D4h
|
||||
u32 OD2R; //D8h
|
||||
u32 OD1R; //DCh
|
||||
u32 OD0R; //E0h
|
||||
};
|
||||
|
||||
struct arc4_t {
|
||||
struct arc4_controlr {
|
||||
|
||||
u32 KRE:1;
|
||||
u32 KLEN:4;
|
||||
u32 KSAE:1;
|
||||
u32 GO:1;
|
||||
u32 STP:1;
|
||||
u32 reserved1:6;
|
||||
u32 NDC:1;
|
||||
u32 ENDI:1;
|
||||
u32 reserved2:8;
|
||||
u32 BUS:1; //bsy
|
||||
u32 reserved3:1;
|
||||
u32 ARS:1;
|
||||
u32 SM:1;
|
||||
u32 reserved4:4;
|
||||
|
||||
} controlr;
|
||||
u32 K3R; //104h
|
||||
u32 K2R; //108h
|
||||
u32 K1R; //10Ch
|
||||
u32 K0R; //110h
|
||||
|
||||
u32 IDLEN; //114h
|
||||
|
||||
u32 ID3R; //118h
|
||||
u32 ID2R; //11Ch
|
||||
u32 ID1R; //120h
|
||||
u32 ID0R; //124h
|
||||
|
||||
u32 OD3R; //128h
|
||||
u32 OD2R; //12Ch
|
||||
u32 OD1R; //130h
|
||||
u32 OD0R; //134h
|
||||
};
|
||||
|
||||
struct deu_hash_t {
|
||||
struct hash_controlr {
|
||||
u32 reserved1:5;
|
||||
u32 KHS:1;
|
||||
u32 GO:1;
|
||||
u32 INIT:1;
|
||||
u32 reserved2:6;
|
||||
u32 NDC:1;
|
||||
u32 ENDI:1;
|
||||
u32 reserved3:7;
|
||||
u32 DGRY:1;
|
||||
u32 BSY:1;
|
||||
u32 reserved4:1;
|
||||
u32 IRCL:1;
|
||||
u32 SM:1;
|
||||
u32 KYUE:1;
|
||||
u32 HMEN:1;
|
||||
u32 SSEN:1;
|
||||
u32 ALGO:1;
|
||||
|
||||
} controlr;
|
||||
u32 MR; //B4h
|
||||
u32 D1R; //B8h
|
||||
u32 D2R; //BCh
|
||||
u32 D3R; //C0h
|
||||
u32 D4R; //C4h
|
||||
u32 D5R; //C8h
|
||||
|
||||
u32 dummy; //CCh
|
||||
|
||||
u32 KIDX; //D0h
|
||||
u32 KEY; //D4h
|
||||
u32 DBN; //D8h
|
||||
};
|
||||
|
||||
|
||||
struct deu_dma_t {
|
||||
struct dma_controlr {
|
||||
u32 reserved1:22;
|
||||
u32 BS:2;
|
||||
u32 BSY:1;
|
||||
u32 reserved2:1;
|
||||
u32 ALGO:2;
|
||||
u32 RXCLS:2;
|
||||
u32 reserved3:1;
|
||||
u32 EN:1;
|
||||
|
||||
} controlr;
|
||||
};
|
||||
|
||||
#endif /* IFXMIPS_DEU_AR9_H */
|
168
package/platform/lantiq/ltq-deu/src/ifxmips_deu_danube.c
Normal file
168
package/platform/lantiq/ltq-deu/src/ifxmips_deu_danube.c
Normal file
@ -0,0 +1,168 @@
|
||||
/******************************************************************************
|
||||
**
|
||||
** FILE NAME : ifxmips_deu_danube.c
|
||||
** PROJECT : IFX UEIP
|
||||
** MODULES : DEU Module for Danube
|
||||
**
|
||||
** DATE : September 8, 2009
|
||||
** AUTHOR : Mohammad Firdaus
|
||||
** DESCRIPTION : Data Encryption Unit Driver
|
||||
** COPYRIGHT : Copyright (c) 2009
|
||||
** Infineon Technologies AG
|
||||
** Am Campeon 1-12, 85579 Neubiberg, Germany
|
||||
**
|
||||
** 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.
|
||||
**
|
||||
** HISTORY
|
||||
** $Date $Author $Comment
|
||||
** 08,Sept 2009 Mohammad Firdaus Initial UEIP release
|
||||
*******************************************************************************/
|
||||
/*!
|
||||
\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_dma.h"
|
||||
#include "ifxmips_deu_danube.h"
|
||||
|
||||
|
||||
/* 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 chip_version(void);
|
||||
void deu_dma_priv_init(void);
|
||||
void __exit ifxdeu_fini_dma(void);
|
||||
|
||||
#define DES_3DES_START IFX_DES_CON
|
||||
#define AES_START IFX_AES_CON
|
||||
#define CLC_START IFX_DEU_CLK
|
||||
|
||||
/* Variables definition */
|
||||
int ifx_danube_pre_1_4;
|
||||
u8 *g_dma_page_ptr = NULL;
|
||||
u8 *g_dma_block = NULL;
|
||||
u8 *g_dma_block2 = NULL;
|
||||
|
||||
deu_drv_priv_t deu_dma_priv;
|
||||
|
||||
|
||||
/*! \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;
|
||||
|
||||
//start crypto engine with write to ILR
|
||||
aes->controlr.SM = 1;
|
||||
aes->controlr.ARS = 1;
|
||||
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;
|
||||
|
||||
// start crypto engine with write to ILR
|
||||
des->controlr.SM = 1;
|
||||
des->controlr.ARS = 1;
|
||||
}
|
||||
|
||||
/*! \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)
|
||||
*/
|
||||
#define IFX_MPS (KSEG1 | 0x1F107000)
|
||||
#define IFX_MPS_CHIPID ((volatile u32*)(IFX_MPS + 0x0344))
|
||||
|
||||
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;
|
||||
}
|
||||
|
250
package/platform/lantiq/ltq-deu/src/ifxmips_deu_danube.h
Normal file
250
package/platform/lantiq/ltq-deu/src/ifxmips_deu_danube.h
Normal file
@ -0,0 +1,250 @@
|
||||
/******************************************************************************
|
||||
**
|
||||
** FILE NAME : ifxmips_deu_danube.h
|
||||
** PROJECT : IFX UEIP
|
||||
** MODULES : DEU Module for Danube
|
||||
**
|
||||
** DATE : September 8, 2009
|
||||
** AUTHOR : Mohammad Firdaus
|
||||
** DESCRIPTION : Data Encryption Unit Driver
|
||||
** COPYRIGHT : Copyright (c) 2009
|
||||
** Infineon Technologies AG
|
||||
** Am Campeon 1-12, 85579 Neubiberg, Germany
|
||||
**
|
||||
** 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.
|
||||
**
|
||||
** HISTORY
|
||||
** $Date $Author $Comment
|
||||
** 08,Sept 2009 Mohammad Firdaus Initial UEIP release
|
||||
*******************************************************************************/
|
||||
/*!
|
||||
\defgroup IFX_DEU IFX_DEU_DRIVERS
|
||||
\ingroup API
|
||||
\brief deu driver module
|
||||
*/
|
||||
|
||||
/*!
|
||||
\file ifxmips_deu_danube.h
|
||||
\brief board specific driver header file for danube
|
||||
*/
|
||||
|
||||
/*!
|
||||
\defgroup BOARD_SPECIFIC_FUNCTIONS IFX_BOARD_SPECIFIC_FUNCTIONS
|
||||
\ingroup IFX_DEU
|
||||
\brief board specific deu header files
|
||||
*/
|
||||
|
||||
#ifndef IFXMIPS_DEU_DANUBE_H
|
||||
#define IFXMIPS_DEU_DANUBE_H
|
||||
|
||||
/* Project Header Files */
|
||||
#include <linux/version.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/init.h>
|
||||
#include <linux/types.h>
|
||||
#include <linux/errno.h>
|
||||
#include <linux/crypto.h>
|
||||
#include <linux/interrupt.h>
|
||||
#include <linux/delay.h>
|
||||
#include <asm/byteorder.h>
|
||||
#include <crypto/algapi.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/mm.h>
|
||||
#include <asm/scatterlist.h>
|
||||
#include <linux/skbuff.h>
|
||||
#include <linux/netdevice.h>
|
||||
#include "ifxmips_deu.h"
|
||||
|
||||
|
||||
|
||||
#define INPUT_ENDIAN_SWAP(input) input_swap(input)
|
||||
#define DEU_ENDIAN_SWAP(input) endian_swap(input)
|
||||
#define FIND_DEU_CHIP_VERSION chip_version()
|
||||
#define AES_DMA_MISC_CONFIG()
|
||||
#define CLC_START IFX_DEU_CLK
|
||||
|
||||
#define AES_START IFX_AES_CON
|
||||
#define DES_3DES_START IFX_DES_CON
|
||||
|
||||
#define AES_INIT 0
|
||||
#define DES_INIT 1
|
||||
#define SHA1_INIT 2
|
||||
#define MD5_INIT 3
|
||||
|
||||
#define WAIT_AES_DMA_READY() \
|
||||
do { \
|
||||
int i; \
|
||||
volatile struct deu_dma_t *dma = (struct deu_dma_t *) IFX_DEU_DMA_CON; \
|
||||
volatile struct aes_t *aes = (volatile struct aes_t *) AES_START; \
|
||||
for (i = 0; i < 10; i++) \
|
||||
udelay(DELAY_PERIOD); \
|
||||
while (dma->controlr.BSY) {}; \
|
||||
while (aes->controlr.BUS) {}; \
|
||||
} while (0)
|
||||
|
||||
#define WAIT_DES_DMA_READY() \
|
||||
do { \
|
||||
int i; \
|
||||
volatile struct deu_dma_t *dma = (struct deu_dma_t *) IFX_DEU_DMA_CON; \
|
||||
volatile struct des_t *des = (struct des_t *) DES_3DES_START; \
|
||||
for (i = 0; i < 10; i++) \
|
||||
udelay(DELAY_PERIOD); \
|
||||
while (dma->controlr.BSY) {}; \
|
||||
while (des->controlr.BUS) {}; \
|
||||
} while (0)
|
||||
|
||||
#define SHA_HASH_INIT \
|
||||
do { \
|
||||
volatile struct deu_hash_t *hash = (struct deu_hash_t *) HASH_START; \
|
||||
hash->controlr.SM = 1; \
|
||||
hash->controlr.ALGO = 0; \
|
||||
hash->controlr.INIT = 1; \
|
||||
} while(0)
|
||||
|
||||
/* DEU STRUCTURES */
|
||||
|
||||
struct clc_controlr_t {
|
||||
u32 Res:26;
|
||||
u32 FSOE:1;
|
||||
u32 SBWE:1;
|
||||
u32 EDIS:1;
|
||||
u32 SPEN:1;
|
||||
u32 DISS:1;
|
||||
u32 DISR:1;
|
||||
|
||||
};
|
||||
|
||||
struct des_t {
|
||||
struct des_controlr { //10h
|
||||
u32 KRE:1;
|
||||
u32 reserved1:5;
|
||||
u32 GO:1;
|
||||
u32 STP:1;
|
||||
u32 Res2:6;
|
||||
u32 NDC:1;
|
||||
u32 ENDI:1;
|
||||
u32 Res3:2;
|
||||
u32 F:3;
|
||||
u32 O:3;
|
||||
u32 BUS:1;
|
||||
u32 DAU:1;
|
||||
u32 ARS:1;
|
||||
u32 SM:1;
|
||||
u32 E_D:1;
|
||||
u32 M:3;
|
||||
|
||||
} controlr;
|
||||
u32 IHR; //14h
|
||||
u32 ILR; //18h
|
||||
u32 K1HR; //1c
|
||||
u32 K1LR; //
|
||||
u32 K2HR;
|
||||
u32 K2LR;
|
||||
u32 K3HR;
|
||||
u32 K3LR; //30h
|
||||
u32 IVHR; //34h
|
||||
u32 IVLR; //38
|
||||
u32 OHR; //3c
|
||||
u32 OLR; //40
|
||||
};
|
||||
|
||||
struct aes_t {
|
||||
struct aes_controlr {
|
||||
|
||||
u32 KRE:1;
|
||||
u32 reserved1:4;
|
||||
u32 PNK:1;
|
||||
u32 GO:1;
|
||||
u32 STP:1;
|
||||
|
||||
u32 reserved2:6;
|
||||
u32 NDC:1;
|
||||
u32 ENDI:1;
|
||||
u32 reserved3:2;
|
||||
|
||||
u32 F:3; //fbs
|
||||
u32 O:3; //om
|
||||
u32 BUS:1; //bsy
|
||||
u32 DAU:1;
|
||||
u32 ARS:1;
|
||||
u32 SM:1;
|
||||
u32 E_D:1;
|
||||
u32 KV:1;
|
||||
u32 K:2; //KL
|
||||
|
||||
} controlr;
|
||||
u32 ID3R; //80h
|
||||
u32 ID2R; //84h
|
||||
u32 ID1R; //88h
|
||||
u32 ID0R; //8Ch
|
||||
u32 K7R; //90h
|
||||
u32 K6R; //94h
|
||||
u32 K5R; //98h
|
||||
u32 K4R; //9Ch
|
||||
u32 K3R; //A0h
|
||||
u32 K2R; //A4h
|
||||
u32 K1R; //A8h
|
||||
u32 K0R; //ACh
|
||||
u32 IV3R; //B0h
|
||||
u32 IV2R; //B4h
|
||||
u32 IV1R; //B8h
|
||||
u32 IV0R; //BCh
|
||||
u32 OD3R; //D4h
|
||||
u32 OD2R; //D8h
|
||||
u32 OD1R; //DCh
|
||||
u32 OD0R; //E0h
|
||||
};
|
||||
|
||||
struct deu_hash_t {
|
||||
struct hash_controlr {
|
||||
u32 reserved1:5;
|
||||
u32 KHS:1;
|
||||
u32 GO:1;
|
||||
u32 INIT:1;
|
||||
u32 reserved2:6;
|
||||
u32 NDC:1;
|
||||
u32 ENDI:1;
|
||||
u32 reserved3:7;
|
||||
u32 DGRY:1;
|
||||
u32 BSY:1;
|
||||
u32 reserved4:1;
|
||||
u32 IRCL:1;
|
||||
u32 SM:1;
|
||||
u32 KYUE:1;
|
||||
u32 HMEN:1;
|
||||
u32 SSEN:1;
|
||||
u32 ALGO:1;
|
||||
|
||||
} controlr;
|
||||
u32 MR; //B4h
|
||||
u32 D1R; //B8h
|
||||
u32 D2R; //BCh
|
||||
u32 D3R; //C0h
|
||||
u32 D4R; //C4h
|
||||
u32 D5R; //C8h
|
||||
|
||||
u32 dummy; //CCh
|
||||
|
||||
u32 KIDX; //D0h
|
||||
u32 KEY; //D4h
|
||||
u32 DBN; //D8h
|
||||
};
|
||||
|
||||
struct deu_dma_t {
|
||||
struct dma_controlr {
|
||||
u32 reserved1:22;
|
||||
u32 BS:2;
|
||||
u32 BSY:1;
|
||||
u32 reserved2:1;
|
||||
u32 ALGO:2;
|
||||
u32 RXCLS:2;
|
||||
u32 reserved3:1;
|
||||
u32 EN:1;
|
||||
|
||||
} controlr;
|
||||
};
|
||||
|
||||
#endif /* IFXMIPS_DEU_DANUBE_H */
|
42
package/platform/lantiq/ltq-deu/src/ifxmips_deu_dma.c
Normal file
42
package/platform/lantiq/ltq-deu/src/ifxmips_deu_dma.c
Normal file
@ -0,0 +1,42 @@
|
||||
/******************************************************************************
|
||||
**
|
||||
** FILE NAME : ifxmips_deu_dma.c
|
||||
** PROJECT : IFX UEIP
|
||||
** MODULES : DEU Module for Danube
|
||||
**
|
||||
** DATE : September 8, 2009
|
||||
** AUTHOR : Mohammad Firdaus
|
||||
** DESCRIPTION : Data Encryption Unit Driver
|
||||
** COPYRIGHT : Copyright (c) 2009
|
||||
** Infineon Technologies AG
|
||||
** Am Campeon 1-12, 85579 Neubiberg, Germany
|
||||
**
|
||||
** 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.
|
||||
**
|
||||
** HISTORY
|
||||
** $Date $Author $Comment
|
||||
** 08 Sept 2009 Mohammad Firdaus Initial UEIP release
|
||||
*******************************************************************************/
|
||||
/*!
|
||||
\defgroup IFX_DEU IFX_DEU_DRIVERS
|
||||
\ingroup IFX_API
|
||||
\brief ifx deu driver module
|
||||
*/
|
||||
|
||||
/*!
|
||||
\file ifxmips_deu_dma.c
|
||||
\ingroup IFX_DEU
|
||||
\brief DMA deu driver file
|
||||
*/
|
||||
|
||||
/*!
|
||||
\defgroup IFX_DMA_FUNCTIONS IFX_DMA_FUNCTIONS
|
||||
\ingroup IFX_DEU
|
||||
\brief deu-dma driver functions
|
||||
*/
|
||||
|
||||
/* Project header files */
|
||||
|
69
package/platform/lantiq/ltq-deu/src/ifxmips_deu_dma.h
Normal file
69
package/platform/lantiq/ltq-deu/src/ifxmips_deu_dma.h
Normal file
@ -0,0 +1,69 @@
|
||||
/******************************************************************************
|
||||
**
|
||||
** FILE NAME : ifxmips_deu_dma.h
|
||||
** DESCRIPTION : Data Encryption Unit Driver
|
||||
** COPYRIGHT : Copyright (c) 2009
|
||||
** Infineon Technologies AG
|
||||
** Am Campeon 1-12, 85579 Neubiberg, Germany
|
||||
**
|
||||
** 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.
|
||||
**
|
||||
** HISTORY
|
||||
** $Date $Author $Comment
|
||||
** 08,Sept 2009 Mohammad Firdaus Initial UEIP release
|
||||
*******************************************************************************/
|
||||
|
||||
/*!
|
||||
\addtogroup IFX_DEU IFX_DEU_DRIVERS
|
||||
\ingroup API
|
||||
\brief ifx deu driver module
|
||||
*/
|
||||
|
||||
/*!
|
||||
\file ifxmips_deu_dma.h
|
||||
\ingroup IFX_DEU
|
||||
\brief DMA deu driver header file
|
||||
*/
|
||||
|
||||
#ifndef IFXMIPS_DEU_DMA_H
|
||||
#define IFXMIPS_DEU_DMA_H
|
||||
|
||||
#include <linux/init.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/mm.h>
|
||||
#include <linux/crypto.h>
|
||||
#include <asm/scatterlist.h>
|
||||
#include <asm/byteorder.h>
|
||||
#include <linux/skbuff.h>
|
||||
#include <linux/netdevice.h>
|
||||
|
||||
// must match the size of memory block allocated for g_dma_block and g_dma_block2
|
||||
#define DEU_MAX_PACKET_SIZE (PAGE_SIZE >> 1)
|
||||
|
||||
typedef struct ifx_deu_device {
|
||||
struct dma_device_info *dma_device;
|
||||
u8 *dst;
|
||||
u8 *src;
|
||||
int len;
|
||||
int dst_count;
|
||||
int src_count;
|
||||
int recv_count;
|
||||
int packet_size;
|
||||
int packet_num;
|
||||
wait_queue_t wait;
|
||||
} _ifx_deu_device;
|
||||
|
||||
extern _ifx_deu_device ifx_deu[1];
|
||||
|
||||
extern int deu_dma_intr_handler (struct dma_device_info *, int);
|
||||
extern u8 *deu_dma_buffer_alloc (int, int *, void **);
|
||||
extern int deu_dma_buffer_free (u8 *, void *);
|
||||
extern void deu_dma_inactivate_poll(struct dma_device_info* dma_dev);
|
||||
extern void deu_dma_activate_poll (struct dma_device_info* dma_dev);
|
||||
extern struct dma_device_info* deu_dma_reserve(struct dma_device_info** dma_device);
|
||||
extern int deu_dma_release(struct dma_device_info** dma_device);
|
||||
|
||||
#endif /* IFMIPS_DEU_DMA_H */
|
144
package/platform/lantiq/ltq-deu/src/ifxmips_deu_vr9.c
Normal file
144
package/platform/lantiq/ltq-deu/src/ifxmips_deu_vr9.c
Normal file
@ -0,0 +1,144 @@
|
||||
/******************************************************************************
|
||||
**
|
||||
** FILE NAME : ifxmips_deu_vr9.c
|
||||
** PROJECT : IFX UEIP
|
||||
** MODULES : DEU Module for VR9
|
||||
**
|
||||
** DATE : September 8, 2009
|
||||
** AUTHOR : Mohammad Firdaus
|
||||
** DESCRIPTION : Data Encryption Unit Driver
|
||||
** COPYRIGHT : Copyright (c) 2009
|
||||
** Infineon Technologies AG
|
||||
** Am Campeon 1-12, 85579 Neubiberg, Germany
|
||||
**
|
||||
** 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.
|
||||
**
|
||||
** HISTORY
|
||||
** $Date $Author $Comment
|
||||
** 08,Sept 2009 Mohammad Firdaus Initial UEIP release
|
||||
*******************************************************************************/
|
||||
|
||||
/*!
|
||||
\defgroup IFX_DEU IFX_DEU_DRIVERS
|
||||
\ingroup API
|
||||
\brief deu driver module
|
||||
*/
|
||||
|
||||
/*!
|
||||
\file ifxmips_deu_vr9.c
|
||||
\ingroup IFX_DEU
|
||||
\brief board specific deu driver file for vr9
|
||||
*/
|
||||
|
||||
/*!
|
||||
\defgroup BOARD_SPECIFIC_FUNCTIONS IFX_BOARD_SPECIFIC_FUNCTIONS
|
||||
\ingroup IFX_DEU
|
||||
\brief board specific deu driver 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_dma.h"
|
||||
#include "ifxmips_deu_vr9.h"
|
||||
|
||||
/* Function decleration */
|
||||
void aes_chip_init (void);
|
||||
void des_chip_init (void);
|
||||
int deu_dma_init (void);
|
||||
void deu_dma_priv_init(void);
|
||||
u32 endian_swap(u32 input);
|
||||
u32* memory_alignment(const u8 *arg, u32 *buff_alloc, int in_out, int nbytes);
|
||||
void aes_dma_memory_copy(u32 *outcopy, u32 *out_dma, u8 *out_arg, int nbytes);
|
||||
void des_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 */
|
||||
|
||||
u8 *g_dma_page_ptr = NULL;
|
||||
u8 *g_dma_block = NULL;
|
||||
u8 *g_dma_block2 = NULL;
|
||||
|
||||
deu_drv_priv_t deu_dma_priv;
|
||||
|
||||
|
||||
/*! \fn u32 endian_swap(u32 input)
|
||||
* \ingroup BOARD_SPECIFIC_FUNCTIONS
|
||||
* \brief Swap data given to the function
|
||||
* \param input Data input to be swapped
|
||||
* \return either the swapped data or the input data depending on whether it is in DMA mode or FPI mode
|
||||
*/
|
||||
|
||||
|
||||
u32 endian_swap(u32 input)
|
||||
{
|
||||
return input;
|
||||
}
|
||||
|
||||
/*! \fn u32 input_swap(u32 input)
|
||||
* \ingroup BOARD_SPECIFIC_FUNCTIONS
|
||||
* \brief Not used
|
||||
* \return input
|
||||
*/
|
||||
|
||||
u32 input_swap(u32 input)
|
||||
{
|
||||
return input;
|
||||
}
|
||||
|
||||
/*! \fn void aes_chip_init (void)
|
||||
* \ingroup BOARD_SPECIFIC_FUNCTIONS
|
||||
* \brief initialize AES hardware
|
||||
*/
|
||||
|
||||
void aes_chip_init (void)
|
||||
{
|
||||
volatile struct aes_t *aes = (struct aes_t *) AES_START;
|
||||
|
||||
// start crypto engine with write to ILR
|
||||
aes->controlr.SM = 1;
|
||||
aes->controlr.NDC = 0;
|
||||
asm("sync");
|
||||
aes->controlr.ENDI = 1;
|
||||
asm("sync");
|
||||
aes->controlr.ARS = 0;
|
||||
|
||||
}
|
||||
|
||||
/*! \fn void des_chip_init (void)
|
||||
* \ingroup IFX_AES_FUNCTIONS
|
||||
* \brief initialize DES hardware
|
||||
*/
|
||||
|
||||
void des_chip_init (void)
|
||||
{
|
||||
volatile struct des_t *des = (struct des_t *) DES_3DES_START;
|
||||
|
||||
// start crypto engine with write to ILR
|
||||
des->controlr.SM = 1;
|
||||
des->controlr.NDC = 1;
|
||||
asm("sync");
|
||||
des->controlr.ENDI = 1;
|
||||
asm("sync");
|
||||
des->controlr.ARS = 0;
|
||||
|
||||
}
|
||||
/*! \fn void chip_version(void)
|
||||
* \ingroup IFX_DES_FUNCTIONS
|
||||
* \brief function not used in VR9
|
||||
*/
|
||||
void chip_version(void)
|
||||
{
|
||||
return;
|
||||
}
|
||||
|
324
package/platform/lantiq/ltq-deu/src/ifxmips_deu_vr9.h
Normal file
324
package/platform/lantiq/ltq-deu/src/ifxmips_deu_vr9.h
Normal file
@ -0,0 +1,324 @@
|
||||
/******************************************************************************
|
||||
**
|
||||
** FILE NAME : ifxmips_deu_vr9.h
|
||||
** PROJECT : IFX UEIP
|
||||
** MODULES : DEU Module for VR9
|
||||
**
|
||||
** DATE : September 8, 2009
|
||||
** AUTHOR : Mohammad Firdaus
|
||||
** DESCRIPTION : Data Encryption Unit Driver
|
||||
** COPYRIGHT : Copyright (c) 2009
|
||||
** Infineon Technologies AG
|
||||
** Am Campeon 1-12, 85579 Neubiberg, Germany
|
||||
**
|
||||
** 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.
|
||||
**
|
||||
** HISTORY
|
||||
** $Date $Author $Comment
|
||||
** 08,Sept 2009 Mohammad Firdaus Initial UEIP release
|
||||
*******************************************************************************/
|
||||
/*!
|
||||
\defgroup IFX_DEU IFX_DEU_DRIVERS
|
||||
\ingroup API
|
||||
\brief deu driver module
|
||||
*/
|
||||
|
||||
/*!
|
||||
\file ifxmips_deu_vr9.h
|
||||
\ingroup IFX_DEU
|
||||
\brief board specific deu driver header file for vr9
|
||||
*/
|
||||
|
||||
/*!
|
||||
\defgroup IFX_DEU_DEFINITIONS IFX_DEU_DEFINITIONS
|
||||
\brief deu driver header file
|
||||
*/
|
||||
|
||||
|
||||
#ifndef IFXMIPS_DEU_VR9_H
|
||||
#define IFXMIPS_DEU_VR9_H
|
||||
|
||||
/* Project Header Files */
|
||||
#include <linux/version.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/init.h>
|
||||
#include <linux/types.h>
|
||||
#include <linux/errno.h>
|
||||
#include <linux/crypto.h>
|
||||
#include <linux/interrupt.h>
|
||||
#include <linux/delay.h>
|
||||
#include <asm/byteorder.h>
|
||||
#include <crypto/algapi.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/mm.h>
|
||||
#include <asm/scatterlist.h>
|
||||
#include <linux/skbuff.h>
|
||||
#include <linux/netdevice.h>
|
||||
#include "ifxmips_deu.h"
|
||||
|
||||
|
||||
#define AES_INIT 1
|
||||
#define DES_INIT 2
|
||||
#define ARC4_INIT 3
|
||||
#define SHA1_INIT 4
|
||||
#define MD5_INIT 5
|
||||
#define SHA1_HMAC_INIT 6
|
||||
#define MD5_HMAC_INIT 7
|
||||
|
||||
#define AES_START IFX_AES_CON
|
||||
#define DES_3DES_START IFX_DES_CON
|
||||
|
||||
#if 0
|
||||
#define AES_IDLE 0
|
||||
#define AES_BUSY 1
|
||||
#define AES_STARTED 2
|
||||
#define AES_COMPLETED 3
|
||||
#define DES_IDLE 0
|
||||
#define DES_BUSY 1
|
||||
#define DES_STARTED 2
|
||||
#define DES_COMPLETED 3
|
||||
#endif
|
||||
|
||||
/* SHA1 CONSTANT */
|
||||
#define HASH_CON_VALUE 0x0701002C
|
||||
|
||||
#define INPUT_ENDIAN_SWAP(input) input_swap(input)
|
||||
#define DEU_ENDIAN_SWAP(input) endian_swap(input)
|
||||
#define FIND_DEU_CHIP_VERSION chip_version()
|
||||
|
||||
#if defined (CONFIG_AR10)
|
||||
#define DELAY_PERIOD 30
|
||||
#else
|
||||
#define DELAY_PERIOD 10
|
||||
#endif
|
||||
|
||||
#define WAIT_AES_DMA_READY() \
|
||||
do { \
|
||||
int i; \
|
||||
volatile struct deu_dma_t *dma = (struct deu_dma_t *) IFX_DEU_DMA_CON; \
|
||||
volatile struct aes_t *aes = (volatile struct aes_t *) AES_START; \
|
||||
for (i = 0; i < 10; i++) \
|
||||
udelay(DELAY_PERIOD); \
|
||||
while (dma->controlr.BSY) {}; \
|
||||
while (aes->controlr.BUS) {}; \
|
||||
} while (0)
|
||||
|
||||
#define WAIT_DES_DMA_READY() \
|
||||
do { \
|
||||
int i; \
|
||||
volatile struct deu_dma_t *dma = (struct deu_dma_t *) IFX_DEU_DMA_CON; \
|
||||
volatile struct des_t *des = (struct des_t *) DES_3DES_START; \
|
||||
for (i = 0; i < 10; i++) \
|
||||
udelay(DELAY_PERIOD); \
|
||||
while (dma->controlr.BSY) {}; \
|
||||
while (des->controlr.BUS) {}; \
|
||||
} while (0)
|
||||
|
||||
#define AES_DMA_MISC_CONFIG() \
|
||||
do { \
|
||||
volatile struct aes_t *aes = (volatile struct aes_t *) AES_START; \
|
||||
aes->controlr.KRE = 1; \
|
||||
aes->controlr.GO = 1; \
|
||||
} while(0)
|
||||
|
||||
#define SHA_HASH_INIT \
|
||||
do { \
|
||||
volatile struct deu_hash_t *hash = (struct deu_hash_t *) HASH_START; \
|
||||
hash->controlr.ENDI = 1; \
|
||||
hash->controlr.SM = 1; \
|
||||
hash->controlr.ALGO = 0; \
|
||||
hash->controlr.INIT = 1; \
|
||||
} while(0)
|
||||
|
||||
#define MD5_HASH_INIT \
|
||||
do { \
|
||||
volatile struct deu_hash_t *hash = (struct deu_hash_t *) HASH_START; \
|
||||
hash->controlr.ENDI = 1; \
|
||||
hash->controlr.SM = 1; \
|
||||
hash->controlr.ALGO = 1; \
|
||||
hash->controlr.INIT = 1; \
|
||||
} while(0)
|
||||
|
||||
/* DEU Common Structures for AR9*/
|
||||
|
||||
struct clc_controlr_t {
|
||||
u32 Res:26;
|
||||
u32 FSOE:1;
|
||||
u32 SBWE:1;
|
||||
u32 EDIS:1;
|
||||
u32 SPEN:1;
|
||||
u32 DISS:1;
|
||||
u32 DISR:1;
|
||||
|
||||
};
|
||||
|
||||
struct des_t {
|
||||
struct des_controlr { //10h
|
||||
u32 KRE:1;
|
||||
u32 reserved1:5;
|
||||
u32 GO:1;
|
||||
u32 STP:1;
|
||||
u32 Res2:6;
|
||||
u32 NDC:1;
|
||||
u32 ENDI:1;
|
||||
u32 Res3:2;
|
||||
u32 F:3;
|
||||
u32 O:3;
|
||||
u32 BUS:1;
|
||||
u32 DAU:1;
|
||||
u32 ARS:1;
|
||||
u32 SM:1;
|
||||
u32 E_D:1;
|
||||
u32 M:3;
|
||||
|
||||
} controlr;
|
||||
u32 IHR; //14h
|
||||
u32 ILR; //18h
|
||||
u32 K1HR; //1c
|
||||
u32 K1LR; //
|
||||
u32 K2HR;
|
||||
u32 K2LR;
|
||||
u32 K3HR;
|
||||
u32 K3LR; //30h
|
||||
u32 IVHR; //34h
|
||||
u32 IVLR; //38
|
||||
u32 OHR; //3c
|
||||
u32 OLR; //40
|
||||
};
|
||||
|
||||
struct aes_t {
|
||||
struct aes_controlr {
|
||||
|
||||
u32 KRE:1;
|
||||
u32 reserved1:4;
|
||||
u32 PNK:1;
|
||||
u32 GO:1;
|
||||
u32 STP:1;
|
||||
u32 reserved2:6;
|
||||
u32 NDC:1;
|
||||
u32 ENDI:1;
|
||||
u32 reserved3:2;
|
||||
u32 F:3; //fbs
|
||||
u32 O:3; //om
|
||||
u32 BUS:1; //bsy
|
||||
u32 DAU:1;
|
||||
u32 ARS:1;
|
||||
u32 SM:1;
|
||||
u32 E_D:1;
|
||||
u32 KV:1;
|
||||
u32 K:2; //KL
|
||||
|
||||
} controlr;
|
||||
u32 ID3R; //80h
|
||||
u32 ID2R; //84h
|
||||
u32 ID1R; //88h
|
||||
u32 ID0R; //8Ch
|
||||
u32 K7R; //90h
|
||||
u32 K6R; //94h
|
||||
u32 K5R; //98h
|
||||
u32 K4R; //9Ch
|
||||
u32 K3R; //A0h
|
||||
u32 K2R; //A4h
|
||||
u32 K1R; //A8h
|
||||
u32 K0R; //ACh
|
||||
u32 IV3R; //B0h
|
||||
u32 IV2R; //B4h
|
||||
u32 IV1R; //B8h
|
||||
u32 IV0R; //BCh
|
||||
u32 OD3R; //D4h
|
||||
u32 OD2R; //D8h
|
||||
u32 OD1R; //DCh
|
||||
u32 OD0R; //E0h
|
||||
};
|
||||
|
||||
struct arc4_t {
|
||||
struct arc4_controlr {
|
||||
|
||||
u32 KRE:1;
|
||||
u32 KLEN:4;
|
||||
u32 KSAE:1;
|
||||
u32 GO:1;
|
||||
u32 STP:1;
|
||||
u32 reserved1:6;
|
||||
u32 NDC:1;
|
||||
u32 ENDI:1;
|
||||
u32 reserved2:8;
|
||||
u32 BUS:1; //bsy
|
||||
u32 reserved3:1;
|
||||
u32 ARS:1;
|
||||
u32 SM:1;
|
||||
u32 reserved4:4;
|
||||
|
||||
} controlr;
|
||||
u32 K3R; //104h
|
||||
u32 K2R; //108h
|
||||
u32 K1R; //10Ch
|
||||
u32 K0R; //110h
|
||||
|
||||
u32 IDLEN; //114h
|
||||
|
||||
u32 ID3R; //118h
|
||||
u32 ID2R; //11Ch
|
||||
u32 ID1R; //120h
|
||||
u32 ID0R; //124h
|
||||
|
||||
u32 OD3R; //128h
|
||||
u32 OD2R; //12Ch
|
||||
u32 OD1R; //130h
|
||||
u32 OD0R; //134h
|
||||
};
|
||||
|
||||
struct deu_hash_t {
|
||||
struct hash_controlr {
|
||||
u32 reserved1:5;
|
||||
u32 KHS:1;
|
||||
u32 GO:1;
|
||||
u32 INIT:1;
|
||||
u32 reserved2:6;
|
||||
u32 NDC:1;
|
||||
u32 ENDI:1;
|
||||
u32 reserved3:7;
|
||||
u32 DGRY:1;
|
||||
u32 BSY:1;
|
||||
u32 reserved4:1;
|
||||
u32 IRCL:1;
|
||||
u32 SM:1;
|
||||
u32 KYUE:1;
|
||||
u32 HMEN:1;
|
||||
u32 SSEN:1;
|
||||
u32 ALGO:1;
|
||||
|
||||
} controlr;
|
||||
u32 MR; //B4h
|
||||
u32 D1R; //B8h
|
||||
u32 D2R; //BCh
|
||||
u32 D3R; //C0h
|
||||
u32 D4R; //C4h
|
||||
u32 D5R; //C8h
|
||||
|
||||
u32 dummy; //CCh
|
||||
|
||||
u32 KIDX; //D0h
|
||||
u32 KEY; //D4h
|
||||
u32 DBN; //D8h
|
||||
};
|
||||
|
||||
|
||||
struct deu_dma_t {
|
||||
struct dma_controlr {
|
||||
u32 reserved1:22;
|
||||
u32 BS:2;
|
||||
u32 BSY:1;
|
||||
u32 reserved2:1;
|
||||
u32 ALGO:2;
|
||||
u32 RXCLS:2;
|
||||
u32 reserved3:1;
|
||||
u32 EN:1;
|
||||
|
||||
} controlr;
|
||||
};
|
||||
|
||||
#endif /* IFXMIPS_DEU_VR9_H */
|
310
package/platform/lantiq/ltq-deu/src/ifxmips_md5.c
Normal file
310
package/platform/lantiq/ltq-deu/src/ifxmips_md5.c
Normal file
@ -0,0 +1,310 @@
|
||||
/******************************************************************************
|
||||
**
|
||||
** FILE NAME : ifxmips_md5.c
|
||||
** PROJECT : IFX UEIP
|
||||
** MODULES : DEU Module for UEIP
|
||||
**
|
||||
** DATE : September 8, 2009
|
||||
** AUTHOR : Mohammad Firdaus
|
||||
** DESCRIPTION : Data Encryption Unit Driver
|
||||
** COPYRIGHT : Copyright (c) 2009
|
||||
** Infineon Technologies AG
|
||||
** Am Campeon 1-12, 85579 Neubiberg, Germany
|
||||
**
|
||||
** 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.
|
||||
**
|
||||
** HISTORY
|
||||
** $Date $Author $Comment
|
||||
** 08,Sept 2009 Mohammad Firdaus Initial UEIP release
|
||||
*******************************************************************************/
|
||||
/*!
|
||||
\defgroup IFX_DEU IFX_DEU_DRIVERS
|
||||
\ingroup API
|
||||
\brief ifx deu driver module
|
||||
*/
|
||||
|
||||
/*!
|
||||
\file ifxmips_md5.c
|
||||
\ingroup IFX_DEU
|
||||
\brief MD5 encryption deu driver file
|
||||
*/
|
||||
|
||||
/*!
|
||||
\defgroup IFX_MD5_FUNCTIONS IFX_MD5_FUNCTIONS
|
||||
\ingroup IFX_DEU
|
||||
\brief ifx deu MD5 functions
|
||||
*/
|
||||
|
||||
/*Project header files */
|
||||
#include <linux/init.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/string.h>
|
||||
#include <linux/crypto.h>
|
||||
#include <linux/types.h>
|
||||
#include <crypto/internal/hash.h>
|
||||
#include <asm/byteorder.h>
|
||||
|
||||
/* Project header */
|
||||
#if defined(CONFIG_DANUBE)
|
||||
#include "ifxmips_deu_danube.h"
|
||||
#elif defined(CONFIG_AR9)
|
||||
#include "ifxmips_deu_ar9.h"
|
||||
#elif defined(CONFIG_VR9) || defined(CONFIG_AR10)
|
||||
#include "ifxmips_deu_vr9.h"
|
||||
#else
|
||||
#error "Plaform Unknwon!"
|
||||
#endif
|
||||
|
||||
#define MD5_DIGEST_SIZE 16
|
||||
#define MD5_HMAC_BLOCK_SIZE 64
|
||||
#define MD5_BLOCK_WORDS 16
|
||||
#define MD5_HASH_WORDS 4
|
||||
#define HASH_START IFX_HASH_CON
|
||||
|
||||
static spinlock_t lock;
|
||||
#define CRTCL_SECT_INIT spin_lock_init(&lock)
|
||||
#define CRTCL_SECT_START spin_lock_irqsave(&lock, flag)
|
||||
#define CRTCL_SECT_END spin_unlock_irqrestore(&lock, flag)
|
||||
|
||||
//#define CRYPTO_DEBUG
|
||||
#ifdef CRYPTO_DEBUG
|
||||
extern char debug_level;
|
||||
#define DPRINTF(level, format, args...) if (level < debug_level) printk(KERN_INFO "[%s %s %d]: " format, __FILE__, __func__, __LINE__, ##args);
|
||||
#else
|
||||
#define DPRINTF(level, format, args...)
|
||||
#endif
|
||||
|
||||
struct md5_ctx {
|
||||
int started;
|
||||
u32 hash[MD5_HASH_WORDS];
|
||||
u32 block[MD5_BLOCK_WORDS];
|
||||
u64 byte_count;
|
||||
};
|
||||
|
||||
extern int disable_deudma;
|
||||
|
||||
/*! \fn static u32 endian_swap(u32 input)
|
||||
* \ingroup IFX_MD5_FUNCTIONS
|
||||
* \brief perform dword level endian swap
|
||||
* \param input value of dword that requires to be swapped
|
||||
*/
|
||||
static u32 endian_swap(u32 input)
|
||||
{
|
||||
u8 *ptr = (u8 *)&input;
|
||||
|
||||
return ((ptr[3] << 24) | (ptr[2] << 16) | (ptr[1] << 8) | ptr[0]);
|
||||
}
|
||||
|
||||
/*! \fn static void md5_transform(u32 *hash, u32 const *in)
|
||||
* \ingroup IFX_MD5_FUNCTIONS
|
||||
* \brief main interface to md5 hardware
|
||||
* \param hash current hash value
|
||||
* \param in 64-byte block of input
|
||||
*/
|
||||
static void md5_transform(struct md5_ctx *mctx, u32 *hash, u32 const *in)
|
||||
{
|
||||
int i;
|
||||
volatile struct deu_hash_t *hashs = (struct deu_hash_t *) HASH_START;
|
||||
unsigned long flag;
|
||||
|
||||
CRTCL_SECT_START;
|
||||
|
||||
if (mctx->started) {
|
||||
hashs->D1R = endian_swap(*((u32 *) hash + 0));
|
||||
hashs->D2R = endian_swap(*((u32 *) hash + 1));
|
||||
hashs->D3R = endian_swap(*((u32 *) hash + 2));
|
||||
hashs->D4R = endian_swap(*((u32 *) hash + 3));
|
||||
}
|
||||
|
||||
for (i = 0; i < 16; i++) {
|
||||
hashs->MR = endian_swap(in[i]);
|
||||
// printk("in[%d]: %08x\n", i, endian_swap(in[i]));
|
||||
};
|
||||
|
||||
//wait for processing
|
||||
while (hashs->controlr.BSY) {
|
||||
// this will not take long
|
||||
}
|
||||
|
||||
*((u32 *) hash + 0) = endian_swap (hashs->D1R);
|
||||
*((u32 *) hash + 1) = endian_swap (hashs->D2R);
|
||||
*((u32 *) hash + 2) = endian_swap (hashs->D3R);
|
||||
*((u32 *) hash + 3) = endian_swap (hashs->D4R);
|
||||
|
||||
mctx->started = 1;
|
||||
|
||||
CRTCL_SECT_END;
|
||||
}
|
||||
|
||||
/*! \fn static inline void md5_transform_helper(struct md5_ctx *ctx)
|
||||
* \ingroup IFX_MD5_FUNCTIONS
|
||||
* \brief interfacing function for md5_transform()
|
||||
* \param ctx crypto context
|
||||
*/
|
||||
static inline void md5_transform_helper(struct md5_ctx *ctx)
|
||||
{
|
||||
//le32_to_cpu_array(ctx->block, sizeof(ctx->block) / sizeof(u32));
|
||||
md5_transform(ctx, ctx->hash, ctx->block);
|
||||
}
|
||||
|
||||
/*! \fn static void md5_init(struct crypto_tfm *tfm)
|
||||
* \ingroup IFX_MD5_FUNCTIONS
|
||||
* \brief initialize md5 hardware
|
||||
* \param tfm linux crypto algo transform
|
||||
*/
|
||||
static int md5_init(struct shash_desc *desc)
|
||||
{
|
||||
struct md5_ctx *mctx = shash_desc_ctx(desc);
|
||||
volatile struct deu_hash_t *hash = (struct deu_hash_t *) HASH_START;
|
||||
|
||||
hash->controlr.ENDI = 0;
|
||||
hash->controlr.SM = 1;
|
||||
hash->controlr.ALGO = 1; // 1 = md5 0 = sha1
|
||||
hash->controlr.INIT = 1; // Initialize the hash operation by writing a '1' to the INIT bit.
|
||||
|
||||
mctx->byte_count = 0;
|
||||
mctx->started = 0;
|
||||
return 0;
|
||||
}
|
||||
|
||||
/*! \fn static void md5_update(struct crypto_tfm *tfm, const u8 *data, unsigned int len)
|
||||
* \ingroup IFX_MD5_FUNCTIONS
|
||||
* \brief on-the-fly md5 computation
|
||||
* \param tfm linux crypto algo transform
|
||||
* \param data input data
|
||||
* \param len size of input data
|
||||
*/
|
||||
static int md5_update(struct shash_desc *desc, const u8 *data, unsigned int len)
|
||||
{
|
||||
struct md5_ctx *mctx = shash_desc_ctx(desc);
|
||||
const u32 avail = sizeof(mctx->block) - (mctx->byte_count & 0x3f);
|
||||
|
||||
mctx->byte_count += len;
|
||||
|
||||
if (avail > len) {
|
||||
memcpy((char *)mctx->block + (sizeof(mctx->block) - avail),
|
||||
data, len);
|
||||
return 0;
|
||||
}
|
||||
|
||||
memcpy((char *)mctx->block + (sizeof(mctx->block) - avail),
|
||||
data, avail);
|
||||
|
||||
md5_transform_helper(mctx);
|
||||
data += avail;
|
||||
len -= avail;
|
||||
|
||||
while (len >= sizeof(mctx->block)) {
|
||||
memcpy(mctx->block, data, sizeof(mctx->block));
|
||||
md5_transform_helper(mctx);
|
||||
data += sizeof(mctx->block);
|
||||
len -= sizeof(mctx->block);
|
||||
}
|
||||
|
||||
memcpy(mctx->block, data, len);
|
||||
return 0;
|
||||
}
|
||||
|
||||
/*! \fn static void md5_final(struct crypto_tfm *tfm, u8 *out)
|
||||
* \ingroup IFX_MD5_FUNCTIONS
|
||||
* \brief compute final md5 value
|
||||
* \param tfm linux crypto algo transform
|
||||
* \param out final md5 output value
|
||||
*/
|
||||
static int md5_final(struct shash_desc *desc, u8 *out)
|
||||
{
|
||||
struct md5_ctx *mctx = shash_desc_ctx(desc);
|
||||
const unsigned int offset = mctx->byte_count & 0x3f;
|
||||
char *p = (char *)mctx->block + offset;
|
||||
int padding = 56 - (offset + 1);
|
||||
volatile struct deu_hash_t *hashs = (struct deu_hash_t *) HASH_START;
|
||||
unsigned long flag;
|
||||
|
||||
*p++ = 0x80;
|
||||
if (padding < 0) {
|
||||
memset(p, 0x00, padding + sizeof (u64));
|
||||
md5_transform_helper(mctx);
|
||||
p = (char *)mctx->block;
|
||||
padding = 56;
|
||||
}
|
||||
|
||||
memset(p, 0, padding);
|
||||
mctx->block[14] = endian_swap(mctx->byte_count << 3);
|
||||
mctx->block[15] = endian_swap(mctx->byte_count >> 29);
|
||||
|
||||
#if 0
|
||||
le32_to_cpu_array(mctx->block, (sizeof(mctx->block) -
|
||||
sizeof(u64)) / sizeof(u32));
|
||||
#endif
|
||||
|
||||
md5_transform(mctx, mctx->hash, mctx->block);
|
||||
|
||||
CRTCL_SECT_START;
|
||||
|
||||
*((u32 *) out + 0) = endian_swap (hashs->D1R);
|
||||
*((u32 *) out + 1) = endian_swap (hashs->D2R);
|
||||
*((u32 *) out + 2) = endian_swap (hashs->D3R);
|
||||
*((u32 *) out + 3) = endian_swap (hashs->D4R);
|
||||
|
||||
CRTCL_SECT_END;
|
||||
|
||||
// Wipe context
|
||||
memset(mctx, 0, sizeof(*mctx));
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
/*
|
||||
* \brief MD5 function mappings
|
||||
*/
|
||||
static struct shash_alg ifxdeu_md5_alg = {
|
||||
.digestsize = MD5_DIGEST_SIZE,
|
||||
.init = md5_init,
|
||||
.update = md5_update,
|
||||
.final = md5_final,
|
||||
.descsize = sizeof(struct md5_ctx),
|
||||
.base = {
|
||||
.cra_name = "md5",
|
||||
.cra_driver_name= "ifxdeu-md5",
|
||||
.cra_flags = CRYPTO_ALG_TYPE_DIGEST,
|
||||
.cra_blocksize = MD5_HMAC_BLOCK_SIZE,
|
||||
.cra_module = THIS_MODULE,
|
||||
}
|
||||
};
|
||||
|
||||
/*! \fn int __init ifxdeu_init_md5 (void)
|
||||
* \ingroup IFX_MD5_FUNCTIONS
|
||||
* \brief initialize md5 driver
|
||||
*/
|
||||
int __init ifxdeu_init_md5 (void)
|
||||
{
|
||||
int ret = -ENOSYS;
|
||||
|
||||
|
||||
if ((ret = crypto_register_shash(&ifxdeu_md5_alg)))
|
||||
goto md5_err;
|
||||
|
||||
CRTCL_SECT_INIT;
|
||||
|
||||
printk (KERN_NOTICE "IFX DEU MD5 initialized%s.\n", disable_deudma ? "" : " (DMA)");
|
||||
return ret;
|
||||
|
||||
md5_err:
|
||||
printk(KERN_ERR "IFX DEU MD5 initialization failed!\n");
|
||||
return ret;
|
||||
}
|
||||
|
||||
/*! \fn void __exit ifxdeu_fini_md5 (void)
|
||||
* \ingroup IFX_MD5_FUNCTIONS
|
||||
* \brief unregister md5 driver
|
||||
*/
|
||||
|
||||
void __exit ifxdeu_fini_md5 (void)
|
||||
{
|
||||
crypto_unregister_shash(&ifxdeu_md5_alg);
|
||||
|
||||
}
|
||||
|
386
package/platform/lantiq/ltq-deu/src/ifxmips_md5_hmac.c
Normal file
386
package/platform/lantiq/ltq-deu/src/ifxmips_md5_hmac.c
Normal file
@ -0,0 +1,386 @@
|
||||
/******************************************************************************
|
||||
**
|
||||
** FILE NAME : ifxmips_md5_hmac.c
|
||||
** PROJECT : IFX UEIP
|
||||
** MODULES : DEU Module for UEIP
|
||||
**
|
||||
** DATE : September 8, 2009
|
||||
** AUTHOR : Mohammad Firdaus
|
||||
** DESCRIPTION : Data Encryption Unit Driver
|
||||
** COPYRIGHT : Copyright (c) 2009
|
||||
** Infineon Technologies AG
|
||||
** Am Campeon 1-12, 85579 Neubiberg, Germany
|
||||
**
|
||||
** 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.
|
||||
**
|
||||
** HISTORY
|
||||
** $Date $Author $Comment
|
||||
** 08,Sept 2009 Mohammad Firdaus Initial UEIP release
|
||||
** 21,March 2011 Mohammad Firdaus Changes for Kernel 2.6.32 and IPSec integration
|
||||
*******************************************************************************/
|
||||
/*!
|
||||
\defgroup IFX_DEU IFX_DEU_DRIVERS
|
||||
\ingroup API
|
||||
\brief ifx deu driver module
|
||||
*/
|
||||
|
||||
/*!
|
||||
\file ifxmips_md5_hmac.c
|
||||
\ingroup IFX_DEU
|
||||
\brief MD5-HMAC encryption deu driver file
|
||||
*/
|
||||
|
||||
/*!
|
||||
\defgroup IFX_MD5_HMAC_FUNCTIONS IFX_MD5_HMAC_FUNCTIONS
|
||||
\ingroup IFX_DEU
|
||||
\brief ifx md5-hmac driver functions
|
||||
*/
|
||||
|
||||
/* Project Header files */
|
||||
#include <linux/init.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/string.h>
|
||||
#include <linux/crypto.h>
|
||||
#include <linux/types.h>
|
||||
#include <crypto/internal/hash.h>
|
||||
#include <asm/byteorder.h>
|
||||
|
||||
#if defined(CONFIG_AR9)
|
||||
#include "ifxmips_deu_ar9.h"
|
||||
#elif defined(CONFIG_VR9) || defined(CONFIG_AR10)
|
||||
#include "ifxmips_deu_vr9.h"
|
||||
#else
|
||||
#error "Plaform Unknwon!"
|
||||
#endif
|
||||
|
||||
#define MD5_DIGEST_SIZE 16
|
||||
#define MD5_HMAC_BLOCK_SIZE 64
|
||||
#define MD5_BLOCK_WORDS 16
|
||||
#define MD5_HASH_WORDS 4
|
||||
#define MD5_HMAC_DBN_TEMP_SIZE 1024 // size in dword, needed for dbn workaround
|
||||
#define HASH_START IFX_HASH_CON
|
||||
|
||||
static spinlock_t lock;
|
||||
#define CRTCL_SECT_INIT spin_lock_init(&lock)
|
||||
#define CRTCL_SECT_START spin_lock_irqsave(&lock, flag)
|
||||
#define CRTCL_SECT_END spin_unlock_irqrestore(&lock, flag)
|
||||
|
||||
//#define CRYPTO_DEBUG
|
||||
#ifdef CRYPTO_DEBUG
|
||||
extern char debug_level;
|
||||
#define DPRINTF(level, format, args...) if (level < debug_level) printk(KERN_INFO "[%s %s %d]: " format, __FILE__, __func__, __LINE__, ##args);
|
||||
#else
|
||||
#define DPRINTF(level, format, args...)
|
||||
#endif
|
||||
|
||||
#define MAX_HASH_KEYLEN 64
|
||||
|
||||
struct md5_hmac_ctx {
|
||||
u8 key[MAX_HASH_KEYLEN];
|
||||
u32 hash[MD5_HASH_WORDS];
|
||||
u32 block[MD5_BLOCK_WORDS];
|
||||
u64 byte_count;
|
||||
u32 dbn;
|
||||
unsigned int keylen;
|
||||
};
|
||||
|
||||
static u32 temp[MD5_HMAC_DBN_TEMP_SIZE];
|
||||
|
||||
extern int disable_deudma;
|
||||
|
||||
/*! \fn static u32 endian_swap(u32 input)
|
||||
* \ingroup IFX_MD5_HMAC_FUNCTIONS
|
||||
* \brief perform dword level endian swap
|
||||
* \param input value of dword that requires to be swapped
|
||||
*/
|
||||
static u32 endian_swap(u32 input)
|
||||
{
|
||||
u8 *ptr = (u8 *)&input;
|
||||
|
||||
return ((ptr[3] << 24) | (ptr[2] << 16) | (ptr[1] << 8) | ptr[0]);
|
||||
}
|
||||
|
||||
/*! \fn static void md5_hmac_transform(struct crypto_tfm *tfm, u32 const *in)
|
||||
* \ingroup IFX_MD5_HMAC_FUNCTIONS
|
||||
* \brief save input block to context
|
||||
* \param tfm linux crypto algo transform
|
||||
* \param in 64-byte block of input
|
||||
*/
|
||||
static void md5_hmac_transform(struct shash_desc *desc, u32 const *in)
|
||||
{
|
||||
struct md5_hmac_ctx *mctx = crypto_shash_ctx(desc->tfm);
|
||||
|
||||
memcpy(&temp[mctx->dbn<<4], in, 64); //dbn workaround
|
||||
mctx->dbn += 1;
|
||||
|
||||
if ( (mctx->dbn<<4) > MD5_HMAC_DBN_TEMP_SIZE )
|
||||
{
|
||||
printk("MD5_HMAC_DBN_TEMP_SIZE exceeded\n");
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
/*! \fn int md5_hmac_setkey(struct crypto_tfm *tfm, const u8 *key, unsigned int keylen)
|
||||
* \ingroup IFX_MD5_HMAC_FUNCTIONS
|
||||
* \brief sets md5 hmac key
|
||||
* \param tfm linux crypto algo transform
|
||||
* \param key input key
|
||||
* \param keylen key length greater than 64 bytes IS NOT SUPPORTED
|
||||
*/
|
||||
static int md5_hmac_setkey(struct crypto_shash *tfm, const u8 *key, unsigned int keylen)
|
||||
{
|
||||
struct md5_hmac_ctx *mctx = crypto_shash_ctx(tfm);
|
||||
volatile struct deu_hash_t *hash = (struct deu_hash_t *) HASH_START;
|
||||
//printk("copying keys to context with length %d\n", keylen);
|
||||
|
||||
if (keylen > MAX_HASH_KEYLEN) {
|
||||
printk("Key length more than what DEU hash can handle\n");
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
|
||||
hash->KIDX |= 0x80000000; // reset all 16 words of the key to '0'
|
||||
memcpy(&mctx->key, key, keylen);
|
||||
mctx->keylen = keylen;
|
||||
|
||||
return 0;
|
||||
|
||||
}
|
||||
|
||||
|
||||
/*! \fn int md5_hmac_setkey_hw(const u8 *key, unsigned int keylen)
|
||||
* \ingroup IFX_MD5_HMAC_FUNCTIONS
|
||||
* \brief sets md5 hmac key into the hardware registers
|
||||
* \param key input key
|
||||
* \param keylen key length greater than 64 bytes IS NOT SUPPORTED
|
||||
*/
|
||||
|
||||
static int md5_hmac_setkey_hw(const u8 *key, unsigned int keylen)
|
||||
{
|
||||
volatile struct deu_hash_t *hash = (struct deu_hash_t *) HASH_START;
|
||||
unsigned long flag;
|
||||
int i, j;
|
||||
u32 *in_key = (u32 *)key;
|
||||
|
||||
//printk("\nsetkey keylen: %d\n key: ", keylen);
|
||||
|
||||
CRTCL_SECT_START;
|
||||
j = 0;
|
||||
for (i = 0; i < keylen; i+=4)
|
||||
{
|
||||
hash->KIDX = j;
|
||||
asm("sync");
|
||||
hash->KEY = *((u32 *) in_key + j);
|
||||
asm("sync");
|
||||
j++;
|
||||
}
|
||||
CRTCL_SECT_END;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
/*! \fn void md5_hmac_init(struct crypto_tfm *tfm)
|
||||
* \ingroup IFX_MD5_HMAC_FUNCTIONS
|
||||
* \brief initialize md5 hmac context
|
||||
* \param tfm linux crypto algo transform
|
||||
*/
|
||||
static int md5_hmac_init(struct shash_desc *desc)
|
||||
{
|
||||
|
||||
struct md5_hmac_ctx *mctx = crypto_shash_ctx(desc->tfm);
|
||||
|
||||
|
||||
mctx->dbn = 0; //dbn workaround
|
||||
md5_hmac_setkey_hw(mctx->key, mctx->keylen);
|
||||
|
||||
return 0;
|
||||
}
|
||||
EXPORT_SYMBOL(md5_hmac_init);
|
||||
|
||||
/*! \fn void md5_hmac_update(struct crypto_tfm *tfm, const u8 *data, unsigned int len)
|
||||
* \ingroup IFX_MD5_HMAC_FUNCTIONS
|
||||
* \brief on-the-fly md5 hmac computation
|
||||
* \param tfm linux crypto algo transform
|
||||
* \param data input data
|
||||
* \param len size of input data
|
||||
*/
|
||||
static int md5_hmac_update(struct shash_desc *desc, const u8 *data, unsigned int len)
|
||||
{
|
||||
struct md5_hmac_ctx *mctx = crypto_shash_ctx(desc->tfm);
|
||||
const u32 avail = sizeof(mctx->block) - (mctx->byte_count & 0x3f);
|
||||
|
||||
mctx->byte_count += len;
|
||||
|
||||
if (avail > len) {
|
||||
memcpy((char *)mctx->block + (sizeof(mctx->block) - avail),
|
||||
data, len);
|
||||
return 0;
|
||||
}
|
||||
|
||||
memcpy((char *)mctx->block + (sizeof(mctx->block) - avail),
|
||||
data, avail);
|
||||
|
||||
md5_hmac_transform(desc, mctx->block);
|
||||
data += avail;
|
||||
len -= avail;
|
||||
|
||||
while (len >= sizeof(mctx->block)) {
|
||||
memcpy(mctx->block, data, sizeof(mctx->block));
|
||||
md5_hmac_transform(desc, mctx->block);
|
||||
data += sizeof(mctx->block);
|
||||
len -= sizeof(mctx->block);
|
||||
}
|
||||
|
||||
memcpy(mctx->block, data, len);
|
||||
return 0;
|
||||
}
|
||||
EXPORT_SYMBOL(md5_hmac_update);
|
||||
|
||||
/*! \fn void md5_hmac_final(struct crypto_tfm *tfm, u8 *out)
|
||||
* \ingroup IFX_MD5_HMAC_FUNCTIONS
|
||||
* \brief compute final md5 hmac value
|
||||
* \param tfm linux crypto algo transform
|
||||
* \param out final md5 hmac output value
|
||||
*/
|
||||
static int md5_hmac_final(struct shash_desc *desc, u8 *out)
|
||||
{
|
||||
struct md5_hmac_ctx *mctx = crypto_shash_ctx(desc->tfm);
|
||||
const unsigned int offset = mctx->byte_count & 0x3f;
|
||||
char *p = (char *)mctx->block + offset;
|
||||
int padding = 56 - (offset + 1);
|
||||
volatile struct deu_hash_t *hashs = (struct deu_hash_t *) HASH_START;
|
||||
unsigned long flag;
|
||||
int i = 0;
|
||||
int dbn;
|
||||
u32 *in = &temp[0];
|
||||
|
||||
|
||||
*p++ = 0x80;
|
||||
if (padding < 0) {
|
||||
memset(p, 0x00, padding + sizeof (u64));
|
||||
md5_hmac_transform(desc, mctx->block);
|
||||
p = (char *)mctx->block;
|
||||
padding = 56;
|
||||
}
|
||||
|
||||
memset(p, 0, padding);
|
||||
mctx->block[14] = endian_swap((mctx->byte_count + 64) << 3); // need to add 512 bit of the IPAD operation
|
||||
mctx->block[15] = 0x00000000;
|
||||
|
||||
md5_hmac_transform(desc, mctx->block);
|
||||
|
||||
CRTCL_SECT_START;
|
||||
|
||||
//printk("\ndbn = %d\n", mctx->dbn);
|
||||
hashs->DBN = mctx->dbn;
|
||||
asm("sync");
|
||||
|
||||
*IFX_HASH_CON = 0x0703002D; //khs, go, init, ndc, endi, kyue, hmen, md5
|
||||
|
||||
//wait for processing
|
||||
while (hashs->controlr.BSY) {
|
||||
// this will not take long
|
||||
}
|
||||
|
||||
for (dbn = 0; dbn < mctx->dbn; dbn++)
|
||||
{
|
||||
for (i = 0; i < 16; i++) {
|
||||
hashs->MR = in[i];
|
||||
};
|
||||
|
||||
hashs->controlr.GO = 1;
|
||||
asm("sync");
|
||||
|
||||
//wait for processing
|
||||
while (hashs->controlr.BSY) {
|
||||
// this will not take long
|
||||
}
|
||||
|
||||
in += 16;
|
||||
}
|
||||
|
||||
|
||||
#if 1
|
||||
//wait for digest ready
|
||||
while (! hashs->controlr.DGRY) {
|
||||
// this will not take long
|
||||
}
|
||||
#endif
|
||||
|
||||
*((u32 *) out + 0) = hashs->D1R;
|
||||
*((u32 *) out + 1) = hashs->D2R;
|
||||
*((u32 *) out + 2) = hashs->D3R;
|
||||
*((u32 *) out + 3) = hashs->D4R;
|
||||
*((u32 *) out + 4) = hashs->D5R;
|
||||
|
||||
/* reset the context after we finish with the hash */
|
||||
mctx->byte_count = 0;
|
||||
memset(&mctx->hash[0], 0, sizeof(MD5_HASH_WORDS));
|
||||
memset(&mctx->block[0], 0, sizeof(MD5_BLOCK_WORDS));
|
||||
memset(&temp[0], 0, MD5_HMAC_DBN_TEMP_SIZE);
|
||||
|
||||
CRTCL_SECT_END;
|
||||
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
EXPORT_SYMBOL(md5_hmac_final);
|
||||
|
||||
/*
|
||||
* \brief MD5_HMAC function mappings
|
||||
*/
|
||||
|
||||
static struct shash_alg ifxdeu_md5_hmac_alg = {
|
||||
.digestsize = MD5_DIGEST_SIZE,
|
||||
.init = md5_hmac_init,
|
||||
.update = md5_hmac_update,
|
||||
.final = md5_hmac_final,
|
||||
.setkey = md5_hmac_setkey,
|
||||
.descsize = sizeof(struct md5_hmac_ctx),
|
||||
.base = {
|
||||
.cra_name = "hmac(md5)",
|
||||
.cra_driver_name= "ifxdeu-md5_hmac",
|
||||
.cra_ctxsize = sizeof(struct md5_hmac_ctx),
|
||||
.cra_flags = CRYPTO_ALG_TYPE_DIGEST,
|
||||
.cra_blocksize = MD5_HMAC_BLOCK_SIZE,
|
||||
.cra_module = THIS_MODULE,
|
||||
}
|
||||
};
|
||||
|
||||
/*! \fn int __init ifxdeu_init_md5_hmac (void)
|
||||
* \ingroup IFX_MD5_HMAC_FUNCTIONS
|
||||
* \brief initialize md5 hmac driver
|
||||
*/
|
||||
int __init ifxdeu_init_md5_hmac (void)
|
||||
{
|
||||
|
||||
int ret = -ENOSYS;
|
||||
|
||||
|
||||
if ((ret = crypto_register_shash(&ifxdeu_md5_hmac_alg)))
|
||||
goto md5_hmac_err;
|
||||
|
||||
CRTCL_SECT_INIT;
|
||||
|
||||
printk (KERN_NOTICE "IFX DEU MD5_HMAC initialized%s.\n", disable_deudma ? "" : " (DMA)");
|
||||
return ret;
|
||||
|
||||
md5_hmac_err:
|
||||
printk(KERN_ERR "IFX DEU MD5_HMAC initialization failed!\n");
|
||||
return ret;
|
||||
}
|
||||
|
||||
/** \fn void __exit ifxdeu_fini_md5_hmac (void)
|
||||
* \ingroup IFX_MD5_HMAC_FUNCTIONS
|
||||
* \brief unregister md5 hmac driver
|
||||
*/
|
||||
void __exit ifxdeu_fini_md5_hmac (void)
|
||||
{
|
||||
crypto_unregister_shash(&ifxdeu_md5_hmac_alg);
|
||||
}
|
||||
|
||||
|
301
package/platform/lantiq/ltq-deu/src/ifxmips_sha1.c
Normal file
301
package/platform/lantiq/ltq-deu/src/ifxmips_sha1.c
Normal file
@ -0,0 +1,301 @@
|
||||
/******************************************************************************
|
||||
**
|
||||
** FILE NAME : ifxmips_sha1.c
|
||||
** PROJECT : IFX UEIP
|
||||
** MODULES : DEU Module for Danube
|
||||
**
|
||||
** DATE : September 8, 2009
|
||||
** AUTHOR : Mohammad Firdaus
|
||||
** DESCRIPTION : Data Encryption Unit Driver
|
||||
** COPYRIGHT : Copyright (c) 2009
|
||||
** Infineon Technologies AG
|
||||
** Am Campeon 1-12, 85579 Neubiberg, Germany
|
||||
**
|
||||
** 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.
|
||||
**
|
||||
** HISTORY
|
||||
** $Date $Author $Comment
|
||||
** 08,Sept 2009 Mohammad Firdaus Initial UEIP release
|
||||
*******************************************************************************/
|
||||
/*!
|
||||
\defgroup IFX_DEU IFX_DEU_DRIVERS
|
||||
\ingroup API
|
||||
\brief ifx deu driver module
|
||||
*/
|
||||
|
||||
/*!
|
||||
\file ifxmips_sha1.c
|
||||
\ingroup IFX_DEU
|
||||
\brief SHA1 encryption deu driver file
|
||||
*/
|
||||
|
||||
/*!
|
||||
\defgroup IFX_SHA1_FUNCTIONS IFX_SHA1_FUNCTIONS
|
||||
\ingroup IFX_DEU
|
||||
\brief ifx deu sha1 functions
|
||||
*/
|
||||
|
||||
|
||||
/* Project header */
|
||||
#include <linux/init.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/mm.h>
|
||||
#include <linux/crypto.h>
|
||||
#include <linux/cryptohash.h>
|
||||
#include <crypto/sha.h>
|
||||
#include <crypto/internal/hash.h>
|
||||
#include <linux/types.h>
|
||||
#include <asm/scatterlist.h>
|
||||
#include <asm/byteorder.h>
|
||||
|
||||
#if defined(CONFIG_DANUBE)
|
||||
#include "ifxmips_deu_danube.h"
|
||||
#elif defined(CONFIG_AR9)
|
||||
#include "ifxmips_deu_ar9.h"
|
||||
#elif defined(CONFIG_VR9) || defined(CONFIG_AR10)
|
||||
#include "ifxmips_deu_vr9.h"
|
||||
#else
|
||||
#error "Plaform Unknwon!"
|
||||
#endif
|
||||
|
||||
#define SHA1_DIGEST_SIZE 20
|
||||
#define SHA1_HMAC_BLOCK_SIZE 64
|
||||
#define HASH_START IFX_HASH_CON
|
||||
|
||||
static spinlock_t lock;
|
||||
#define CRTCL_SECT_INIT spin_lock_init(&lock)
|
||||
#define CRTCL_SECT_START spin_lock_irqsave(&lock, flag)
|
||||
#define CRTCL_SECT_END spin_unlock_irqrestore(&lock, flag)
|
||||
|
||||
//#define CRYPTO_DEBUG
|
||||
#ifdef CRYPTO_DEBUG
|
||||
extern char debug_level;
|
||||
#define DPRINTF(level, format, args...) if (level < debug_level) printk(KERN_INFO "[%s %s %d]: " format, __FILE__, __func__, __LINE__, ##args);
|
||||
#else
|
||||
#define DPRINTF(level, format, args...)
|
||||
#endif
|
||||
|
||||
/*
|
||||
* \brief SHA1 private structure
|
||||
*/
|
||||
struct sha1_ctx {
|
||||
int started;
|
||||
u64 count;
|
||||
u32 hash[5];
|
||||
u32 state[5];
|
||||
u8 buffer[64];
|
||||
};
|
||||
|
||||
extern int disable_deudma;
|
||||
|
||||
|
||||
/*! \fn static void sha1_transform (u32 *state, const u32 *in)
|
||||
* \ingroup IFX_SHA1_FUNCTIONS
|
||||
* \brief main interface to sha1 hardware
|
||||
* \param state current state
|
||||
* \param in 64-byte block of input
|
||||
*/
|
||||
static void sha1_transform (struct sha1_ctx *sctx, u32 *state, const u32 *in)
|
||||
{
|
||||
int i = 0;
|
||||
volatile struct deu_hash_t *hashs = (struct deu_hash_t *) HASH_START;
|
||||
unsigned long flag;
|
||||
|
||||
CRTCL_SECT_START;
|
||||
|
||||
/* For context switching purposes, the previous hash output
|
||||
* is loaded back into the output register
|
||||
*/
|
||||
if (sctx->started) {
|
||||
hashs->D1R = *((u32 *) sctx->hash + 0);
|
||||
hashs->D2R = *((u32 *) sctx->hash + 1);
|
||||
hashs->D3R = *((u32 *) sctx->hash + 2);
|
||||
hashs->D4R = *((u32 *) sctx->hash + 3);
|
||||
hashs->D5R = *((u32 *) sctx->hash + 4);
|
||||
}
|
||||
|
||||
for (i = 0; i < 16; i++) {
|
||||
hashs->MR = in[i];
|
||||
};
|
||||
|
||||
//wait for processing
|
||||
while (hashs->controlr.BSY) {
|
||||
// this will not take long
|
||||
}
|
||||
|
||||
/* For context switching purposes, the output is saved into a
|
||||
* context struct which can be used later on
|
||||
*/
|
||||
*((u32 *) sctx->hash + 0) = hashs->D1R;
|
||||
*((u32 *) sctx->hash + 1) = hashs->D2R;
|
||||
*((u32 *) sctx->hash + 2) = hashs->D3R;
|
||||
*((u32 *) sctx->hash + 3) = hashs->D4R;
|
||||
*((u32 *) sctx->hash + 4) = hashs->D5R;
|
||||
|
||||
sctx->started = 1;
|
||||
|
||||
CRTCL_SECT_END;
|
||||
}
|
||||
|
||||
/*! \fn static void sha1_init(struct crypto_tfm *tfm)
|
||||
* \ingroup IFX_SHA1_FUNCTIONS
|
||||
* \brief initialize sha1 hardware
|
||||
* \param tfm linux crypto algo transform
|
||||
*/
|
||||
static int sha1_init(struct shash_desc *desc)
|
||||
{
|
||||
struct sha1_ctx *sctx = shash_desc_ctx(desc);
|
||||
|
||||
SHA_HASH_INIT;
|
||||
|
||||
sctx->started = 0;
|
||||
sctx->count = 0;
|
||||
return 0;
|
||||
}
|
||||
|
||||
/*! \fn static void sha1_update(struct crypto_tfm *tfm, const u8 *data, unsigned int len)
|
||||
* \ingroup IFX_SHA1_FUNCTIONS
|
||||
* \brief on-the-fly sha1 computation
|
||||
* \param tfm linux crypto algo transform
|
||||
* \param data input data
|
||||
* \param len size of input data
|
||||
*/
|
||||
static int sha1_update(struct shash_desc * desc, const u8 *data,
|
||||
unsigned int len)
|
||||
{
|
||||
struct sha1_ctx *sctx = shash_desc_ctx(desc);
|
||||
unsigned int i, j;
|
||||
|
||||
j = (sctx->count >> 3) & 0x3f;
|
||||
sctx->count += len << 3;
|
||||
|
||||
if ((j + len) > 63) {
|
||||
memcpy (&sctx->buffer[j], data, (i = 64 - j));
|
||||
sha1_transform (sctx, sctx->state, (const u32 *)sctx->buffer);
|
||||
for (; i + 63 < len; i += 64) {
|
||||
sha1_transform (sctx, sctx->state, (const u32 *)&data[i]);
|
||||
}
|
||||
|
||||
j = 0;
|
||||
}
|
||||
else
|
||||
i = 0;
|
||||
|
||||
memcpy (&sctx->buffer[j], &data[i], len - i);
|
||||
return 0;
|
||||
}
|
||||
|
||||
/*! \fn static void sha1_final(struct crypto_tfm *tfm, u8 *out)
|
||||
* \ingroup IFX_SHA1_FUNCTIONS
|
||||
* \brief compute final sha1 value
|
||||
* \param tfm linux crypto algo transform
|
||||
* \param out final md5 output value
|
||||
*/
|
||||
static int sha1_final(struct shash_desc *desc, u8 *out)
|
||||
{
|
||||
struct sha1_ctx *sctx = shash_desc_ctx(desc);
|
||||
u32 index, padlen;
|
||||
u64 t;
|
||||
u8 bits[8] = { 0, };
|
||||
static const u8 padding[64] = { 0x80, };
|
||||
volatile struct deu_hash_t *hashs = (struct deu_hash_t *) HASH_START;
|
||||
unsigned long flag;
|
||||
|
||||
t = sctx->count;
|
||||
bits[7] = 0xff & t;
|
||||
t >>= 8;
|
||||
bits[6] = 0xff & t;
|
||||
t >>= 8;
|
||||
bits[5] = 0xff & t;
|
||||
t >>= 8;
|
||||
bits[4] = 0xff & t;
|
||||
t >>= 8;
|
||||
bits[3] = 0xff & t;
|
||||
t >>= 8;
|
||||
bits[2] = 0xff & t;
|
||||
t >>= 8;
|
||||
bits[1] = 0xff & t;
|
||||
t >>= 8;
|
||||
bits[0] = 0xff & t;
|
||||
|
||||
/* Pad out to 56 mod 64 */
|
||||
index = (sctx->count >> 3) & 0x3f;
|
||||
padlen = (index < 56) ? (56 - index) : ((64 + 56) - index);
|
||||
sha1_update (desc, padding, padlen);
|
||||
|
||||
/* Append length */
|
||||
sha1_update (desc, bits, sizeof bits);
|
||||
|
||||
CRTCL_SECT_START;
|
||||
|
||||
*((u32 *) out + 0) = hashs->D1R;
|
||||
*((u32 *) out + 1) = hashs->D2R;
|
||||
*((u32 *) out + 2) = hashs->D3R;
|
||||
*((u32 *) out + 3) = hashs->D4R;
|
||||
*((u32 *) out + 4) = hashs->D5R;
|
||||
|
||||
CRTCL_SECT_END;
|
||||
|
||||
// Wipe context
|
||||
memset (sctx, 0, sizeof *sctx);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
/*
|
||||
* \brief SHA1 function mappings
|
||||
*/
|
||||
static struct shash_alg ifxdeu_sha1_alg = {
|
||||
.digestsize = SHA1_DIGEST_SIZE,
|
||||
.init = sha1_init,
|
||||
.update = sha1_update,
|
||||
.final = sha1_final,
|
||||
.descsize = sizeof(struct sha1_ctx),
|
||||
.statesize = sizeof(struct sha1_state),
|
||||
.base = {
|
||||
.cra_name = "sha1",
|
||||
.cra_driver_name= "ifxdeu-sha1",
|
||||
.cra_flags = CRYPTO_ALG_TYPE_DIGEST,
|
||||
.cra_blocksize = SHA1_HMAC_BLOCK_SIZE,
|
||||
.cra_module = THIS_MODULE,
|
||||
}
|
||||
};
|
||||
|
||||
|
||||
/*! \fn int __init ifxdeu_init_sha1 (void)
|
||||
* \ingroup IFX_SHA1_FUNCTIONS
|
||||
* \brief initialize sha1 driver
|
||||
*/
|
||||
int __init ifxdeu_init_sha1 (void)
|
||||
{
|
||||
int ret = -ENOSYS;
|
||||
|
||||
|
||||
if ((ret = crypto_register_shash(&ifxdeu_sha1_alg)))
|
||||
goto sha1_err;
|
||||
|
||||
CRTCL_SECT_INIT;
|
||||
|
||||
printk (KERN_NOTICE "IFX DEU SHA1 initialized%s.\n", disable_deudma ? "" : " (DMA)");
|
||||
return ret;
|
||||
|
||||
sha1_err:
|
||||
printk(KERN_ERR "IFX DEU SHA1 initialization failed!\n");
|
||||
return ret;
|
||||
}
|
||||
|
||||
/*! \fn void __exit ifxdeu_fini_sha1 (void)
|
||||
* \ingroup IFX_SHA1_FUNCTIONS
|
||||
* \brief unregister sha1 driver
|
||||
*/
|
||||
void __exit ifxdeu_fini_sha1 (void)
|
||||
{
|
||||
crypto_unregister_shash(&ifxdeu_sha1_alg);
|
||||
|
||||
|
||||
}
|
||||
|
||||
|
378
package/platform/lantiq/ltq-deu/src/ifxmips_sha1_hmac.c
Normal file
378
package/platform/lantiq/ltq-deu/src/ifxmips_sha1_hmac.c
Normal file
@ -0,0 +1,378 @@
|
||||
/******************************************************************************
|
||||
**
|
||||
** FILE NAME : ifxmips_sha1_hmac.c
|
||||
** PROJECT : IFX UEIP
|
||||
** MODULES : DEU Module for UEIP
|
||||
** DATE : September 8, 2009
|
||||
** AUTHOR : Mohammad Firdaus
|
||||
** DESCRIPTION : Data Encryption Unit Driver
|
||||
** COPYRIGHT : Copyright (c) 2009
|
||||
** Infineon Technologies AG
|
||||
** Am Campeon 1-12, 85579 Neubiberg, Germany
|
||||
**
|
||||
** 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.
|
||||
**
|
||||
** HISTORY
|
||||
** $Date $Author $Comment
|
||||
** 08,Sept 2009 Mohammad Firdaus Initial UEIP release
|
||||
** 21,March 2011 Mohammad Firdaus Changes for Kernel 2.6.32 and IPSec integration
|
||||
*******************************************************************************/
|
||||
/*!
|
||||
\defgroup IFX_DEU IFX_DEU_DRIVERS
|
||||
\ingroup API
|
||||
\brief ifx deu driver module
|
||||
*/
|
||||
|
||||
/*!
|
||||
\file ifxmips_sha1_hmac.c
|
||||
\ingroup IFX_DEU
|
||||
\brief SHA1-HMAC deu driver file
|
||||
*/
|
||||
|
||||
/*!
|
||||
\defgroup IFX_SHA1_HMAC_FUNCTIONS IFX_SHA1_HMAC_FUNCTIONS
|
||||
\ingroup IFX_DEU
|
||||
\brief ifx sha1 hmac functions
|
||||
*/
|
||||
|
||||
|
||||
/* Project header */
|
||||
#include <linux/init.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/mm.h>
|
||||
#include <linux/crypto.h>
|
||||
#include <linux/cryptohash.h>
|
||||
#include <crypto/internal/hash.h>
|
||||
#include <linux/types.h>
|
||||
#include <asm/scatterlist.h>
|
||||
#include <asm/byteorder.h>
|
||||
#include <linux/delay.h>
|
||||
|
||||
#if defined(CONFIG_AR9)
|
||||
#include "ifxmips_deu_ar9.h"
|
||||
#elif defined(CONFIG_VR9) || defined(CONFIG_AR10)
|
||||
#include "ifxmips_deu_vr9.h"
|
||||
#else
|
||||
#error "Plaform Unknwon!"
|
||||
#endif
|
||||
|
||||
#define SHA1_DIGEST_SIZE 20
|
||||
#define SHA1_HMAC_BLOCK_SIZE 64
|
||||
#define SHA1_HMAC_DBN_TEMP_SIZE 1024 // size in dword, needed for dbn workaround
|
||||
#define HASH_START IFX_HASH_CON
|
||||
|
||||
#define SHA1_HMAC_MAX_KEYLEN 64
|
||||
|
||||
static spinlock_t lock;
|
||||
#define CRTCL_SECT_INIT spin_lock_init(&lock)
|
||||
#define CRTCL_SECT_START spin_lock_irqsave(&lock, flag)
|
||||
#define CRTCL_SECT_END spin_unlock_irqrestore(&lock, flag)
|
||||
|
||||
#ifdef CRYPTO_DEBUG
|
||||
extern char debug_level;
|
||||
#define DPRINTF(level, format, args...) if (level < debug_level) printk(KERN_INFO "[%s %s %d]: " format, __FILE__, __func__, __LINE__, ##args);
|
||||
#else
|
||||
#define DPRINTF(level, format, args...)
|
||||
#endif
|
||||
|
||||
struct sha1_hmac_ctx {
|
||||
int keylen;
|
||||
|
||||
u8 buffer[SHA1_HMAC_BLOCK_SIZE];
|
||||
u8 key[SHA1_HMAC_MAX_KEYLEN];
|
||||
u32 state[5];
|
||||
u32 dbn;
|
||||
u64 count;
|
||||
|
||||
};
|
||||
|
||||
static u32 temp[SHA1_HMAC_DBN_TEMP_SIZE];
|
||||
|
||||
extern int disable_deudma;
|
||||
|
||||
/*! \fn static void sha1_hmac_transform(struct crypto_tfm *tfm, u32 const *in)
|
||||
* \ingroup IFX_SHA1_HMAC_FUNCTIONS
|
||||
* \brief save input block to context
|
||||
* \param tfm linux crypto algo transform
|
||||
* \param in 64-byte block of input
|
||||
*/
|
||||
static int sha1_hmac_transform(struct shash_desc *desc, u32 const *in)
|
||||
{
|
||||
struct sha1_hmac_ctx *sctx = crypto_shash_ctx(desc->tfm);
|
||||
|
||||
memcpy(&temp[sctx->dbn<<4], in, 64); //dbn workaround
|
||||
sctx->dbn += 1;
|
||||
|
||||
if ( (sctx->dbn<<4) > SHA1_HMAC_DBN_TEMP_SIZE )
|
||||
{
|
||||
printk("SHA1_HMAC_DBN_TEMP_SIZE exceeded\n");
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
/*! \fn int sha1_hmac_setkey(struct crypto_tfm *tfm, const u8 *key, unsigned int keylen)
|
||||
* \ingroup IFX_SHA1_HMAC_FUNCTIONS
|
||||
* \brief sets sha1 hmac key
|
||||
* \param tfm linux crypto algo transform
|
||||
* \param key input key
|
||||
* \param keylen key length greater than 64 bytes IS NOT SUPPORTED
|
||||
*/
|
||||
static int sha1_hmac_setkey(struct crypto_shash *tfm, const u8 *key, unsigned int keylen)
|
||||
{
|
||||
struct sha1_hmac_ctx *sctx = crypto_shash_ctx(tfm);
|
||||
volatile struct deu_hash_t *hashs = (struct deu_hash_t *) HASH_START;
|
||||
|
||||
if (keylen > SHA1_HMAC_MAX_KEYLEN) {
|
||||
printk("Key length exceeds maximum key length\n");
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
//printk("Setting keys of len: %d\n", keylen);
|
||||
|
||||
hashs->KIDX |= 0x80000000; //reset keys back to 0
|
||||
memcpy(&sctx->key, key, keylen);
|
||||
sctx->keylen = keylen;
|
||||
|
||||
return 0;
|
||||
|
||||
}
|
||||
|
||||
|
||||
/*! \fn int sha1_hmac_setkey_hw(struct crypto_tfm *tfm, const u8 *key, unsigned int keylen)
|
||||
* \ingroup IFX_SHA1_HMAC_FUNCTIONS
|
||||
* \brief sets sha1 hmac key into hw registers
|
||||
* \param tfm linux crypto algo transform
|
||||
* \param key input key
|
||||
* \param keylen key length greater than 64 bytes IS NOT SUPPORTED
|
||||
*/
|
||||
static int sha1_hmac_setkey_hw(const u8 *key, unsigned int keylen)
|
||||
{
|
||||
volatile struct deu_hash_t *hash = (struct deu_hash_t *) HASH_START;
|
||||
int i, j;
|
||||
unsigned long flag;
|
||||
u32 *in_key = (u32 *)key;
|
||||
|
||||
j = 0;
|
||||
|
||||
CRTCL_SECT_START;
|
||||
for (i = 0; i < keylen; i+=4)
|
||||
{
|
||||
hash->KIDX = j;
|
||||
asm("sync");
|
||||
hash->KEY = *((u32 *) in_key + j);
|
||||
j++;
|
||||
}
|
||||
|
||||
CRTCL_SECT_END;
|
||||
return 0;
|
||||
}
|
||||
|
||||
/*! \fn void sha1_hmac_init(struct crypto_tfm *tfm)
|
||||
* \ingroup IFX_SHA1_HMAC_FUNCTIONS
|
||||
* \brief initialize sha1 hmac context
|
||||
* \param tfm linux crypto algo transform
|
||||
*/
|
||||
static int sha1_hmac_init(struct shash_desc *desc)
|
||||
{
|
||||
struct sha1_hmac_ctx *sctx = crypto_shash_ctx(desc->tfm);
|
||||
|
||||
//printk("debug ln: %d, fn: %s\n", __LINE__, __func__);
|
||||
sctx->dbn = 0; //dbn workaround
|
||||
sha1_hmac_setkey_hw(sctx->key, sctx->keylen);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
/*! \fn static void sha1_hmac_update(struct crypto_tfm *tfm, const u8 *data, unsigned int len)
|
||||
* \ingroup IFX_SHA1_HMAC_FUNCTIONS
|
||||
* \brief on-the-fly sha1 hmac computation
|
||||
* \param tfm linux crypto algo transform
|
||||
* \param data input data
|
||||
* \param len size of input data
|
||||
*/
|
||||
static int sha1_hmac_update(struct shash_desc *desc, const u8 *data,
|
||||
unsigned int len)
|
||||
{
|
||||
struct sha1_hmac_ctx *sctx = crypto_shash_ctx(desc->tfm);
|
||||
unsigned int i, j;
|
||||
|
||||
j = (sctx->count >> 3) & 0x3f;
|
||||
sctx->count += len << 3;
|
||||
// printk("sctx->count = %d\n", sctx->count);
|
||||
|
||||
if ((j + len) > 63) {
|
||||
memcpy (&sctx->buffer[j], data, (i = 64 - j));
|
||||
sha1_hmac_transform (desc, (const u32 *)sctx->buffer);
|
||||
for (; i + 63 < len; i += 64) {
|
||||
sha1_hmac_transform (desc, (const u32 *)&data[i]);
|
||||
}
|
||||
|
||||
j = 0;
|
||||
}
|
||||
else
|
||||
i = 0;
|
||||
|
||||
memcpy (&sctx->buffer[j], &data[i], len - i);
|
||||
return 0;
|
||||
}
|
||||
|
||||
/*! \fn static void sha1_hmac_final(struct crypto_tfm *tfm, u8 *out)
|
||||
* \ingroup IFX_SHA1_HMAC_FUNCTIONS
|
||||
* \brief ompute final sha1 hmac value
|
||||
* \param tfm linux crypto algo transform
|
||||
* \param out final sha1 hmac output value
|
||||
*/
|
||||
static int sha1_hmac_final(struct shash_desc *desc, u8 *out)
|
||||
{
|
||||
//struct sha1_hmac_ctx *sctx = shash_desc_ctx(desc);
|
||||
struct sha1_hmac_ctx *sctx = crypto_shash_ctx(desc->tfm);
|
||||
u32 index, padlen;
|
||||
u64 t;
|
||||
u8 bits[8] = { 0, };
|
||||
static const u8 padding[64] = { 0x80, };
|
||||
volatile struct deu_hash_t *hashs = (struct deu_hash_t *) HASH_START;
|
||||
unsigned long flag;
|
||||
int i = 0;
|
||||
int dbn;
|
||||
u32 *in = &temp[0];
|
||||
|
||||
t = sctx->count + 512; // need to add 512 bit of the IPAD operation
|
||||
bits[7] = 0xff & t;
|
||||
t >>= 8;
|
||||
bits[6] = 0xff & t;
|
||||
t >>= 8;
|
||||
bits[5] = 0xff & t;
|
||||
t >>= 8;
|
||||
bits[4] = 0xff & t;
|
||||
t >>= 8;
|
||||
bits[3] = 0xff & t;
|
||||
t >>= 8;
|
||||
bits[2] = 0xff & t;
|
||||
t >>= 8;
|
||||
bits[1] = 0xff & t;
|
||||
t >>= 8;
|
||||
bits[0] = 0xff & t;
|
||||
|
||||
/* Pad out to 56 mod 64 */
|
||||
index = (sctx->count >> 3) & 0x3f;
|
||||
padlen = (index < 56) ? (56 - index) : ((64 + 56) - index);
|
||||
sha1_hmac_update (desc, padding, padlen);
|
||||
|
||||
/* Append length */
|
||||
sha1_hmac_update (desc, bits, sizeof bits);
|
||||
|
||||
CRTCL_SECT_START;
|
||||
|
||||
hashs->DBN = sctx->dbn;
|
||||
|
||||
//for vr9 change, ENDI = 1
|
||||
*IFX_HASH_CON = HASH_CON_VALUE;
|
||||
|
||||
//wait for processing
|
||||
while (hashs->controlr.BSY) {
|
||||
// this will not take long
|
||||
}
|
||||
|
||||
for (dbn = 0; dbn < sctx->dbn; dbn++)
|
||||
{
|
||||
for (i = 0; i < 16; i++) {
|
||||
hashs->MR = in[i];
|
||||
};
|
||||
|
||||
hashs->controlr.GO = 1;
|
||||
asm("sync");
|
||||
|
||||
//wait for processing
|
||||
while (hashs->controlr.BSY) {
|
||||
// this will not take long
|
||||
}
|
||||
|
||||
in += 16;
|
||||
}
|
||||
|
||||
|
||||
#if 1
|
||||
//wait for digest ready
|
||||
while (! hashs->controlr.DGRY) {
|
||||
// this will not take long
|
||||
}
|
||||
#endif
|
||||
|
||||
*((u32 *) out + 0) = hashs->D1R;
|
||||
*((u32 *) out + 1) = hashs->D2R;
|
||||
*((u32 *) out + 2) = hashs->D3R;
|
||||
*((u32 *) out + 3) = hashs->D4R;
|
||||
*((u32 *) out + 4) = hashs->D5R;
|
||||
|
||||
memset(&sctx->buffer[0], 0, SHA1_HMAC_BLOCK_SIZE);
|
||||
sctx->count = 0;
|
||||
|
||||
//printk("debug ln: %d, fn: %s\n", __LINE__, __func__);
|
||||
CRTCL_SECT_END;
|
||||
|
||||
|
||||
return 0;
|
||||
|
||||
}
|
||||
|
||||
/*
|
||||
* \brief SHA1-HMAC function mappings
|
||||
*/
|
||||
static struct shash_alg ifxdeu_sha1_hmac_alg = {
|
||||
.digestsize = SHA1_DIGEST_SIZE,
|
||||
.init = sha1_hmac_init,
|
||||
.update = sha1_hmac_update,
|
||||
.final = sha1_hmac_final,
|
||||
.setkey = sha1_hmac_setkey,
|
||||
.descsize = sizeof(struct sha1_hmac_ctx),
|
||||
.base = {
|
||||
.cra_name = "hmac(sha1)",
|
||||
.cra_driver_name= "ifxdeu-sha1_hmac",
|
||||
.cra_ctxsize = sizeof(struct sha1_hmac_ctx),
|
||||
.cra_flags = CRYPTO_ALG_TYPE_DIGEST,
|
||||
.cra_blocksize = SHA1_HMAC_BLOCK_SIZE,
|
||||
.cra_module = THIS_MODULE,
|
||||
}
|
||||
|
||||
};
|
||||
|
||||
|
||||
/*! \fn int __init ifxdeu_init_sha1_hmac (void)
|
||||
* \ingroup IFX_SHA1_HMAC_FUNCTIONS
|
||||
* \brief initialize sha1 hmac driver
|
||||
*/
|
||||
int __init ifxdeu_init_sha1_hmac (void)
|
||||
{
|
||||
int ret = -ENOSYS;
|
||||
|
||||
|
||||
|
||||
if ((ret = crypto_register_shash(&ifxdeu_sha1_hmac_alg)))
|
||||
goto sha1_err;
|
||||
|
||||
CRTCL_SECT_INIT;
|
||||
|
||||
printk (KERN_NOTICE "IFX DEU SHA1_HMAC initialized%s.\n", disable_deudma ? "" : " (DMA)");
|
||||
return ret;
|
||||
|
||||
sha1_err:
|
||||
printk(KERN_ERR "IFX DEU SHA1_HMAC initialization failed!\n");
|
||||
return ret;
|
||||
}
|
||||
|
||||
/*! \fn void __exit ifxdeu_fini_sha1_hmac (void)
|
||||
* \ingroup IFX_SHA1_HMAC_FUNCTIONS
|
||||
* \brief unregister sha1 hmac driver
|
||||
*/
|
||||
void __exit ifxdeu_fini_sha1_hmac (void)
|
||||
{
|
||||
|
||||
crypto_unregister_shash(&ifxdeu_sha1_hmac_alg);
|
||||
|
||||
|
||||
}
|
||||
|
92
package/platform/lantiq/ltq-deu/src/ifxmips_tcrypt.h
Normal file
92
package/platform/lantiq/ltq-deu/src/ifxmips_tcrypt.h
Normal file
@ -0,0 +1,92 @@
|
||||
/*
|
||||
* Quick & dirty crypto testing module.
|
||||
*
|
||||
* This will only exist until we have a better testing mechanism
|
||||
* (e.g. a char device).
|
||||
*
|
||||
* Copyright (c) 2002 James Morris <jmorris@intercode.com.au>
|
||||
* Copyright (c) 2002 Jean-Francois Dive <jef@linuxbe.org>
|
||||
* Copyright (c) 2007 Nokia Siemens Networks
|
||||
*
|
||||
* 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.
|
||||
*
|
||||
*/
|
||||
#ifndef _IFXMIPS_CRYPTO_TCRYPT_H
|
||||
#define _IFXMIPS_CRYPTO_TCRYPT_H
|
||||
|
||||
struct cipher_speed_template {
|
||||
const char *key;
|
||||
unsigned int klen;
|
||||
};
|
||||
|
||||
struct hash_speed {
|
||||
unsigned int blen; /* buffer length */
|
||||
unsigned int plen; /* per-update length */
|
||||
};
|
||||
|
||||
/*
|
||||
* DES test vectors.
|
||||
*/
|
||||
#define DES3_SPEED_VECTORS 1
|
||||
#define CRYPTO_ALG_TYPE_SPEED_TEST 0xB
|
||||
|
||||
static int alg_speed_test(const char *alg, const char *driver,
|
||||
unsigned int sec,
|
||||
struct cipher_speed_template *t,
|
||||
unsigned int tcount, u8 *keysize);
|
||||
|
||||
static struct cipher_speed_template des3_speed_template[] = {
|
||||
{
|
||||
.key = "\x01\x23\x45\x67\x89\xab\xcd\xef"
|
||||
"\x55\x55\x55\x55\x55\x55\x55\x55"
|
||||
"\xfe\xdc\xba\x98\x76\x54\x32\x10",
|
||||
.klen = 24,
|
||||
}
|
||||
};
|
||||
|
||||
/*
|
||||
* Cipher speed tests
|
||||
*/
|
||||
static u8 speed_template_8[] = {8, 0};
|
||||
static u8 speed_template_24[] = {24, 0};
|
||||
static u8 speed_template_8_32[] = {8, 32, 0};
|
||||
static u8 speed_template_16_32[] = {16, 32, 0};
|
||||
static u8 speed_template_16_24_32[] = {16, 24, 32, 0};
|
||||
static u8 speed_template_32_40_48[] = {32, 40, 48, 0};
|
||||
static u8 speed_template_32_48_64[] = {32, 48, 64, 0};
|
||||
|
||||
/*
|
||||
* Digest speed tests
|
||||
*/
|
||||
static struct hash_speed generic_hash_speed_template[] = {
|
||||
{ .blen = 16, .plen = 16, },
|
||||
{ .blen = 64, .plen = 16, },
|
||||
{ .blen = 64, .plen = 64, },
|
||||
{ .blen = 256, .plen = 16, },
|
||||
{ .blen = 256, .plen = 64, },
|
||||
{ .blen = 256, .plen = 256, },
|
||||
{ .blen = 1024, .plen = 16, },
|
||||
{ .blen = 1024, .plen = 256, },
|
||||
{ .blen = 1024, .plen = 1024, },
|
||||
{ .blen = 2048, .plen = 16, },
|
||||
{ .blen = 2048, .plen = 256, },
|
||||
{ .blen = 2048, .plen = 1024, },
|
||||
{ .blen = 2048, .plen = 2048, },
|
||||
{ .blen = 4096, .plen = 16, },
|
||||
{ .blen = 4096, .plen = 256, },
|
||||
{ .blen = 4096, .plen = 1024, },
|
||||
{ .blen = 4096, .plen = 4096, },
|
||||
{ .blen = 8192, .plen = 16, },
|
||||
{ .blen = 8192, .plen = 256, },
|
||||
{ .blen = 8192, .plen = 1024, },
|
||||
{ .blen = 8192, .plen = 4096, },
|
||||
{ .blen = 8192, .plen = 8192, },
|
||||
|
||||
/* End marker */
|
||||
{ .blen = 0, .plen = 0, }
|
||||
};
|
||||
|
||||
#endif /* _CRYPTO_TCRYPT_H */
|
9598
package/platform/lantiq/ltq-deu/src/ifxmips_testmgr.h
Normal file
9598
package/platform/lantiq/ltq-deu/src/ifxmips_testmgr.h
Normal file
File diff suppressed because it is too large
Load Diff
141
package/platform/lantiq/ltq-deu/src/internal.h
Normal file
141
package/platform/lantiq/ltq-deu/src/internal.h
Normal file
@ -0,0 +1,141 @@
|
||||
/*
|
||||
* Cryptographic API.
|
||||
*
|
||||
* Copyright (c) 2002 James Morris <jmorris@intercode.com.au>
|
||||
* Copyright (c) 2005 Herbert Xu <herbert@gondor.apana.org.au>
|
||||
*
|
||||
* 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.
|
||||
*
|
||||
*/
|
||||
#ifndef _CRYPTO_INTERNAL_H
|
||||
#define _CRYPTO_INTERNAL_H
|
||||
|
||||
#include <crypto/algapi.h>
|
||||
#include <linux/completion.h>
|
||||
#include <linux/mm.h>
|
||||
#include <linux/highmem.h>
|
||||
#include <linux/interrupt.h>
|
||||
#include <linux/init.h>
|
||||
#include <linux/list.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/kernel.h>
|
||||
#include <linux/notifier.h>
|
||||
#include <linux/rwsem.h>
|
||||
#include <linux/slab.h>
|
||||
#include <linux/fips.h>
|
||||
|
||||
/* Crypto notification events. */
|
||||
enum {
|
||||
CRYPTO_MSG_ALG_REQUEST,
|
||||
CRYPTO_MSG_ALG_REGISTER,
|
||||
CRYPTO_MSG_ALG_UNREGISTER,
|
||||
CRYPTO_MSG_TMPL_REGISTER,
|
||||
CRYPTO_MSG_TMPL_UNREGISTER,
|
||||
};
|
||||
|
||||
struct crypto_instance;
|
||||
struct crypto_template;
|
||||
|
||||
struct crypto_larval {
|
||||
struct crypto_alg alg;
|
||||
struct crypto_alg *adult;
|
||||
struct completion completion;
|
||||
u32 mask;
|
||||
};
|
||||
|
||||
extern struct list_head crypto_alg_list;
|
||||
extern struct rw_semaphore crypto_alg_sem;
|
||||
extern struct blocking_notifier_head crypto_chain;
|
||||
|
||||
#ifdef CONFIG_PROC_FS
|
||||
void __init crypto_init_proc(void);
|
||||
void __exit crypto_exit_proc(void);
|
||||
#else
|
||||
static inline void crypto_init_proc(void)
|
||||
{ }
|
||||
static inline void crypto_exit_proc(void)
|
||||
{ }
|
||||
#endif
|
||||
|
||||
static inline unsigned int crypto_cipher_ctxsize(struct crypto_alg *alg)
|
||||
{
|
||||
return alg->cra_ctxsize;
|
||||
}
|
||||
|
||||
static inline unsigned int crypto_compress_ctxsize(struct crypto_alg *alg)
|
||||
{
|
||||
return alg->cra_ctxsize;
|
||||
}
|
||||
|
||||
struct crypto_alg *crypto_mod_get(struct crypto_alg *alg);
|
||||
struct crypto_alg *crypto_alg_lookup(const char *name, u32 type, u32 mask);
|
||||
struct crypto_alg *crypto_alg_mod_lookup(const char *name, u32 type, u32 mask);
|
||||
|
||||
int crypto_init_cipher_ops(struct crypto_tfm *tfm);
|
||||
int crypto_init_compress_ops(struct crypto_tfm *tfm);
|
||||
|
||||
void crypto_exit_cipher_ops(struct crypto_tfm *tfm);
|
||||
void crypto_exit_compress_ops(struct crypto_tfm *tfm);
|
||||
|
||||
struct crypto_larval *crypto_larval_alloc(const char *name, u32 type, u32 mask);
|
||||
void crypto_larval_kill(struct crypto_alg *alg);
|
||||
struct crypto_alg *crypto_larval_lookup(const char *name, u32 type, u32 mask);
|
||||
void crypto_larval_error(const char *name, u32 type, u32 mask);
|
||||
void crypto_alg_tested(const char *name, int err);
|
||||
|
||||
void crypto_shoot_alg(struct crypto_alg *alg);
|
||||
struct crypto_tfm *__crypto_alloc_tfm(struct crypto_alg *alg, u32 type,
|
||||
u32 mask);
|
||||
void *crypto_create_tfm(struct crypto_alg *alg,
|
||||
const struct crypto_type *frontend);
|
||||
struct crypto_alg *crypto_find_alg(const char *alg_name,
|
||||
const struct crypto_type *frontend,
|
||||
u32 type, u32 mask);
|
||||
void *crypto_alloc_tfm(const char *alg_name,
|
||||
const struct crypto_type *frontend, u32 type, u32 mask);
|
||||
|
||||
int crypto_register_notifier(struct notifier_block *nb);
|
||||
int crypto_unregister_notifier(struct notifier_block *nb);
|
||||
int crypto_probing_notify(unsigned long val, void *v);
|
||||
|
||||
static inline void crypto_alg_put(struct crypto_alg *alg)
|
||||
{
|
||||
if (atomic_dec_and_test(&alg->cra_refcnt) && alg->cra_destroy)
|
||||
alg->cra_destroy(alg);
|
||||
}
|
||||
|
||||
static inline int crypto_tmpl_get(struct crypto_template *tmpl)
|
||||
{
|
||||
return try_module_get(tmpl->module);
|
||||
}
|
||||
|
||||
static inline void crypto_tmpl_put(struct crypto_template *tmpl)
|
||||
{
|
||||
module_put(tmpl->module);
|
||||
}
|
||||
|
||||
static inline int crypto_is_larval(struct crypto_alg *alg)
|
||||
{
|
||||
return alg->cra_flags & CRYPTO_ALG_LARVAL;
|
||||
}
|
||||
|
||||
static inline int crypto_is_dead(struct crypto_alg *alg)
|
||||
{
|
||||
return alg->cra_flags & CRYPTO_ALG_DEAD;
|
||||
}
|
||||
|
||||
static inline int crypto_is_moribund(struct crypto_alg *alg)
|
||||
{
|
||||
return alg->cra_flags & (CRYPTO_ALG_DEAD | CRYPTO_ALG_DYING);
|
||||
}
|
||||
|
||||
static inline void crypto_notify(unsigned long val, void *v)
|
||||
{
|
||||
blocking_notifier_call_chain(&crypto_chain, val, v);
|
||||
}
|
||||
|
||||
#endif /* _CRYPTO_INTERNAL_H */
|
||||
|
3957
package/platform/lantiq/ltq-deu/src/ltq_deu_testmgr.c
Normal file
3957
package/platform/lantiq/ltq-deu/src/ltq_deu_testmgr.c
Normal file
File diff suppressed because it is too large
Load Diff
Loading…
Reference in New Issue
Block a user