first commit

1 files changed, 365 insertions, 0 deletions

diff --git a/drivers/misc/mediatek/kernel/sec_osal.c b/drivers/misc/mediatek/kernel/sec_osal.c
new file mode 100644
index 000000000..10319fee8
--- /dev/null
+++ b/drivers/misc/mediatek/kernel/sec_osal.c
@@ -0,0 +1,365 @@
+/******************************************************************************
+ *  KERNEL HEADER
+ ******************************************************************************/
+#include <mach/sec_osal.h>
+
+#include <linux/string.h>
+#include <linux/bug.h>
+#include <linux/spinlock.h>
+#include <linux/semaphore.h>
+#include <linux/delay.h>
+#include <linux/errno.h>
+#include <linux/mutex.h>
+#include <linux/mtd/mtd.h>
+#include <linux/fs.h>
+#include <linux/mtd/partitions.h>
+#include <asm/uaccess.h>
+#include <linux/slab.h>
+#include <linux/version.h>
+#include <linux/module.h>
+#if LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 36)
+#include <linux/mtd/nand.h>
+#endif
+#include <linux/vmalloc.h>
+
+/*****************************************************************************
+ * MACRO
+ *****************************************************************************/
+#ifndef ASSERT
+#define ASSERT(expr)        BUG_ON(!(expr))
+#endif
+
+/*****************************************************************************
+ * GLOBAL VARIABLE
+ *****************************************************************************/
+#if (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 36))
+DECLARE_MUTEX(hacc_sem);
+DECLARE_MUTEX(mtd_sem);
+DECLARE_MUTEX(rid_sem);
+DECLARE_MUTEX(sec_mm_sem);
+DECLARE_MUTEX(osal_fp_sem);
+DECLARE_MUTEX(osal_verify_sem);
+DECLARE_MUTEX(osal_secro_sem);
+DECLARE_MUTEX(osal_secro_v5_sem);
+#else				/* (LINUX_VERSION_CODE < KERNEL_VERSION(2,6,36)) */
+DEFINE_SEMAPHORE(hacc_sem);
+DEFINE_SEMAPHORE(mtd_sem);
+DEFINE_SEMAPHORE(rid_sem);
+DEFINE_SEMAPHORE(sec_mm_sem);
+DEFINE_SEMAPHORE(osal_fp_sem);
+DEFINE_SEMAPHORE(osal_verify_sem);
+DEFINE_SEMAPHORE(osal_secro_sem);
+DEFINE_SEMAPHORE(osal_secro_v5_sem);
+#endif
+
+/*****************************************************************************
+ * LOCAL VARIABLE
+ *****************************************************************************/
+static mm_segment_t curr_fs;
+#define OSAL_MAX_FP_COUNT           4096
+#define OSAL_FP_OVERFLOW            OSAL_MAX_FP_COUNT
+/* The array 0 will be not be used, and fp_id=0 will be though as NULL file */
+static struct file *g_osal_fp[OSAL_MAX_FP_COUNT] = { 0 };
+
+/*****************************************************************************
+ * PORTING LAYER
+ *****************************************************************************/
+void osal_kfree(void *buf)
+{
+/* kfree(buf); */
+	vfree(buf);
+}
+
+void *osal_kmalloc(unsigned int size)
+{
+/* return kmalloc(size,GFP_KERNEL); */
+	return vmalloc(size);
+}
+
+unsigned long osal_copy_from_user(void *to, void *from, unsigned long size)
+{
+	return copy_from_user(to, from, size);
+}
+
+unsigned long osal_copy_to_user(void *to, void *from, unsigned long size)
+{
+	return copy_to_user(to, from, size);
+}
+
+int osal_hacc_lock(void)
+{
+	return down_interruptible(&hacc_sem);
+}
+
+void osal_hacc_unlock(void)
+{
+	up(&hacc_sem);
+}
+
+
+int osal_verify_lock(void)
+{
+	return down_interruptible(&osal_verify_sem);
+}
+
+void osal_verify_unlock(void)
+{
+	up(&osal_verify_sem);
+}
+
+int osal_secro_lock(void)
+{
+	return down_interruptible(&osal_secro_sem);
+}
+
+void osal_secro_unlock(void)
+{
+	up(&osal_secro_sem);
+}
+
+int osal_secro_v5_lock(void)
+{
+	return down_interruptible(&osal_secro_v5_sem);
+}
+
+void osal_secro_v5_unlock(void)
+{
+	up(&osal_secro_v5_sem);
+}
+
+int osal_mtd_lock(void)
+{
+	return down_interruptible(&mtd_sem);
+}
+
+void osal_mtd_unlock(void)
+{
+	up(&mtd_sem);
+}
+
+int osal_rid_lock(void)
+{
+	return down_interruptible(&rid_sem);
+}
+
+void osal_rid_unlock(void)
+{
+	up(&rid_sem);
+}
+
+void osal_msleep(unsigned int msec)
+{
+	msleep(msec);
+}
+
+void osal_assert(unsigned int val)
+{
+	ASSERT(val);
+}
+
+int osal_set_kernel_fs(void)
+{
+	int val = 0;
+	val = down_interruptible(&sec_mm_sem);
+	curr_fs = get_fs();
+	set_fs(KERNEL_DS);
+	return val;
+}
+
+void osal_restore_fs(void)
+{
+	set_fs(curr_fs);
+	up(&sec_mm_sem);
+}
+
+int osal_filp_open_read_only(const char *file_path)
+{
+	int filp_id = 0;
+	int val = 0;
+
+	val = down_interruptible(&osal_fp_sem);
+
+	for (filp_id = 1; filp_id < OSAL_MAX_FP_COUNT; filp_id++) {
+		if (g_osal_fp[filp_id] == NULL) {
+			break;
+		}
+	}
+
+	g_osal_fp[filp_id] = filp_open(file_path, O_RDONLY, 0777);
+
+	if (IS_ERR(g_osal_fp[filp_id])) {
+		g_osal_fp[OSAL_FILE_NULL] = g_osal_fp[filp_id];	/* Record the fail reason in pos 0 */
+		g_osal_fp[filp_id] = NULL;
+		filp_id = OSAL_FILE_NULL;
+	}
+
+	up(&osal_fp_sem);
+
+	/* the fp_id = 0 will be thought as NULL file ponter */
+	if (filp_id >= OSAL_FP_OVERFLOW) {
+		g_osal_fp[OSAL_FILE_NULL] = (struct file *)(-ENOMEM);	/* Out of memory */
+		return OSAL_FILE_NULL;
+	}
+
+	return filp_id;
+}
+
+void *osal_get_filp_struct(int fp_id)
+{
+	int val = 0;
+	struct file *ret;
+
+	if (fp_id >= 1 && fp_id < OSAL_MAX_FP_COUNT) {
+		val = down_interruptible(&osal_fp_sem);
+
+		ret = g_osal_fp[fp_id];
+
+		up(&osal_fp_sem);
+
+		return (void *)ret;
+	}
+
+	return (struct file *)(-ENOENT);	/* No such file or directory */
+}
+
+int osal_filp_close(int fp_id)
+{
+	int val = 0;
+	int ret = 0;
+
+	if (fp_id >= 1 && fp_id < OSAL_MAX_FP_COUNT) {
+		val = down_interruptible(&osal_fp_sem);
+
+		if (!IS_ERR(g_osal_fp[fp_id])) {
+			ret = filp_close(g_osal_fp[fp_id], NULL);
+		}
+		g_osal_fp[fp_id] = NULL;
+
+		up(&osal_fp_sem);
+
+		return ret;
+	}
+
+	return OSAL_FILE_CLOSE_FAIL;
+}
+
+loff_t osal_filp_seek_set(int fp_id, loff_t off)
+{
+	loff_t offset;
+	int val = 0;
+
+	if (fp_id >= 1 && fp_id < OSAL_MAX_FP_COUNT) {
+		val = down_interruptible(&osal_fp_sem);
+
+		offset = g_osal_fp[fp_id]->f_op->llseek(g_osal_fp[fp_id], off, SEEK_SET);
+
+		up(&osal_fp_sem);
+
+		return offset;
+	}
+
+	return OSAL_FILE_SEEK_FAIL;
+}
+
+loff_t osal_filp_seek_end(int fp_id, loff_t off)
+{
+	loff_t offset;
+	int val = 0;
+
+	if (fp_id >= 1 && fp_id < OSAL_MAX_FP_COUNT) {
+		val = down_interruptible(&osal_fp_sem);
+
+		offset = g_osal_fp[fp_id]->f_op->llseek(g_osal_fp[fp_id], off, SEEK_END);
+
+		up(&osal_fp_sem);
+
+		return offset;
+	}
+
+	return OSAL_FILE_SEEK_FAIL;
+}
+
+loff_t osal_filp_pos(int fp_id)
+{
+	loff_t offset;
+	int val = 0;
+
+	if (fp_id >= 1 && fp_id < OSAL_MAX_FP_COUNT) {
+		val = down_interruptible(&osal_fp_sem);
+
+		offset = g_osal_fp[fp_id]->f_pos;
+
+		up(&osal_fp_sem);
+
+		return offset;
+	}
+
+	return OSAL_FILE_GET_POS_FAIL;
+}
+
+long osal_filp_read(int fp_id, char *buf, unsigned long len)
+{
+	ssize_t read_len;
+	int val = 0;
+
+	if (fp_id >= 1 && fp_id < OSAL_MAX_FP_COUNT) {
+		val = down_interruptible(&osal_fp_sem);
+
+		read_len =
+		    g_osal_fp[fp_id]->f_op->read(g_osal_fp[fp_id], buf, len,
+						 &g_osal_fp[fp_id]->f_pos);
+
+		up(&osal_fp_sem);
+
+		return read_len;
+	}
+
+	return OSAL_FILE_READ_FAIL;
+}
+
+long osal_is_err(int fp_id)
+{
+	bool err;
+	int val = 0;
+
+	if (fp_id >= 1 && fp_id < OSAL_MAX_FP_COUNT) {
+		val = down_interruptible(&osal_fp_sem);
+
+		err = IS_ERR(g_osal_fp[fp_id]);
+
+		up(&osal_fp_sem);
+
+		return err;
+	}
+
+	osal_assert(0);
+	return 1;
+}
+EXPORT_SYMBOL(osal_kfree);
+EXPORT_SYMBOL(osal_kmalloc);
+EXPORT_SYMBOL(osal_copy_from_user);
+EXPORT_SYMBOL(osal_copy_to_user);
+EXPORT_SYMBOL(osal_hacc_lock);
+EXPORT_SYMBOL(osal_hacc_unlock);
+EXPORT_SYMBOL(osal_verify_lock);
+EXPORT_SYMBOL(osal_verify_unlock);
+EXPORT_SYMBOL(osal_secro_lock);
+EXPORT_SYMBOL(osal_secro_unlock);
+EXPORT_SYMBOL(osal_secro_v5_lock);
+EXPORT_SYMBOL(osal_secro_v5_unlock);
+EXPORT_SYMBOL(osal_mtd_lock);
+EXPORT_SYMBOL(osal_mtd_unlock);
+EXPORT_SYMBOL(osal_rid_lock);
+EXPORT_SYMBOL(osal_rid_unlock);
+EXPORT_SYMBOL(osal_msleep);
+EXPORT_SYMBOL(osal_assert);
+EXPORT_SYMBOL(osal_set_kernel_fs);
+EXPORT_SYMBOL(osal_restore_fs);
+EXPORT_SYMBOL(osal_get_filp_struct);
+EXPORT_SYMBOL(osal_filp_close);
+EXPORT_SYMBOL(osal_filp_seek_set);
+EXPORT_SYMBOL(osal_filp_seek_end);
+EXPORT_SYMBOL(osal_filp_pos);
+EXPORT_SYMBOL(osal_filp_read);
+EXPORT_SYMBOL(osal_is_err);
+EXPORT_SYMBOL(osal_filp_open_read_only);