//int GPS_ioctl(struct inode *inode, struct file *filp, unsigned int cmd, unsigned long arg)
long GPS_unlocked_ioctl(struct file *filp, unsigned int cmd, unsigned long arg)
{
int retval = 0;
ENUM_WMTHWVER_TYPE_T hw_ver_sym = WMTHWVER_INVALID;
GPS_DBG_FUNC("cmd (0x%x)\n", cmd);
switch (cmd)
{
case COMBO_IOC_GPS_HWVER:
/*get combo hw version*/
hw_ver_sym = mtk_wcn_wmt_hwver_get();
GPS_INFO_FUNC("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;
default:
retval = -EFAULT;
GPS_DBG_FUNC(KERN_INFO "GPS_ioctl(): unknown cmd (0x%x)\n", cmd);
break;
}
return retval;
}
static VOID gps_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;
GPS_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);
GPS_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_GPS)
&& (type == WMTMSG_TYPE_RESET)) {
if (rst_msg == WMTRSTMSG_RESET_START) {
GPS_DBG_FUNC("gps restart start!\n");
/*reset_start message handling */
} else if ((rst_msg == WMTRSTMSG_RESET_END) || (rst_msg == WMTRSTMSG_RESET_END_FAIL)) {
GPS_DBG_FUNC("gps restart end!\n");
/*reset_end message handling */
}
}
} else {
/*message format invalid */
}
}
static int GPS_open(struct inode *inode, struct file *file)
{
pr_debug("%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_GPS)) {
GPS_WARN_FUNC("WMT turn on GPS fail!\n");
return -ENODEV;
} else {
mtk_wcn_wmt_msgcb_reg(WMTDRV_TYPE_GPS, gps_cdev_rst_cb);
GPS_DBG_FUNC("WMT turn on GPS OK!\n");
}
#endif
if (mtk_wcn_stp_is_ready()) {
#if 0
if (MTK_WCN_BOOL_FALSE == mtk_wcn_wmt_func_on(WMTDRV_TYPE_GPS)) {
GPS_WARN_FUNC("WMT turn on GPS fail!\n");
return -ENODEV;
}
GPS_DBG_FUNC("WMT turn on GPS OK!\n");
#endif
mtk_wcn_stp_register_event_cb(GPS_TASK_INDX, GPS_event_cb);
} else {
GPS_ERR_FUNC("STP is not ready, Cannot open GPS Devices\n\r");
/*return error code */
return -ENODEV;
}
/* init_MUTEX(&wr_mtx); */
sema_init(&wr_mtx, 1);
/* init_MUTEX(&rd_mtx); */
sema_init(&rd_mtx, 1);
return 0;
}
static int GPS_close(struct inode *inode, struct file *file)
{
pr_debug("%s: major %d minor %d (pid %d)\n", __func__, imajor(inode), iminor(inode), current->pid);
if (current->pid == 1)
return 0;
/*Flush Rx Queue */
mtk_wcn_stp_register_event_cb(GPS_TASK_INDX, 0x0); /* unregister event callback function */
mtk_wcn_wmt_msgcb_unreg(WMTDRV_TYPE_GPS);
if (MTK_WCN_BOOL_FALSE == mtk_wcn_wmt_func_off(WMTDRV_TYPE_GPS)) {
GPS_WARN_FUNC("WMT turn off GPS fail!\n");
return -EIO; /* mostly, native programer does not care this return vlaue, but we still return error code. */
} else {
GPS_DBG_FUNC("WMT turn off GPS OK!\n");
}
return 0;
}
/* int GPS_ioctl(struct inode *inode, struct file *filp, unsigned int cmd, unsigned long arg) */
long GPS_unlocked_ioctl(struct file *filp, unsigned int cmd, unsigned long arg)
{
INT32 retval = 0;
ENUM_WMTHWVER_TYPE_T hw_ver_sym = WMTHWVER_INVALID;
UINT32 hw_version = 0;
UINT32 fw_version = 0;
pr_warn("GPS_ioctl(): cmd (%d)\n", cmd);
switch (cmd) {
case 0: /* enable/disable STP */
GPS_DBG_FUNC("GPS_ioctl(): disable STP control from GPS dev\n");
retval = -EINVAL;
#if 1
#else
/* George: STP is controlled by WMT only */
mtk_wcn_stp_enable(arg);
#endif
break;
case 1: /* send raw data */
GPS_DBG_FUNC("GPS_ioctl(): disable raw data from GPS dev\n");
retval = -EINVAL;
break;
case COMBO_IOC_GPS_HWVER:
/*get combo hw version */
hw_ver_sym = mtk_wcn_wmt_hwver_get();
GPS_DBG_FUNC("GPS_ioctl(): get hw version = %d, sizeof(hw_ver_sym) = %zd\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_IOC_GPS_IC_HW_VERSION:
/*get combo hw version from ic, without wmt mapping */
hw_version = mtk_wcn_wmt_ic_info_get(WMTCHIN_HWVER);
GPS_DBG_FUNC("GPS_ioctl(): get hw version = 0x%x\n", hw_version);
if (copy_to_user((int __user *)arg, &hw_version, sizeof(hw_version)))
retval = -EFAULT;
break;
case COMBO_IOC_GPS_IC_FW_VERSION:
/*get combo fw version from ic, without wmt mapping */
fw_version = mtk_wcn_wmt_ic_info_get(WMTCHIN_FWVER);
GPS_DBG_FUNC("GPS_ioctl(): get fw version = 0x%x\n", fw_version);
if (copy_to_user((int __user *)arg, &fw_version, sizeof(fw_version)))
retval = -EFAULT;
break;
default:
retval = -EFAULT;
GPS_DBG_FUNC("GPS_ioctl(): unknown cmd (%d)\n", cmd);
break;
}
/*OUT:*/
return retval;
}
ssize_t GPS_read(struct file *filp, char __user *buf, size_t count, loff_t *f_pos)
{
INT32 val = 0;
INT32 retval;
down(&rd_mtx);
/* pr_warn("GPS_read(): count %d pos %lld\n", count, *f_pos);*/
if (count > MTKSTP_BUFFER_SIZE)
count = MTKSTP_BUFFER_SIZE;
#if GPS_DEBUG_TRACE_GPIO
mtk_wcn_stp_debug_gpio_assert(IDX_GPS_RX, DBG_TIE_LOW);
#endif
retval = mtk_wcn_stp_receive_data(i_buf, count, GPS_TASK_INDX);
#if GPS_DEBUG_TRACE_GPIO
mtk_wcn_stp_debug_gpio_assert(IDX_GPS_RX, DBG_TIE_HIGH);
#endif
while (retval == 0) {
/* got nothing, wait for STP's signal */
/*wait_event(GPS_wq, flag != 0); *//* George: let signal wake up */
val = wait_event_interruptible(GPS_wq, flag != 0);
flag = 0;
#if GPS_DEBUG_TRACE_GPIO
mtk_wcn_stp_debug_gpio_assert(IDX_GPS_RX, DBG_TIE_LOW);
#endif
retval = mtk_wcn_stp_receive_data(i_buf, count, GPS_TASK_INDX);
#if GPS_DEBUG_TRACE_GPIO
mtk_wcn_stp_debug_gpio_assert(IDX_GPS_RX, DBG_TIE_HIGH);
#endif
/* if we are signaled */
if (val) {
if (-ERESTARTSYS == val)
GPS_DBG_FUNC("signaled by -ERESTARTSYS(%d)\n ", val);
else
GPS_DBG_FUNC("signaled by %d\n ", val);
break;
}
}
#if GPS_DEBUG_DUMP
{
PUINT8 buf_ptr = &i_buf[0];
INT32 k = 0;
pr_warn("--[GPS-READ]--");
for (k = 0; k < 10; k++) {
if (k % 16 == 0)
pr_warn("\n");
pr_warn("0x%02x ", i_buf[k]);
}
pr_warn("--\n");
}
#endif
if (retval) {
/* we got something from STP driver */
if (copy_to_user(buf, i_buf, retval)) {
retval = -EFAULT;
goto OUT;
} else {
/* success */
}
} else {
/* we got nothing from STP driver, being signaled */
retval = val;
}
OUT:
up(&rd_mtx);
/* pr_warn("GPS_read(): retval = %d\n", retval);*/
return retval;
}
