Aquaris-M10-4G/drivers/misc/mediatek/connectivity/common/combo/linux/stp_chrdev_ant.c

#include <linux/init.h>
#include <linux/module.h>
#include <linux/types.h>
#include <linux/kernel.h>
#include <linux/fs.h>
#include <linux/cdev.h>
#include <linux/sched.h>
#include <asm/current.h>
#include <asm/uaccess.h>
#include <linux/fcntl.h>
#include <linux/poll.h>
#include <linux/delay.h>
#include <linux/time.h>
#include "osal_typedef.h"
#include "stp_exp.h"
#include "wmt_exp.h"

MODULE_LICENSE("Dual BSD/GPL");


#define ANT_DRIVER_NAME "mtk_stp_ANT_chrdev"
#define ANT_DEV_MAJOR 197	/* never used number */
static PINT8 ANT_BUILT_IN_PATCH_FILE_NAME;
static PINT8 ANT_BUILT_IN_PATCH_FILE_NAME_E1 = "/system/etc/firmware/ANT_RAM_CODE_E1.BIN";
static PINT8 ANT_BUILT_IN_PATCH_FILE_NAME_E2 = "/system/etc/firmware/ANT_RAM_CODE_E2.BIN";

#define PFX                         "[MTK-ANT] "
#define ANT_LOG_DBG                  3
#define ANT_LOG_INFO                 2
#define ANT_LOG_WARN                 1
#define ANT_LOG_ERR                  0

#define COMBO_IOC_ANT_HWVER           6
#define COMBO_IOCTL_ANT_IC_HW_VER	7
#define COMBO_IOCTL_ANT_IC_FW_VER	8
#define COMBO_IOCTAL_ANT_DOWNLOAD_FIRMWARE 9

#define COMBO_IOC_MAGIC        0xb0
#define COMBO_IOCTL_FW_ASSERT  _IOWR(COMBO_IOC_MAGIC, 0, void*)
#define COMBO_IOCTL_BT_IC_HW_VER  _IOWR(COMBO_IOC_MAGIC, 1, int)
#define COMBO_IOCTL_BT_IC_FW_VER  _IOWR(COMBO_IOC_MAGIC, 2, int)

static UINT32 gDbgLevel = ANT_LOG_INFO;

