/* * drivers/barcelona/gps/gps.c * * Implementation of the GPS driver. * * Copyright (C) 2004,2005 TomTom BV * Authors: * Jeroen Taverne * Dimitry Andric * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License version 2 as * published by the Free Software Foundation. */ /******************************************************************************* * Dependency *******************************************************************************/ #ifdef CONFIG_MTK_GPS_SUPPORT #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include /* #include */ #include #include #include #ifdef pr_fmt #undef pr_fmt #endif #define pr_fmt(fmt) "["KBUILD_MODNAME"]" fmt /****************************************************************************** * Function Configuration ******************************************************************************/ /* #define FAKE_DATA */ #define GPS_SUSPEND_RESUME #define GPS_CONFIGURABLE_RESET_DELAY /****************************************************************************** * Definition ******************************************************************************/ /* device name and major number */ #define GPS_DEVNAME "mt3326-gps" /****************************************************************************** * Debug configuration ******************************************************************************/ #if 0 #define GPS_DBG_FUNC(fmt, arg...) pr_debug(PFX, "%s: " fmt, __func__ , ##arg) #define GPS_ERR(fmt, arg...) pr_err(PFX, "%s: " fmt, __func__ , ##arg) #define GPS_WARN(fmt, arg...) pr_warn(PFX, "%s" fmt, __func__ , ##arg) #define GPS_NOTICE(fmt, arg...) pr_notice(PFX, "%s: " fmt, __func__ , ##arg) #define GPS_INFO(fmt, arg...) pr_info(PFX, "%s: " fmt, __func__ , ##arg) #define PFX "GPS: " #else #define GPS_DBG_NONE(fmt, arg...) do {} while (0) #define GPS_DBG pr_debug #define GPS_TRC GPS_DBG_NONE #define GPS_VER pr_debug #define GPS_ERR pr_err #endif /******************************************************************************* * structure & enumeration *******************************************************************************/ enum { GPS_PWRCTL_UNSUPPORTED = 0xFF, GPS_PWRCTL_OFF = 0x00, GPS_PWRCTL_ON = 0x01, GPS_PWRCTL_RST = 0x02, GPS_PWRCTL_OFF_FORCE = 0x03, GPS_PWRCTL_RST_FORCE = 0x04, GPS_PWRCTL_MAX = 0x05, }; enum { GPS_PWR_UNSUPPORTED = 0xFF, GPS_PWR_RESUME = 0x00, GPS_PWR_SUSPEND = 0x01, GPS_PWR_MAX = 0x02, }; enum { GPS_STATE_UNSUPPORTED = 0xFF, GPS_STATE_OFF = 0x00, /*cleanup/power off, default state */ GPS_STATE_INIT = 0x01, /*init */ GPS_STATE_START = 0x02, /*start navigating */ GPS_STATE_STOP = 0x03, /*stop navigating */ GPS_STATE_DEC_FREQ = 0x04, GPS_STATE_SLEEP = 0x05, GPS_STATE_MAX = 0x06, }; enum { GPS_PWRSAVE_UNSUPPORTED = 0xFF, GPS_PWRSAVE_DEC_FREQ = 0x00, GPS_PWRSAVE_SLEEP = 0x01, GPS_PWRSAVE_OFF = 0x02, GPS_PWRSAVE_MAX = 0x03, }; /*---------------------------------------------------------------------------*/ struct gps_data { int dat_len; int dat_pos; char dat_buf[4096]; spinlock_t lock; wait_queue_head_t read_wait; struct semaphore sem; }; /*---------------------------------------------------------------------------*/ struct gps_sta_itm { /*gps status record */ unsigned char year; /*current year - 1900 */ unsigned char month; /*1~12 */ unsigned char day; /*1~31 */ unsigned char hour; /*0~23 */ unsigned char minute; /*0~59 */ unsigned char sec; /*0~59 */ unsigned char count; /*reborn count */ unsigned char reason; /*reason: 0: timeout; 1: force */ }; /*---------------------------------------------------------------------------*/ struct gps_sta_obj { int index; struct gps_sta_itm items[32]; }; /*---------------------------------------------------------------------------*/ struct gps_drv_obj { unsigned char pwrctl; unsigned char suspend; unsigned char state; unsigned char pwrsave; int rdelay; /*power reset delay */ struct kobject *kobj; struct mutex sem; struct gps_sta_obj status; struct mt3326_gps_hardware *hw; }; /*---------------------------------------------------------------------------*/ struct gps_dev_obj { struct class *cls; struct device *dev; dev_t devno; struct cdev chdev; struct mt3326_gps_hardware *hw; }; /****************************************************************************** * GPS driver ******************************************************************************/ struct mt3326_gps_hardware { int (*ext_power_on)(int); int (*ext_power_off)(int); }; struct mt3326_gps_hardware mt3326_gps_hw = { .ext_power_on = NULL, .ext_power_off = NULL, }; /****************************************************************************** * local variables ******************************************************************************/ static struct gps_data gps_private = { 0 }; #if defined(FAKE_DATA) static char fake_data[] = { "$GPGGA,135036.000,2446.3713,N,12101.3605,E,1,5,1.61,191.1,M,15.1,M,,*51\r\n" "$GPGSA,A,3,22,18,14,30,31,,,,,,,,1.88,1.61,0.98*09\r\n" "$GPGSV,2,1,6,18,83,106,32,22,58,324,35,30,45,157,35,14,28,308,32*44\r\n" "$GPGSV,2,2,6,40,21,254,,31,17,237,29*42\r\n" "$GPRMC,135036.000,A,2446.37125,N,12101.36054,E,0.243,56.48,140109,,A*46\r\n" "$GPVTG,56.48,T,,M,0.243,N,0.451,K,A*07\r\n" }; #endif /* FAKE_DATA */ /*this should be synchronous with mnld.c enum { MNL_RESTART_NONE = 0x00, //recording the 1st of mnld MNL_RESTART_TIMEOUT_INIT = 0x01, //restart due to timeout MNL_RESTART_TIMEOUT_MONITOR = 0x02, //restart due to timeout MNL_RESTART_TIMEOUT_WAKEUP = 0x03, //restart due to timeout MNL_RESTART_TIMEOUT_TTFF = 0x04, //restart due to TTFF timeout MNL_RESTART_FORCE = 0x04, //restart due to external command }; */ /*---------------------------------------------------------------------------*/ static char *str_reason[] = { "none", "init", "monitor", "wakeup", "TTFF", "force", "unknown" }; /****************************************************************************** * Functions ******************************************************************************/ static inline void mt3326_gps_power(struct mt3326_gps_hardware *hw, unsigned int on, unsigned int force) { /*FIX ME: PM_api should provide a function to get current status */ static unsigned int power_on = 1; int err; GPS_DBG("Switching GPS device %s\n", on ? "on" : "off"); if (!hw) { GPS_ERR("null pointer!!\n"); return; } if (power_on == on) { GPS_DBG("ignore power control: %d\n", on); } else if (on) { /*power on */ if (hw->ext_power_on) { err = hw->ext_power_on(0); if (err) GPS_ERR("ext_power_on fail\n"); } #if 0 #ifndef MTK_MT6620 if (!hwPowerOn(MT6516_POWER_V3GTX, VOL_2800, "MT3326")) { GPS_ERR("power on fails!!\n"); return; } #endif #endif if (hw->ext_power_on) { err = hw->ext_power_on(1); if (err) GPS_ERR("ext_power_on fail\n"); } #if 0 if (!hwEnableClock(MT6516_PDN_PERI_UART2, "MT3326")) GPS_ERR("enable clock fail"); #endif mdelay(120); } else { #if 0 if (!hwDisableClock(MT6516_PDN_PERI_UART2, "MT3326")) GPS_ERR("disable clock fail\n"); #endif if (hw->ext_power_off) { err = hw->ext_power_off(force); if (err) GPS_ERR("ext_power_off fail\n"); } } power_on = on; } /*****************************************************************************/ static inline void mt3326_gps_reset(struct mt3326_gps_hardware *hw, int delay, int force) { mt3326_gps_power(hw, 1, 0); mdelay(delay); mt3326_gps_power(hw, 0, force); mdelay(delay); mt3326_gps_power(hw, 1, 0); } /******************************************************************************/ static inline int mt3326_gps_set_suspend(struct gps_drv_obj *obj, unsigned char suspend) { if (!obj) return -1; mutex_lock(&obj->sem); if (obj->suspend != suspend) { /* GPS_DBG("issue sysfs_notify : %p\n", obj->kobj->sd); */ sysfs_notify(obj->kobj, NULL, "suspend"); } obj->suspend = suspend; mutex_unlock(&obj->sem); return 0; } /******************************************************************************/ static inline int mt3326_gps_set_pwrctl(struct gps_drv_obj *obj, unsigned char pwrctl) { int err = 0; if (!obj) return -1; mutex_lock(&obj->sem); if ((pwrctl == GPS_PWRCTL_ON) || (pwrctl == GPS_PWRCTL_OFF)) { obj->pwrctl = pwrctl; mt3326_gps_power(obj->hw, pwrctl, 0); } else if (pwrctl == GPS_PWRCTL_OFF_FORCE) { obj->pwrctl = pwrctl; mt3326_gps_power(obj->hw, pwrctl, 1); } else if (pwrctl == GPS_PWRCTL_RST) { mt3326_gps_reset(obj->hw, obj->rdelay, 0); obj->pwrctl = GPS_PWRCTL_ON; } else if (pwrctl == GPS_PWRCTL_RST_FORCE) { mt3326_gps_reset(obj->hw, obj->rdelay, 1); obj->pwrctl = GPS_PWRCTL_ON; } else { err = -1; } mutex_unlock(&obj->sem); return err; } /******************************************************************************/ static inline int mt3326_gps_set_status(struct gps_drv_obj *obj, const char *buf, size_t count) { int err = 0; int year, mon, day, hour, minute, sec, cnt, reason, idx; if (!obj) return -1; mutex_lock(&obj->sem); if (sscanf(buf, "(%d/%d/%d %d:%d:%d) - %d/%d", &year, &mon, &day, &hour, &minute, &sec, &cnt, &reason) == 8) { int number = (int)(sizeof(obj->status.items) / sizeof(obj->status.items[0])); idx = obj->status.index % number; obj->status.items[idx].year = (unsigned char)year; obj->status.items[idx].month = (unsigned char)mon; obj->status.items[idx].day = (unsigned char)day; obj->status.items[idx].hour = (unsigned char)hour; obj->status.items[idx].minute = (unsigned char)minute; obj->status.items[idx].sec = (unsigned char)sec; obj->status.items[idx].count = (unsigned char)cnt; obj->status.items[idx].reason = (unsigned char)reason; obj->status.index++; } else { err = -1; } mutex_unlock(&obj->sem); return err; } /******************************************************************************/ static inline int mt3326_gps_set_state(struct gps_drv_obj *obj, unsigned char state) { int err = 0; if (!obj) return -1; mutex_lock(&obj->sem); if (state < GPS_STATE_MAX) obj->state = state; else err = -1; mutex_unlock(&obj->sem); return err; } /******************************************************************************/ static inline int mt3326_gps_set_pwrsave(struct gps_drv_obj *obj, unsigned char pwrsave) { int err = 0; if (!obj) return -1; mutex_lock(&obj->sem); if (pwrsave < GPS_PWRSAVE_MAX) obj->pwrsave = pwrsave; else err = -1; mutex_unlock(&obj->sem); return err; } /******************************************************************************/ static inline int mt3326_gps_dev_suspend(struct gps_drv_obj *obj) { #if defined(GPS_SUSPEND_RESUME) int err; err = mt3326_gps_set_suspend(obj, GPS_PWR_SUSPEND); if (err) GPS_DBG("set suspend fail: %d\n", err); err = mt3326_gps_set_pwrctl(obj, GPS_PWRCTL_OFF); if (err) GPS_DBG("set pwrctl fail: %d\n", err); return err; #endif } /******************************************************************************/ static inline int mt3326_gps_dev_resume(struct gps_drv_obj *obj) { #if defined(GPS_SUSPEND_RESUME) int err; err = mt3326_gps_set_suspend(obj, GPS_PWR_RESUME); if (err) GPS_DBG("set suspend fail: %d\n", err); /*don't power on device automatically */ return err; #endif } /******************************************************************************/ static ssize_t mt3326_show_pwrctl(struct device *dev, struct device_attribute *attr, char *buf) { struct gps_drv_obj *obj; ssize_t res; if (!dev) { GPS_DBG("dev is null!!\n"); return 0; } obj = (struct gps_drv_obj *)dev_get_drvdata(dev); if (!obj) { GPS_DBG("drv data is null!!\n"); return 0; } mutex_lock(&obj->sem); res = snprintf(buf, PAGE_SIZE, "%d\n", obj->pwrctl); mutex_unlock(&obj->sem); return res; } /******************************************************************************/ static ssize_t mt3326_store_pwrctl(struct device *dev, struct device_attribute *attr, const char *buf, size_t count) { struct gps_drv_obj *obj; if (!dev) { GPS_DBG("dev is null!!\n"); return 0; } obj = (struct gps_drv_obj *)dev_get_drvdata(dev); if (!obj) { GPS_DBG("drv data is null!!\n"); return 0; } if ((count == 1) || ((count == 2) && (buf[1] == '\n'))) { unsigned char pwrctl = buf[0] - '0'; if (!mt3326_gps_set_pwrctl(obj, pwrctl)) return count; } /* GPS_DBG("invalid content: '%s', length = %ld\n", buf, count); */ return count; } /******************************************************************************/ static ssize_t mt3326_show_suspend(struct device *dev, struct device_attribute *attr, char *buf) { struct gps_drv_obj *obj; ssize_t res; if (!dev) { GPS_DBG("dev is null!!\n"); return 0; } obj = (struct gps_drv_obj *)dev_get_drvdata(dev); if (!obj) { GPS_DBG("drv data is null!!\n"); return 0; } mutex_lock(&obj->sem); res = snprintf(buf, PAGE_SIZE, "%d\n", obj->suspend); mutex_unlock(&obj->sem); return res; } /******************************************************************************/ static ssize_t mt3326_store_suspend(struct device *dev, struct device_attribute *attr, const char *buf, size_t count) { struct gps_drv_obj *obj; if (!dev) { GPS_DBG("dev is null!!\n"); return 0; } obj = (struct gps_drv_obj *)dev_get_drvdata(dev); if (!obj) { GPS_DBG("drv data is null!!\n"); return 0; } if ((count == 1) || ((count == 2) && (buf[1] == '\n'))) { unsigned char suspend = buf[0] - '0'; if (suspend == GPS_PWR_SUSPEND) { if (!mt3326_gps_dev_suspend(obj)) return count; } else if (suspend == GPS_PWR_RESUME) { if (!mt3326_gps_dev_resume(obj)) return count; } } /* GPS_DBG("invalid content: '%s', length = %d\n", buf, count); */ return count; } /******************************************************************************/ static ssize_t mt3326_show_status(struct device *dev, struct device_attribute *attr, char *buf) { int res, idx, num, left, cnt, len; struct gps_drv_obj *obj; char *reason = NULL; int reason_max = (int)(sizeof(str_reason) / sizeof(str_reason[0])); if (!dev) { GPS_DBG("dev is null!!\n"); return 0; } obj = (struct gps_drv_obj *)dev_get_drvdata(dev); if (!obj) { GPS_DBG("drv data is null!!\n"); return 0; } mutex_lock(&obj->sem); num = (int)(sizeof(obj->status.items) / sizeof(obj->status.items[0])); left = PAGE_SIZE; cnt = 0; len = 0; for (idx = 0; idx < num; idx++) { if (obj->status.items[idx].month == 0) continue; if (obj->status.items[idx].reason >= reason_max) reason = str_reason[reason_max - 1]; else reason = str_reason[obj->status.items[idx].reason]; cnt = snprintf(buf + len, left, "[%d] %.4d/%.2d/%.2d %.2d:%.2d:%.2d - %d, %s\n", idx, obj->status.items[idx].year + 1900, obj->status.items[idx].month, obj->status.items[idx].day, obj->status.items[idx].hour, obj->status.items[idx].minute, obj->status.items[idx].sec, obj->status.items[idx].count, reason); left -= cnt; len += cnt; } res = PAGE_SIZE - left; mutex_unlock(&obj->sem); return res; } /******************************************************************************/ static ssize_t mt3326_store_status(struct device *dev, struct device_attribute *attr, const char *buf, size_t count) { int res = 0; struct gps_drv_obj *obj; if (!dev) { GPS_DBG("dev is null!!\n"); return 0; } obj = (struct gps_drv_obj *)dev_get_drvdata(dev); if (!obj) { GPS_DBG("drv data is null!!\n"); return 0; } res = mt3326_gps_set_status(obj, buf, count); if (!res) return count; GPS_DBG("invalid content: '%p', length = %zu\n", buf, count); return count; } /******************************************************************************/ static ssize_t mt3326_show_state(struct device *dev, struct device_attribute *attr, char *buf) { ssize_t res; struct gps_drv_obj *obj; if (!dev) { GPS_DBG("dev is null!!\n"); return 0; } obj = (struct gps_drv_obj *)dev_get_drvdata(dev); if (!obj) { GPS_DBG("drv data is null!!\n"); return 0; } mutex_lock(&obj->sem); res = snprintf(buf, PAGE_SIZE, "%d\n", obj->state); mutex_unlock(&obj->sem); return res; } /******************************************************************************/ static ssize_t mt3326_store_state(struct device *dev, struct device_attribute *attr, const char *buf, size_t count) { struct gps_drv_obj *obj; if (!dev) { GPS_DBG("dev is null!!\n"); return 0; } obj = (struct gps_drv_obj *)dev_get_drvdata(dev); if (!obj) { GPS_DBG("drv data is null!!\n"); return 0; } if ((count == 1) || ((count == 2) && (buf[1] == '\n'))) { /*To Do: dynamic change according to input */ unsigned char state = buf[0] - '0'; if (!mt3326_gps_set_state(obj, state)) return count; } GPS_DBG("invalid content: '%p', length = %zu\n", buf, count); return count; } /******************************************************************************/ static ssize_t mt3326_show_pwrsave(struct device *dev, struct device_attribute *attr, char *buf) { ssize_t res; struct gps_drv_obj *obj; if (!dev) { GPS_DBG("dev is null!!\n"); return 0; } obj = (struct gps_drv_obj *)dev_get_drvdata(dev); if (!obj) { GPS_DBG("drv data is null!!\n"); return 0; } mutex_lock(&obj->sem); res = snprintf(buf, PAGE_SIZE, "%d\n", obj->pwrsave); mutex_unlock(&obj->sem); return res; } /******************************************************************************/ static ssize_t mt3326_store_pwrsave(struct device *dev, struct device_attribute *attr, const char *buf, size_t count) { struct gps_drv_obj *obj; if (!dev) { GPS_DBG("dev is null!!\n"); return 0; } obj = (struct gps_drv_obj *)dev_get_drvdata(dev); if (!obj) { GPS_DBG("drv data is null!!\n"); return 0; } if ((count == 1) || ((count == 2) && (buf[1] == '\n'))) { unsigned char pwrsave = buf[0] - '0'; if (!mt3326_gps_set_pwrsave(obj, pwrsave)) return count; } GPS_DBG("invalid content: '%p', length = %zu\n", buf, count); return count; } /******************************************************************************/ #if defined(GPS_CONFIGURABLE_RESET_DELAY) /******************************************************************************/ static ssize_t mt3326_show_rdelay(struct device *dev, struct device_attribute *attr, char *buf) { ssize_t res; struct gps_drv_obj *obj; if (!dev) { GPS_DBG("dev is null!!\n"); return 0; } obj = (struct gps_drv_obj *)dev_get_drvdata(dev); if (!obj) { GPS_DBG("drv data is null!!\n"); return 0; } mutex_lock(&obj->sem); res = snprintf(buf, PAGE_SIZE, "%d\n", obj->rdelay); mutex_unlock(&obj->sem); return res; } /******************************************************************************/ static ssize_t mt3326_store_rdelay(struct device *dev, struct device_attribute *attr, const char *buf, size_t count) { struct gps_drv_obj *obj; int rdelay; unsigned long val; if (!dev) { GPS_DBG("dev is null!!\n"); return 0; } obj = (struct gps_drv_obj *)dev_get_drvdata(dev); if (!obj) { GPS_DBG("drv data is null!!\n"); return 0; } rdelay = (int)kstrtol(buf, 10, &val); if (rdelay < 2000) { mutex_lock(&obj->sem); obj->rdelay = rdelay; mutex_unlock(&obj->sem); return count; } GPS_DBG("invalid content: '%p', length = %zu\n", buf, count); return count; } /******************************************************************************/ #endif /******************************************************************************/ DEVICE_ATTR(pwrctl, S_IWUSR | S_IWGRP | S_IRUGO, mt3326_show_pwrctl, mt3326_store_pwrctl); DEVICE_ATTR(suspend, S_IWUSR | S_IWGRP | S_IRUGO, mt3326_show_suspend, mt3326_store_suspend); DEVICE_ATTR(status, S_IWUSR | S_IWGRP | S_IRUGO, mt3326_show_status, mt3326_store_status); DEVICE_ATTR(state, S_IWUSR | S_IWGRP | S_IRUGO, mt3326_show_state, mt3326_store_state); DEVICE_ATTR(pwrsave, S_IWUSR | S_IWGRP | S_IRUGO, mt3326_show_pwrsave, mt3326_store_pwrsave); #if defined(GPS_CONFIGURABLE_RESET_DELAY) DEVICE_ATTR(rdelay, S_IWUSR | S_IWGRP | S_IRUGO, mt3326_show_rdelay, mt3326_store_rdelay); #endif static struct device_attribute *gps_attr_list[] = { &dev_attr_pwrctl, &dev_attr_suspend, &dev_attr_status, &dev_attr_state, &dev_attr_pwrsave, #if defined(GPS_CONFIGURABLE_RESET_DELAY) &dev_attr_rdelay, #endif }; /******************************************************************************/ static int mt3326_gps_create_attr(struct device *dev) { int idx, err = 0; int num = (int)(sizeof(gps_attr_list) / sizeof(gps_attr_list[0])); if (!dev) return -EINVAL; GPS_TRC(); for (idx = 0; idx < num; idx++) { err = device_create_file(dev, gps_attr_list[idx]); if (err) { GPS_DBG("device_create_file (%s) = %d\n", gps_attr_list[idx]->attr.name, err); break; } } return err; } /******************************************************************************/ static int mt3326_gps_delete_attr(struct device *dev) { int idx, err = 0; int num = (int)(sizeof(gps_attr_list) / sizeof(gps_attr_list[0])); if (!dev) return -EINVAL; for (idx = 0; idx < num; idx++) device_remove_file(dev, gps_attr_list[idx]); return err; } /******************************************************************************/ long mt3326_gps_unlocked_ioctl(struct file *file, unsigned int cmd, unsigned long arg) { GPS_DBG("mt3326_gps_unlocked_ioctl!!\n"); return -ENOIOCTLCMD; } /******************************************************************************/ long mt3326_gps_compat_ioctl(struct file *file, unsigned int cmd, unsigned long arg) { long ret; GPS_DBG("mt3326_gps_compat_ioctl!!\n"); ret = mt3326_gps_unlocked_ioctl(file, cmd, arg); return ret; } /*****************************************************************************/ static int mt3326_gps_open(struct inode *inode, struct file *file) { GPS_TRC(); file->private_data = &gps_private; /* all files share the same buffer */ return nonseekable_open(inode, file); } /*****************************************************************************/ static int mt3326_gps_release(struct inode *inode, struct file *file) { struct gps_data *dev = file->private_data; GPS_TRC(); if (dev) file->private_data = NULL; return 0; } /******************************************************************************/ static ssize_t mt3326_gps_read(struct file *file, char __user *buf, size_t count, loff_t *ppos) { struct gps_data *dev = file->private_data; ssize_t ret = 0; int copy_len = 0; GPS_TRC(); if (!dev) return -EINVAL; if (signal_pending(current)) return -ERESTARTSYS; if (down_interruptible(&dev->sem)) return -ERESTARTSYS; if (dev->dat_len == 0) { /*no data to be read */ up(&dev->sem); if (file->f_flags & O_NONBLOCK) /*non-block mode */ return -EAGAIN; do { /*block mode */ ret = wait_event_interruptible(dev->read_wait, (dev->dat_len > 0)); if (ret == -ERESTARTSYS) return -ERESTARTSYS; } while (ret == 0); if (down_interruptible(&dev->sem)) return -ERESTARTSYS; } /*data is available */ copy_len = (dev->dat_len < (int)count) ? (dev->dat_len) : (int)(count); if (copy_to_user(buf, (dev->dat_buf + dev->dat_pos), (unsigned long)copy_len)) { ret = -EFAULT; } else { /* GPS_VER("mt3326_gps_read(%ld,%d,%d) = %d\n", count, dev->dat_pos, dev->dat_len, */ /* copy_len); */ if (dev->dat_len > (copy_len + dev->dat_pos)) { dev->dat_pos += copy_len; } else { dev->dat_len = 0; dev->dat_pos = 0; } ret = copy_len; } up(&dev->sem); /* GPS_VER("%s return %ld bytes\n", __func__, ret); */ return ret; } /******************************************************************************/ static ssize_t mt3326_gps_write(struct file *file, const char __user *buf, size_t count, loff_t *ppos) { struct gps_data *dev = file->private_data; ssize_t ret = 0; int copy_size = 0; GPS_TRC(); if (!dev) return -EINVAL; if (!count) /*no data written */ return 0; if (signal_pending(current)) return -ERESTARTSYS; if (down_interruptible(&dev->sem)) return -ERESTARTSYS; copy_size = (count < 4096) ? count : 4096; if (copy_from_user(dev->dat_buf, buf, copy_size)) { GPS_DBG("copy_from_user error"); ret = -EFAULT; } else { dev->dat_len = count; dev->dat_pos = 0; ret = count; } up(&dev->sem); wake_up_interruptible(&dev->read_wait); GPS_VER("%s: write %d bytes\n", __func__, dev->dat_len); return ret; } /******************************************************************************/ static unsigned int mt3326_gps_poll(struct file *file, poll_table *wait) { struct gps_data *dev = file->private_data; unsigned int mask = 0; GPS_TRC(); if (!dev) return 0; down(&dev->sem); poll_wait(file, &dev->read_wait, wait); if (dev->dat_len != 0) /*readable if data is available */ mask = (POLLIN | POLLRDNORM) | (POLLOUT | POLLWRNORM); else /*always writable */ mask = (POLLOUT | POLLWRNORM); up(&dev->sem); GPS_VER("%s: mask : 0x%X\n", __func__, mask); return mask; } /*****************************************************************************/ /* Kernel interface */ static const struct file_operations mt3326_gps_fops = { .owner = THIS_MODULE, .unlocked_ioctl = mt3326_gps_unlocked_ioctl, .compat_ioctl = mt3326_gps_compat_ioctl, .open = mt3326_gps_open, .read = mt3326_gps_read, .write = mt3326_gps_write, .release = mt3326_gps_release, .poll = mt3326_gps_poll, }; /*****************************************************************************/ static void mt3326_gps_hw_init(struct mt3326_gps_hardware *hw) { mt3326_gps_power(hw, 1, 0); } /*****************************************************************************/ static void mt3326_gps_hw_exit(struct mt3326_gps_hardware *hw) { mt3326_gps_power(hw, 0, 0); } /*****************************************************************************/ static int mt3326_gps_probe(struct platform_device *dev) { int ret = 0, err = 0; struct gps_drv_obj *drvobj = NULL; /* struct mt3326_gps_hardware *hw = (struct mt3326_gps_hardware *)dev->dev.platform_data; */ struct mt3326_gps_hardware *hw = &mt3326_gps_hw; struct gps_dev_obj *devobj = NULL; devobj = kzalloc(sizeof(*devobj), GFP_KERNEL); if (!devobj) { GPS_ERR("-ENOMEM\n"); err = -ENOMEM; return -1; } mt3326_gps_hw_init(hw); GPS_DBG("Registering chardev\n"); ret = alloc_chrdev_region(&devobj->devno, 0, 1, GPS_DEVNAME); if (ret) { GPS_ERR("alloc_chrdev_region fail: %d\n", ret); goto error; } else { GPS_DBG("major: %d, minor: %d\n", MAJOR(devobj->devno), MINOR(devobj->devno)); } cdev_init(&devobj->chdev, &mt3326_gps_fops); devobj->chdev.owner = THIS_MODULE; err = cdev_add(&devobj->chdev, devobj->devno, 1); if (err) { GPS_ERR("cdev_add fail: %d\n", err); goto error; } drvobj = kmalloc(sizeof(*drvobj), GFP_KERNEL); if (!drvobj) { err = -ENOMEM; goto error; } memset(drvobj, 0, sizeof(*drvobj)); devobj->cls = class_create(THIS_MODULE, "gpsdrv"); if (IS_ERR(devobj->cls)) { GPS_ERR("Unable to create class, err = %d\n", (int)PTR_ERR(devobj->cls)); goto error; } devobj->dev = device_create(devobj->cls, NULL, devobj->devno, drvobj, "gps"); drvobj->hw = hw; drvobj->pwrctl = 0; drvobj->suspend = 0; drvobj->state = GPS_STATE_UNSUPPORTED; drvobj->pwrsave = GPS_PWRSAVE_UNSUPPORTED; drvobj->rdelay = 50; drvobj->kobj = &devobj->dev->kobj; mutex_init(&drvobj->sem); err = mt3326_gps_create_attr(devobj->dev); if (err) goto error; /*initialize members */ spin_lock_init(&gps_private.lock); init_waitqueue_head(&gps_private.read_wait); sema_init(&gps_private.sem, 1); gps_private.dat_len = 0; gps_private.dat_pos = 0; memset(gps_private.dat_buf, 0x00, sizeof(gps_private.dat_buf)); /*set platform data: a new device created for gps */ platform_set_drvdata(dev, devobj); GPS_DBG("Done\n"); return 0; error: if (err == 0) cdev_del(&devobj->chdev); if (ret == 0) unregister_chrdev_region(devobj->devno, 1); kfree(devobj); kfree(drvobj); return -1; } /*****************************************************************************/ static int mt3326_gps_remove(struct platform_device *dev) { int err; struct gps_dev_obj *devobj = (struct gps_dev_obj *)platform_get_drvdata(dev); struct gps_drv_obj *drvobj; if (!devobj) { GPS_ERR("null pointer: %p\n", devobj); return -1; } drvobj = (struct gps_drv_obj *)dev_get_drvdata(devobj->dev); if (!drvobj) { GPS_ERR("null pointer: %p\n", drvobj); return -1; } GPS_DBG("Unregistering chardev\n"); cdev_del(&devobj->chdev); unregister_chrdev_region(devobj->devno, 1); mt3326_gps_hw_exit(devobj->hw); err = mt3326_gps_delete_attr(devobj->dev); if (err) GPS_ERR("delete attr fails: %d\n", err); device_destroy(devobj->cls, devobj->devno); class_destroy(devobj->cls); kfree(devobj); GPS_DBG("Done\n"); return 0; } /*****************************************************************************/ static void mt3326_gps_shutdown(struct platform_device *dev) { struct gps_dev_obj *devobj = (struct gps_dev_obj *)platform_get_drvdata(dev); GPS_DBG("Shutting down\n"); mt3326_gps_hw_exit(devobj->hw); } /*****************************************************************************/ #ifdef CONFIG_PM /*****************************************************************************/ static int mt3326_gps_suspend(struct platform_device *dev, pm_message_t state) { int err = 0; struct gps_dev_obj *devobj = (struct gps_dev_obj *)platform_get_drvdata(dev); struct gps_drv_obj *drvobj; if (!devobj) { GPS_ERR("null pointer: %p\n", devobj); return -1; } drvobj = (struct gps_drv_obj *)dev_get_drvdata(devobj->dev); if (!drvobj) { GPS_ERR("null pointer: %p\n", drvobj); return -1; } if (state.event == PM_EVENT_SUSPEND) err = mt3326_gps_dev_suspend(drvobj); else GPS_DBG("dev = %p, event = %u,", dev, state.event); return err; } /*****************************************************************************/ static int mt3326_gps_resume(struct platform_device *dev) { struct gps_dev_obj *devobj = (struct gps_dev_obj *)platform_get_drvdata(dev); struct gps_drv_obj *drvobj = (struct gps_drv_obj *)dev_get_drvdata(devobj->dev); return mt3326_gps_dev_resume(drvobj); } /*****************************************************************************/ #endif /* CONFIG_PM */ /*****************************************************************************/ #ifdef CONFIG_OF static const struct of_device_id apgps_of_ids[] = { {.compatible = "mediatek,mt3326-gps",}, {} }; #endif static struct platform_driver mt3326_gps_driver = { .probe = mt3326_gps_probe, .remove = mt3326_gps_remove, .shutdown = mt3326_gps_shutdown, #if defined(CONFIG_PM) .suspend = mt3326_gps_suspend, .resume = mt3326_gps_resume, #endif .driver = { .name = GPS_DEVNAME, .bus = &platform_bus_type, #ifdef CONFIG_OF .of_match_table = apgps_of_ids, #endif }, }; /*****************************************************************************/ static int __init mt3326_gps_mod_init(void) { int ret = 0; GPS_TRC(); /* ret = driver_register(&mt3326_gps_driver); */ ret = platform_driver_register(&mt3326_gps_driver); return ret; } /*****************************************************************************/ static void __exit mt3326_gps_mod_exit(void) { GPS_TRC(); platform_driver_unregister(&mt3326_gps_driver); } /*****************************************************************************/ module_init(mt3326_gps_mod_init); module_exit(mt3326_gps_mod_exit); /*****************************************************************************/ MODULE_AUTHOR("MingHsien Hsieh "); MODULE_DESCRIPTION("MT3326 GPS Driver"); MODULE_LICENSE("GPL"); #endif