#define ANT_DBG_FUNC(fmt, arg...)	\
do { if (gDbgLevel >= ANT_LOG_DBG)	\
		pr_warn(PFX "%s: "  fmt, __func__ , ##arg);	\
} while (0)
#define ANT_INFO_FUNC(fmt, arg...)	\
do { if (gDbgLevel >= ANT_LOG_INFO)	\
		pr_warn(PFX "%s: "  fmt, __func__ , ##arg);	\
} while (0)
#define ANT_WARN_FUNC(fmt, arg...)	\
do { if (gDbgLevel >= ANT_LOG_WARN)	\
		pr_err(PFX "%s: "  fmt, __func__ , ##arg);	\
} while (0)
#define ANT_ERR_FUNC(fmt, arg...)	\
do { if (gDbgLevel >= ANT_LOG_ERR)	\
		pr_err(PFX "%s: "   fmt, __func__ , ##arg);	\
} while (0)

#define VERSION "1.0"
/* #define BT_NVRAM_CUSTOM_NAME "/data/BT_Addr" */

static INT32 ANT_devs = 1;	/* device count */
static INT32 ANT_major = ANT_DEV_MAJOR;	/* dynamic allocation */
module_param(ANT_major, uint, 0);
static struct cdev ANT_cdev;

static UINT8 i_buf[MTKSTP_BUFFER_SIZE];	/* input buffer of read() */
static UINT8 o_buf[MTKSTP_BUFFER_SIZE];	/* output buffer of write() */
static struct semaphore wr_mtx, rd_mtx;
static wait_queue_head_t inq;	/* read queues */
static DECLARE_WAIT_QUEUE_HEAD(ANT_wq);
static INT32 flag;
static volatile INT32 retflag;
/*
static unsigned char g_bt_bd_addr[10] = {0x01, 0x1a, 0xfc, 0x06, 0x00, 0x55, 0x66, 0x77, 0x88, 0x00};
static unsigned char g_nvram_btdata[8];
*/
static INT32 read_ram_code_length = 300;
static int ANT_Power(unsigned long ver);
/*
static INT32 nvram_read(PINT8 filename, PINT8 buf, ssize_t len, INT32 offset)
{
    struct file *fd;
    //ssize_t ret;
    INT32 retLen = -1;

    mm_segment_t old_fs = get_fs();
    set_fs(KERNEL_DS);

    fd = filp_open(filename, O_WRONLY | O_CREAT, 0644);

    if (IS_ERR(fd)) {
	BT_ERR_FUNC("failed to open!!\n");
	return -1;
    }
    do {
	if ((fd->f_op == NULL) || (fd->f_op->read == NULL)) {
	    BT_ERR_FUNC("file can not be read!!\n");
	    break;
	}

	if (fd->f_pos != offset) {
	    if (fd->f_op->llseek) {
		if (fd->f_op->llseek(fd, offset, 0) != offset) {
		    BT_ERR_FUNC("[nvram_read] : failed to seek!!\n");
		    break;
		}
	    } else {
		fd->f_pos = offset;
	    }
	}

	retLen = fd->f_op->read(fd,
				buf,
				len,
				&fd->f_pos);

    } while (false);

    filp_close(fd, NULL);

    set_fs(old_fs);

    return retLen;
}


INT32 platform_load_nvram_data(PINT8 filename, PINT8 buf, INT32 len)
{
    //INT32 ret;
    BT_INFO_FUNC("platform_load_nvram_data ++ BDADDR\n");

    return nvram_read(filename, buf, len, 0);
}
*/

static VOID ant_cdev_rst_cb(ENUM_WMTDRV_TYPE_T src,
			    ENUM_WMTDRV_TYPE_T dst,
			    ENUM_WMTMSG_TYPE_T type, PVOID buf, UINT32 sz)
{

	/*
	   To handle reset procedure please
	 */
	ENUM_WMTRSTMSG_TYPE_T rst_msg;

	/*ANT_DBG_FUNC("sizeof(ENUM_WMTRSTMSG_TYPE_T) = %zd\n", sizeof(ENUM_WMTRSTMSG_TYPE_T));*/
	if (sz <= sizeof(ENUM_WMTRSTMSG_TYPE_T)) {
		memcpy((PINT8)&rst_msg, (PINT8)buf, sz);
		ANT_DBG_FUNC("src = %d, dst = %d, type = %d, buf = 0x%x sz = %d, max = %d\n", src,
			      dst, type, rst_msg, sz, WMTRSTMSG_RESET_MAX);
		if ((src == WMTDRV_TYPE_WMT) && (dst == WMTDRV_TYPE_ANT)
		    && (type == WMTMSG_TYPE_RESET)) {
			if (rst_msg == WMTRSTMSG_RESET_START) {
				ANT_INFO_FUNC("ANT restart start!\n");
				retflag = 1;
				wake_up_interruptible(&inq);
				/*reset_start message handling */

			} else if (rst_msg == WMTRSTMSG_RESET_END) {
				ANT_INFO_FUNC("ANT restart end!\n");
				retflag = 2;
				wake_up_interruptible(&inq);
				/*reset_end message handling */
			}
		}
	} else {
		/*message format invalid */
		ANT_INFO_FUNC("message format invalid!\n");
	}
}

VOID ANT_event_cb(VOID)
{
	ANT_DBG_FUNC("ANT_event_cb()\n");

	flag = 1;
	wake_up(&ANT_wq);
	/* finally, awake any reader */
	wake_up_interruptible(&inq);	/* blocked in read() and select() */
}

unsigned int ANT_poll(struct file *filp, poll_table *wait)
{
	UINT32 mask = 0;

/* down(&wr_mtx); */
	/*
	 * The buffer is circular; it is considered full
	 * if "wp" is right behind "rp". "left" is 0 if the
	 * buffer is empty, and it is "1" if it is completely full.
	 */
	if (mtk_wcn_stp_is_rxqueue_empty(ANT_TASK_INDX)) {
		poll_wait(filp, &inq, wait);

		/* empty let select sleep */
		if ((!mtk_wcn_stp_is_rxqueue_empty(ANT_TASK_INDX)) || retflag)
			mask |= POLLIN | POLLRDNORM;	/* readable */
	} else {
		mask |= POLLIN | POLLRDNORM;	/* readable */
	}

	/* do we need condition? */
	mask |= POLLOUT | POLLWRNORM;	/* writable */
/* up(&wr_mtx); */
	return mask;
}


ssize_t ANT_write(struct file *filp, const char __user *buf, size_t count, loff_t *f_pos)
{
	INT32 retval = 0;
	INT32 written = 0;

	down(&wr_mtx);
	/*ANT_DBG_FUNC("%s: count %d pos %lld\n", __func__, count, *f_pos);*/
	if (retflag) {
		if (retflag == 1) {	/* reset start */
			retval = -88;
			ANT_INFO_FUNC("MT662x reset Write: start\n");
		} else if (retflag == 2) {	/* reset end */
			retval = -99;
			ANT_INFO_FUNC("MT662x reset Write: end\n");
		}
		goto OUT;
	}

	if (count > 0) {
		INT32 copy_size = (count < MTKSTP_BUFFER_SIZE) ? count : MTKSTP_BUFFER_SIZE;

		if (copy_from_user(&o_buf[0], &buf[0], copy_size)) {
			retval = -EFAULT;
			goto OUT;
		}
		/* pr_warn("%02x ", val); */

		written = mtk_wcn_stp_send_data(&o_buf[0], copy_size, ANT_TASK_INDX);
		if (0 == written) {
			retval = -ENOSPC;
		/*no windowspace in STP is available, native process should not call BT_write with no delay at all */
		/*ANT_ERR_FUNC
			    ("target packet length:%d, write success length:%d, retval = %d.\n",
			     count, written, retval);*/
		} else {
			retval = written;
		}

	} else {
		retval = -EFAULT;
	/*ANT_ERR_FUNC("target packet length:%d is not allowed, retval = %d.\n", count,
			     retval);*/
	}

 OUT:
	up(&wr_mtx);
	return retval;
}

ssize_t ANT_read(struct file *filp, char __user *buf, size_t count, loff_t *f_pos)
{
	INT32 retval = 0;
	INT32 i = 0;

	down(&rd_mtx);

	/*ANT_DBG_FUNC("ANT_read(): count %d pos %lld\n", count, *f_pos);*/
	if (retflag) {
		if (retflag == 1) {	/* reset start */
			retval = -88;
			ANT_INFO_FUNC("MT662x reset Read: start\n");
		} else if (retflag == 2) {	/* reset end */
			retval = -99;
			ANT_INFO_FUNC("MT662x reset Read: end\n");
		}
		goto OUT;
	}

	if (count > MTKSTP_BUFFER_SIZE)
		count = MTKSTP_BUFFER_SIZE;
	retval = mtk_wcn_stp_receive_data(i_buf, count, ANT_TASK_INDX);

	while (retval == 0) {	/* got nothing, wait for STP's signal */
		/*If nonblocking mode, return directly O_NONBLOCK is specified during open() */
		if (filp->f_flags & O_NONBLOCK) {
			ANT_DBG_FUNC("Non-blocking ANT_read()\n");
			retval = -EAGAIN;
			goto OUT;
		}

		ANT_DBG_FUNC("ANT_read(): wait_event 1\n");
		wait_event(ANT_wq, flag != 0);
		ANT_DBG_FUNC("ANT_read(): wait_event 2\n");
		flag = 0;

		retval = mtk_wcn_stp_receive_data(i_buf, count, ANT_TASK_INDX);
		ANT_DBG_FUNC("ANT_read(): mtk_wcn_stp_receive_data() = %d\n", retval);
	}

	ANT_DBG_FUNC("ANT_read() read buffer is:");

	while (i < retval) {
		ANT_DBG_FUNC("[%d]:0x%x\n", i, i_buf[i]);
		i++;
	}

	ANT_DBG_FUNC("ANT_read(): mtk_wcn_stp_receive_data() = %d\n", retval);
	/* we got something from STP driver */
	if (copy_to_user(buf, i_buf, retval)) {
		retval = -EFAULT;
		goto OUT;
	}

 OUT:
	up(&rd_mtx);
	ANT_DBG_FUNC("ANT_read(): retval = %d\n", retval);
	return retval;
}

/* int BT_ioctl(struct inode *inode, struct file *filp, unsigned int cmd, unsigned long arg) */
long ANT_unlocked_ioctl(struct file *filp, unsigned int cmd, unsigned long arg)
{
	INT32 retval = 0;
	UINT32 hw_version = 0;
	UINT32 fw_version = 0;
	MTK_WCN_BOOL bRet = MTK_WCN_BOOL_TRUE;
	ENUM_WMTHWVER_TYPE_T hw_ver_sym = WMTHWVER_INVALID;

	ANT_DBG_FUNC("ANT_ioctl(): cmd (%d)\n", cmd);
	switch (cmd) {
#if 0
	case 0:		/* enable/disable STP */
		/* George: STP is controlled by WMT only */
		/* mtk_wcn_stp_enable(arg); */
		break;
#endif
	case 1:		/* send raw data */
		ANT_DBG_FUNC("ANT_ioctl(): disable raw data from ANT dev\n");
		retval = -EINVAL;
		break;
	case COMBO_IOC_ANT_HWVER:
		/*get combo hw version */
		hw_ver_sym = mtk_wcn_wmt_hwver_get();

		/*ANT_INFO_FUNC("ANT_ioctl(): get hw version = %d, sizeof(hw_ver_sym) = %d\n",
			      hw_ver_sym, sizeof(hw_ver_sym)); */
		if (copy_to_user((int __user *)arg, &hw_ver_sym, sizeof(hw_ver_sym)))
			retval = -EFAULT;
		break;

	case COMBO_IOCTL_FW_ASSERT:
		/* BT trigger fw assert for debug */
		ANT_INFO_FUNC("ANT Set fw assert......\n");
		/* bRet = mtk_wcn_wmt_assert(WMTDRV_TYPE_ANT, arg); temp mark */
		if (bRet == MTK_WCN_BOOL_TRUE) {
			ANT_INFO_FUNC("ANT Set fw assert OK\n");
			retval = 0;
		} else {
			ANT_INFO_FUNC("ANT Set fw assert Failed\n");
			retval = (-1000);
		}
		break;
	case COMBO_IOCTL_ANT_IC_HW_VER:
		ANT_DBG_FUNC("get hw version setup 1\n");
		hw_version = mtk_wcn_wmt_ic_info_get(WMTCHIN_HWVER);
		if (copy_to_user((int __user *)arg, &hw_version, sizeof(hw_version)))
			retval = -EFAULT;
		break;
	case COMBO_IOCTL_ANT_IC_FW_VER:
		ANT_DBG_FUNC("get fw version setup 2\n");
		fw_version = mtk_wcn_wmt_ic_info_get(WMTCHIN_FWVER);
		if (copy_to_user((int __user *)arg, &fw_version, sizeof(fw_version)))
			retval = -EFAULT;
		break;
	case COMBO_IOCTAL_ANT_DOWNLOAD_FIRMWARE:
		return ANT_Power(arg);
	default:
		retval = -EFAULT;
		ANT_DBG_FUNC("ANT_ioctl(): unknown cmd (%d)\n", cmd);
		break;
	}

	return retval;
}

long ANT_compat_ioctl(struct file *filp, unsigned int cmd, unsigned long arg)
{
	long ret;

	pr_warn("%s: cmd (%d)\n", __func__, cmd);
	ret = ANT_unlocked_ioctl(filp, cmd, arg);
	pr_warn("%s: cmd (%d)\n", __func__, cmd);
	return ret;
}

static INT32 ANT_DownLoad_RAM_Code(unsigned long ver)
{
	struct file *pPatchExtFile = NULL;
	UINT8 pbPatchExtBin[read_ram_code_length];
	INT32 lFileLen = 0;
	INT32 download_status = 0;
	UINT32 transport_length = 0;
	INT32 download_number = 0;
	INT32 i = 0;
	mm_segment_t old_fs = get_fs();

	set_fs(KERNEL_DS);

	switch (ver) {
	case 1:
		ANT_BUILT_IN_PATCH_FILE_NAME = ANT_BUILT_IN_PATCH_FILE_NAME_E1;
		ANT_INFO_FUNC("download E1 patch\n");
		break;
	case 2:
		ANT_BUILT_IN_PATCH_FILE_NAME = ANT_BUILT_IN_PATCH_FILE_NAME_E2;
		ANT_INFO_FUNC("download E2 patch\n");
		break;
	default:
		ANT_INFO_FUNC("Can not support RAM code version:%ld!\n", ver);
		return 0;
	}
	pPatchExtFile = filp_open(ANT_BUILT_IN_PATCH_FILE_NAME, O_RDONLY, 0644);


	if ((IS_ERR(pPatchExtFile))) {
		ANT_ERR_FUNC("failed to open  %s\r\n", ANT_BUILT_IN_PATCH_FILE_NAME);
		filp_close(pPatchExtFile, NULL);
		set_fs(old_fs);
		return 0;
	}

	ANT_INFO_FUNC("Open %s\r\n", ANT_BUILT_IN_PATCH_FILE_NAME);
	/* Set the file at end */
	lFileLen = pPatchExtFile->f_op->llseek(pPatchExtFile, 0, SEEK_END);

	/*
	   if(pPatchExtFile->f_op->llseek(pPatchExtFile, 0, SEEK_END) != 0){
	   ANT_ERR_FUNC("llseek ant rom code file fails errno: %d\n");
	   return 0;
	   }
	   lFileLen = ftell(pPatchExtFile);
	 */
	if (lFileLen < 0) {
		ANT_ERR_FUNC("Patch ext error len %d\n", lFileLen);
		filp_close(pPatchExtFile, NULL);
		return 0;
	}
	ANT_DBG_FUNC("Patch ext file size %d\n", lFileLen);
	/* rewind(pPatchExtFile); */
	pPatchExtFile->f_op->llseek(pPatchExtFile, 0, SEEK_SET);
	/* loop number */
	download_number = lFileLen / read_ram_code_length;
	ANT_DBG_FUNC("The send file loop number is %d\n", download_number);

	/* read down load ram code and down load it to controller side */
	i = 0;

	/* for(int i = 0 ; i <= download_number ; i ++ ){ */
	while ((i <= download_number)) {
		if (i < download_number) {
			ANT_DBG_FUNC("The ram code file location is %llx\n",
				      pPatchExtFile->f_pos);
			if ((pPatchExtFile->f_op->
			     read(pPatchExtFile, pbPatchExtBin,
				  read_ram_code_length,
				  &pPatchExtFile->f_pos)) < 0) {
					ANT_ERR_FUNC
					    ("fread ant rom code file fails errno\n");
					filp_close(pPatchExtFile, NULL);
					return 0;
				}
				ANT_DBG_FUNC("The %d second read file\n", i);
		} else {
			ANT_DBG_FUNC("The ram code file location is %llx\n",
				      pPatchExtFile->f_pos);
			if ((pPatchExtFile->f_op->
			     read(pPatchExtFile, pbPatchExtBin,
				  (lFileLen - (i * read_ram_code_length)),
				  &pPatchExtFile->f_pos)) < 0) {
				ANT_ERR_FUNC("fread ant rom code file fails errno\n");
				filp_close(pPatchExtFile, NULL);
				return 0;
			}
			ANT_DBG_FUNC("The last read file\n");
		}
		/* set lengnth and status */
		if (0 == i) {
			download_status = WMT_ANT_RAM_START_PKT;
				transport_length = read_ram_code_length;
		} else if ((i != download_number) && (0 != i)) {
			download_status = WMT_ANT_RAM_CONTINUE_PKT;
			transport_length = read_ram_code_length;
		} else {
			download_status = WMT_ANT_RAM_END_PKT;
			transport_length = lFileLen - (i * read_ram_code_length);
		}
		if (WMT_ANT_RAM_DOWN_FAIL ==
		    mtk_wcn_wmt_ant_ram_ctrl(WMT_ANT_RAM_DOWNLOAD, (PUINT8)(&pbPatchExtBin),
					     transport_length, download_status)) {
			ANT_ERR_FUNC("Download ant rom code file fails\n");
			filp_close(pPatchExtFile, NULL);
			return 0;
		}
			i++;
	}
		/*
		   pbPatchExtBin = (unsigned char*)malloc(lFileLen);
		   if(pbPatchExtBin){
		   size_t szReadLen = fread(pbPatchExtBin, 1, lFileLen, pPatchExtFile);
		   dwPatchExtLen = szReadLen;
		   }
		 */
	filp_close(pPatchExtFile, NULL);
	set_fs(old_fs);
	return 1;
}

static int ANT_Power(unsigned long ver)
{
	INT32 status = mtk_wcn_wmt_ant_ram_ctrl(WMT_ANT_RAM_GET_STATUS, 0, 0, 0);

	if (WMT_ANT_RAM_NOT_EXIST == status) {
		if (1 == ANT_DownLoad_RAM_Code(ver)) {
			ANT_INFO_FUNC("ANT Download RAM code is Successful\n");
			return 0;
		}
		ANT_INFO_FUNC("ANT Download RAM code is Fail\n");
		return -1;
	}

	if (WMT_ANT_RAM_EXIST == status)
		ANT_INFO_FUNC("ANT Fimeware side Ramcode is ready");
	return 0;
}

static int ANT_open(struct inode *inode, struct file *file)
{
	ANT_INFO_FUNC("%s: major %d minor %d (pid %d)\n", __func__,
		      imajor(inode), iminor(inode), current->pid);
	if (current->pid == 1)
		return 0;
#if 1				/* GeorgeKuo: turn on function before check stp ready */
	/* turn on BT */
	if (MTK_WCN_BOOL_FALSE == mtk_wcn_wmt_func_on(WMTDRV_TYPE_ANT)) {
		ANT_WARN_FUNC("WMT turn on ANT fail!\n");
		return -ENODEV;
	}
	retflag = 0;
	mtk_wcn_wmt_msgcb_reg(WMTDRV_TYPE_ANT, ant_cdev_rst_cb);
	ANT_INFO_FUNC("WMT register ANT rst cb!\n");
#endif

	if (mtk_wcn_stp_is_ready()) {
#if 0				/* GeorgeKuo: turn on function before check stp ready */
		/* turn on BT */
		if (MTK_WCN_BOOL_FALSE == mtk_wcn_wmt_func_on(WMTDRV_TYPE_ANT)) {
			ANT_WARN_FUNC("WMT turn on ANT fail!\n");
			return -ENODEV;
		}
#endif
		mtk_wcn_stp_set_bluez(0);

		ANT_DBG_FUNC("Now it's in MTK ANT Mode\n");
		ANT_DBG_FUNC("WMT turn on ANT OK!\n");
		ANT_DBG_FUNC("STP is ready!\n");

#if 0
		platform_load_nvram_data(BT_NVRAM_CUSTOM_NAME,
					 (char *)&g_nvram_btdata, sizeof(g_nvram_btdata));

		ANT_INFO_FUNC
		    ("Read NVRAM : BD address %02x%02x%02x%02x%02x%02x Cap 0x%02x Codec 0x%02x\n",
		     g_nvram_btdata[0], g_nvram_btdata[1], g_nvram_btdata[2], g_nvram_btdata[3],
		     g_nvram_btdata[4], g_nvram_btdata[5], g_nvram_btdata[6], g_nvram_btdata[7]);
#endif

		mtk_wcn_stp_register_event_cb(ANT_TASK_INDX, ANT_event_cb);
		ANT_DBG_FUNC("mtk_wcn_stp_register_event_cb finish\n");


/* #if 0 */
		/* Query the RAM Code Status and download it */
/* ANT_Power(); */

/* #endif */
	} else {
		ANT_ERR_FUNC("STP is not ready\n");

		/*return error code */
		return -ENODEV;
	}

/* init_MUTEX(&wr_mtx); */
	sema_init(&wr_mtx, 1);
/* init_MUTEX(&rd_mtx); */
	sema_init(&rd_mtx, 1);
	ANT_INFO_FUNC("finish\n");

	return 0;
}

static int ANT_close(struct inode *inode, struct file *file)
{
	ANT_INFO_FUNC("%s: major %d minor %d (pid %d)\n", __func__,
		      imajor(inode), iminor(inode), current->pid);
	if (current->pid == 1)
		return 0;
	retflag = 0;
	mtk_wcn_wmt_msgcb_unreg(WMTDRV_TYPE_ANT);
	mtk_wcn_stp_register_event_cb(ANT_TASK_INDX, NULL);

	if (MTK_WCN_BOOL_FALSE == mtk_wcn_wmt_func_off(WMTDRV_TYPE_ANT)) {
		ANT_INFO_FUNC("WMT turn off ANT fail!\n");
		return -EIO;	/* mostly, native programmer will not check this return value. */
	}
	ANT_INFO_FUNC("WMT turn off ANT OK!\n");

	return 0;
}

const struct file_operations ANT_fops = {
	.open = ANT_open,
	.release = ANT_close,
	.read = ANT_read,
	.write = ANT_write,
	.unlocked_ioctl = ANT_unlocked_ioctl,
	.compat_ioctl = ANT_compat_ioctl,
	.poll = ANT_poll
};

#if REMOVE_MK_NODE
struct class *stpant_class = NULL;
#endif

static int ANT_init(void)
{
	dev_t dev = MKDEV(ANT_major, 0);
	INT32 alloc_ret = 0;
	INT32 cdev_err = 0;
#if REMOVE_MK_NODE
	struct device *stpant_dev = NULL;
#endif

	/*static allocate chrdev */
	alloc_ret = register_chrdev_region(dev, 1, ANT_DRIVER_NAME);
	if (alloc_ret) {
		ANT_ERR_FUNC("fail to register chrdev\n");
		return alloc_ret;
	}

	cdev_init(&ANT_cdev, &ANT_fops);
	ANT_cdev.owner = THIS_MODULE;

	cdev_err = cdev_add(&ANT_cdev, dev, ANT_devs);
	if (cdev_err)
		goto error;
#if REMOVE_MK_NODE		/* mknod replace */

	stpant_class = class_create(THIS_MODULE, "stpant");
	if (IS_ERR(stpant_class))
		goto error;
	stpant_dev = device_create(stpant_class, NULL, dev, NULL, "stpant");
	if (IS_ERR(stpant_dev))
		goto error;
#endif

	ANT_INFO_FUNC("%s driver(major %d) installed.\n", ANT_DRIVER_NAME, ANT_major);
	retflag = 0;
	mtk_wcn_stp_register_event_cb(ANT_TASK_INDX, NULL);

	/* init wait queue */
	init_waitqueue_head(&(inq));

	return 0;

 error:
#if REMOVE_MK_NODE
	if (!IS_ERR(stpant_dev))
		device_destroy(stpant_class, dev);
	if (!IS_ERR(stpant_class)) {
		class_destroy(stpant_class);
		stpant_class = NULL;
	}
#endif

	if (cdev_err == 0)
		cdev_del(&ANT_cdev);

	if (alloc_ret == 0)
		unregister_chrdev_region(dev, ANT_devs);

	return -1;
}

static void ANT_exit(void)
{
	dev_t dev = MKDEV(ANT_major, 0);

	retflag = 0;

	mtk_wcn_stp_register_event_cb(ANT_TASK_INDX, NULL);	/* unregister event callback function */
#if REMOVE_MK_NODE
	device_destroy(stpant_class, dev);
	class_destroy(stpant_class);
	stpant_class = NULL;
#endif

	cdev_del(&ANT_cdev);
	unregister_chrdev_region(dev, ANT_devs);

	ANT_INFO_FUNC("%s driver removed.\n", ANT_DRIVER_NAME);
}

#ifdef MTK_WCN_REMOVE_KERNEL_MODULE

int mtk_wcn_stpant_drv_init(VOID)
{
	return ANT_init();
}
EXPORT_SYMBOL(mtk_wcn_stpant_drv_init);

void mtk_wcn_stpant_drv_exit(VOID)
{
	return ANT_exit();
}
EXPORT_SYMBOL(mtk_wcn_stpant_drv_exit);

#else

module_init(ANT_init);
module_exit(ANT_exit);

#endif