#include "activity.h" struct act_context *act_context_obj = NULL; static struct act_init_info *activity_init_list[MAX_CHOOSE_ACT_NUM] = { 0 }; /* modified */ static void act_early_suspend(struct early_suspend *h); static void act_late_resume(struct early_suspend *h); static void act_work_func(struct work_struct *work) { struct act_context *cxt = NULL; /* int out_size; */ /* hwm_sensor_data sensor_data; */ /* u64 data64[6]; //for unify get_data parameter type */ /* u16 data32[6]; //for hwm_sensor_data.values as int */ u16 data16[6]; /* for hwm_sensor_data.values as int */ int status; int64_t nt; struct timespec time; int err = 0; cxt = act_context_obj; if (cxt->act_data.get_data == NULL) ACT_ERR("act driver not register data path\n"); time.tv_sec = time.tv_nsec = 0; time = get_monotonic_coarse(); nt = time.tv_sec * 1000000000LL + time.tv_nsec; /* add wake lock to make sure data can be read before system suspend */ /* initial data */ ACT_LOG("act_data.values %d,%d,%d,%d,%d,%d\n", cxt->drv_data.act_data.values[0], cxt->drv_data.act_data.values[1], cxt->drv_data.act_data.values[2], cxt->drv_data.act_data.values[3], cxt->drv_data.act_data.values[4], cxt->drv_data.act_data.values[5]); err = cxt->act_data.get_data(data16, &status); ACT_LOG("get_data 16 %d,%d,%d,%d,%d,%d\n", data16[0], data16[1], data16[2], data16[3], data16[4], data16[5]); if (err) { ACT_ERR("get act data fails!!\n"); goto act_loop; } else { if ((data16[0] == cxt->drv_data.act_data.values[0]) && (data16[1] == cxt->drv_data.act_data.values[1]) && (data16[2] == cxt->drv_data.act_data.values[2]) && (data16[3] == cxt->drv_data.act_data.values[3]) && (data16[4] == cxt->drv_data.act_data.values[4]) && (data16[5] == cxt->drv_data.act_data.values[5])) { goto act_loop; } else { cxt->drv_data.act_data.values[0] = data16[0]; cxt->drv_data.act_data.values[1] = data16[1]; cxt->drv_data.act_data.values[2] = data16[2]; cxt->drv_data.act_data.values[3] = data16[3]; cxt->drv_data.act_data.values[4] = data16[4]; cxt->drv_data.act_data.values[5] = data16[5]; ACT_LOG("act values %d,%d,%d,%d,%d,%d\n", cxt->drv_data.act_data.values[0], cxt->drv_data.act_data.values[1], cxt->drv_data.act_data.values[2], cxt->drv_data.act_data.values[3], cxt->drv_data.act_data.values[4], cxt->drv_data.act_data.values[5]); cxt->drv_data.act_data.status = status; cxt->drv_data.act_data.time = nt; } } if (true == cxt->is_first_data_after_enable) { cxt->is_first_data_after_enable = false; /* filter -1 value */ if (ACT_INVALID_VALUE == cxt->drv_data.act_data.values[0] || ACT_INVALID_VALUE == cxt->drv_data.act_data.values[1] || ACT_INVALID_VALUE == cxt->drv_data.act_data.values[2] || ACT_INVALID_VALUE == cxt->drv_data.act_data.values[3] || ACT_INVALID_VALUE == cxt->drv_data.act_data.values[4] || ACT_INVALID_VALUE == cxt->drv_data.act_data.values[5]) { ACT_LOG(" read invalid data\n"); goto act_loop; } } /* report data to input devic */ /* printk("new act work run....\n") */ /* ACT_LOG("act data[%d,%d,%d]\n" ,cxt->drv_data.act_data.values[0],*/ /* cxt->drv_data.act_data.values[1],cxt->drv_data.act_data.values[2]);*/ act_data_report(cxt->drv_data.act_data, cxt->drv_data.act_data.status); act_loop: if (true == cxt->is_polling_run) { { mod_timer(&cxt->timer, jiffies + atomic_read(&cxt->delay) / (1000 / HZ)); } } } static void act_poll(unsigned long data) { struct act_context *obj = (struct act_context *)data; if (obj != NULL) schedule_work(&obj->report); } static struct act_context *act_context_alloc_object(void) { struct act_context *obj = kzalloc(sizeof(*obj), GFP_KERNEL); ACT_LOG("act_context_alloc_object++++\n"); if (!obj) { ACT_ERR("Alloc act object error!\n"); return NULL; } atomic_set(&obj->delay, 200); /*5Hz set work queue delay time 200ms */ atomic_set(&obj->wake, 0); INIT_WORK(&obj->report, act_work_func); init_timer(&obj->timer); obj->timer.expires = jiffies + atomic_read(&obj->delay) / (1000 / HZ); obj->timer.function = act_poll; obj->timer.data = (unsigned long)obj; obj->is_first_data_after_enable = false; obj->is_polling_run = false; obj->is_batch_enable = false; mutex_init(&obj->act_op_mutex); ACT_LOG("act_context_alloc_object----\n"); return obj; } static int act_real_enable(int enable) { int err = 0; struct act_context *cxt = NULL; cxt = act_context_obj; if (1 == enable) { if (true == cxt->is_active_data || true == cxt->is_active_nodata) { err = cxt->act_ctl.enable_nodata(1); if (err) { err = cxt->act_ctl.enable_nodata(1); if (err) { err = cxt->act_ctl.enable_nodata(1); if (err) ACT_ERR("act enable(%d) err 3 timers = %d\n", enable, err); } } ACT_LOG("act real enable\n"); } } if (0 == enable) { if (false == cxt->is_active_data && false == cxt->is_active_nodata) { err = cxt->act_ctl.enable_nodata(0); if (err) ACT_ERR("act enable(%d) err = %d\n", enable, err); ACT_LOG("act real disable\n"); } } return err; } static int act_enable_data(int enable) { struct act_context *cxt = NULL; cxt = act_context_obj; if (NULL == cxt->act_ctl.open_report_data) { ACT_ERR("no act control path\n"); return -1; } if (1 == enable) { ACT_LOG("act enable data\n"); cxt->is_active_data = true; cxt->is_first_data_after_enable = true; cxt->act_ctl.open_report_data(1); if (false == cxt->is_polling_run && cxt->is_batch_enable == false) { if (false == cxt->act_ctl.is_report_input_direct) { mod_timer(&cxt->timer, jiffies + atomic_read(&cxt->delay) / (1000 / HZ)); cxt->is_polling_run = true; } } } if (0 == enable) { ACT_LOG("act disable\n"); cxt->is_active_data = false; cxt->act_ctl.open_report_data(0); if (true == cxt->is_polling_run) { if (false == cxt->act_ctl.is_report_input_direct) { cxt->is_polling_run = false; del_timer_sync(&cxt->timer); cancel_work_sync(&cxt->report); cxt->drv_data.act_data.values[0] = ACT_INVALID_VALUE; cxt->drv_data.act_data.values[1] = ACT_INVALID_VALUE; cxt->drv_data.act_data.values[2] = ACT_INVALID_VALUE; cxt->drv_data.act_data.values[3] = ACT_INVALID_VALUE; cxt->drv_data.act_data.values[4] = ACT_INVALID_VALUE; cxt->drv_data.act_data.values[5] = ACT_INVALID_VALUE; } } } act_real_enable(enable); return 0; } int act_enable_nodata(int enable) { struct act_context *cxt = NULL; cxt = act_context_obj; if (NULL == cxt->act_ctl.enable_nodata) { ACT_ERR("act_enable_nodata:act ctl path is NULL\n"); return -1; } if (1 == enable) cxt->is_active_nodata = true; if (0 == enable) cxt->is_active_nodata = false; act_real_enable(enable); return 0; } static ssize_t act_show_enable_nodata(struct device *dev, struct device_attribute *attr, char *buf) { int len = 0; ACT_LOG(" not support now\n"); return len; } static ssize_t act_store_enable_nodata(struct device *dev, struct device_attribute *attr, const char *buf, size_t count) { struct act_context *cxt = NULL; /* int err =0; */ ACT_LOG("act_store_enable nodata buf=%s\n", buf); mutex_lock(&act_context_obj->act_op_mutex); cxt = act_context_obj; if (NULL == cxt->act_ctl.enable_nodata) { ACT_LOG("act_ctl enable nodata NULL\n"); mutex_unlock(&act_context_obj->act_op_mutex); return count; } if (!strncmp(buf, "1", 1)) act_enable_nodata(1); else if (!strncmp(buf, "0", 1)) act_enable_nodata(0); else ACT_ERR(" act_store enable nodata cmd error !!\n"); mutex_unlock(&act_context_obj->act_op_mutex); return count; } static ssize_t act_store_active(struct device *dev, struct device_attribute *attr, const char *buf, size_t count) { struct act_context *cxt = NULL; ACT_LOG("act_store_active buf=%s\n", buf); mutex_lock(&act_context_obj->act_op_mutex); cxt = act_context_obj; if (NULL == cxt->act_ctl.open_report_data) { ACT_LOG("act_ctl enable NULL\n"); mutex_unlock(&act_context_obj->act_op_mutex); return count; } if (!strncmp(buf, "1", 1)) act_enable_data(1); else if (!strncmp(buf, "0", 1)) act_enable_data(0); else ACT_ERR(" act_store_active error !!\n"); mutex_unlock(&act_context_obj->act_op_mutex); ACT_LOG(" act_store_active done\n"); return count; } /*----------------------------------------------------------------------------*/ static ssize_t act_show_active(struct device *dev, struct device_attribute *attr, char *buf) { struct act_context *cxt = NULL; int div = 0; cxt = act_context_obj; /* int len = 0; */ ACT_LOG("act show active not support now\n"); /* div=cxt->act_data.vender_div; */ ACT_LOG("act vender_div value: %d\n", div); return snprintf(buf, PAGE_SIZE, "%d\n", div); /* return len; */ } static ssize_t act_store_delay(struct device *dev, struct device_attribute *attr, const char *buf, size_t count) { /* struct act_context *devobj = (struct act_context*)dev_get_drvdata(dev); */ int delay; int mdelay = 0; struct act_context *cxt = NULL; int err = 0; mutex_lock(&act_context_obj->act_op_mutex); cxt = act_context_obj; if (NULL == cxt->act_ctl.set_delay) { ACT_LOG("act_ctl set_delay NULL\n"); mutex_unlock(&act_context_obj->act_op_mutex); return count; } err = kstrtoint(buf, 10, &delay); if (0 != err) { ACT_ERR("invalid format!!\n"); mutex_unlock(&act_context_obj->act_op_mutex); return count; } if (false == cxt->act_ctl.is_report_input_direct) { mdelay = (int)delay / 1000 / 1000; atomic_set(&act_context_obj->delay, mdelay); } cxt->act_ctl.set_delay(delay); ACT_LOG(" act_delay %d ns\n", delay); mutex_unlock(&act_context_obj->act_op_mutex); return count; } static ssize_t act_show_delay(struct device *dev, struct device_attribute *attr, char *buf) { int len = 0; ACT_LOG(" not support now\n"); return len; } static ssize_t act_store_batch(struct device *dev, struct device_attribute *attr, const char *buf, size_t count) { struct act_context *cxt = NULL; /* int err =0; */ ACT_LOG("act_store_batch buf=%s\n", buf); mutex_lock(&act_context_obj->act_op_mutex); cxt = act_context_obj; if (cxt->act_ctl.is_support_batch) { if (!strncmp(buf, "1", 1)) cxt->is_batch_enable = true; else if (!strncmp(buf, "0", 1)) cxt->is_batch_enable = false; else ACT_ERR(" act_store_batch error !!\n"); } else { ACT_LOG(" act_store_batch not support\n"); } mutex_unlock(&act_context_obj->act_op_mutex); ACT_LOG(" act_store_batch done: %d\n", cxt->is_batch_enable); return count; } static ssize_t act_show_batch(struct device *dev, struct device_attribute *attr, char *buf) { return snprintf(buf, PAGE_SIZE, "%d\n", 0); } static ssize_t act_store_flush(struct device *dev, struct device_attribute *attr, const char *buf, size_t count) { /* mutex_lock(&act_context_obj->act_op_mutex); */ /* struct act_context *devobj = (struct act_context*)dev_get_drvdata(dev); */ /* do read FIFO data function and report data immediately */ /* mutex_unlock(&act_context_obj->act_op_mutex); */ return count; } static ssize_t act_show_flush(struct device *dev, struct device_attribute *attr, char *buf) { return snprintf(buf, PAGE_SIZE, "%d\n", 0); } static ssize_t act_show_devnum(struct device *dev, struct device_attribute *attr, char *buf) { const char *devname = NULL; devname = dev_name(&act_context_obj->idev->dev); return snprintf(buf, PAGE_SIZE, "%s\n", devname + 5); } static int activity_remove(struct platform_device *pdev) { ACT_LOG("activity_remove\n"); return 0; } static int activity_probe(struct platform_device *pdev) { ACT_LOG("activity_probe\n"); return 0; } #ifdef CONFIG_OF static const struct of_device_id activity_of_match[] = { {.compatible = "mediatek,activity",}, {}, }; #endif static struct platform_driver activity_driver = { .probe = activity_probe, .remove = activity_remove, .driver = { .name = "activity", #ifdef CONFIG_OF .of_match_table = activity_of_match, #endif } }; static int act_real_driver_init(void) { int i = 0; int err = 0; ACT_LOG(" act_real_driver_init +\n"); for (i = 0; i < MAX_CHOOSE_ACT_NUM; i++) { ACT_LOG(" i=%d\n", i); if (0 != activity_init_list[i]) { ACT_LOG(" act try to init driver %s\n", activity_init_list[i]->name); err = activity_init_list[i]->init(); if (0 == err) { ACT_LOG(" act real driver %s probe ok\n", activity_init_list[i]->name); break; } } } if (i == MAX_CHOOSE_ACT_NUM) { ACT_LOG(" act_real_driver_init fail\n"); err = -1; } return err; } int act_driver_add(struct act_init_info *obj) { int err = 0; int i = 0; ACT_FUN(f); for (i = 0; i < MAX_CHOOSE_ACT_NUM; i++) { if (i == 0) { ACT_LOG("register act driver for the first time\n"); err = platform_driver_register(&activity_driver); if (err) ACT_ERR("failed to register act driver already exist\n"); } if (NULL == activity_init_list[i]) { obj->platform_diver_addr = &activity_driver; activity_init_list[i] = obj; break; } } if (NULL == activity_init_list[i]) { ACT_ERR("act driver add err\n"); err = -1; } return err; } EXPORT_SYMBOL_GPL(act_driver_add); static int act_misc_init(struct act_context *cxt) { int err = 0; /* kernel-3.10\include\linux\Miscdevice.h */ /* use MISC_DYNAMIC_MINOR exceed 64 */ cxt->mdev.minor = M_ACT_MISC_MINOR; cxt->mdev.name = ACT_MISC_DEV_NAME; err = misc_register(&cxt->mdev); if (err) ACT_ERR("unable to register act misc device!!\n"); return err; } static void act_input_destroy(struct act_context *cxt) { struct input_dev *dev = cxt->idev; input_unregister_device(dev); input_free_device(dev); } static int act_input_init(struct act_context *cxt) { struct input_dev *dev; int err = 0; dev = input_allocate_device(); if (NULL == dev) return -ENOMEM; dev->name = ACT_INPUTDEV_NAME; input_set_capability(dev, EV_ABS, EVENT_TYPE_ACT_IN_VEHICLE); input_set_capability(dev, EV_ABS, EVENT_TYPE_ACT_ON_BICYCLE); input_set_capability(dev, EV_ABS, EVENT_TYPE_ACT_ON_FOOT); input_set_capability(dev, EV_ABS, EVENT_TYPE_ACT_STILL); input_set_capability(dev, EV_ABS, EVENT_TYPE_ACT_UNKNOWN); input_set_capability(dev, EV_ABS, EVENT_TYPE_ACT_TILT); input_set_capability(dev, EV_ABS, EVENT_TYPE_ACT_STATUS); input_set_abs_params(dev, EVENT_TYPE_ACT_IN_VEHICLE, ACT_VALUE_MIN, ACT_VALUE_MAX, 0, 0); input_set_abs_params(dev, EVENT_TYPE_ACT_ON_BICYCLE, ACT_VALUE_MIN, ACT_VALUE_MAX, 0, 0); input_set_abs_params(dev, EVENT_TYPE_ACT_ON_FOOT, ACT_VALUE_MIN, ACT_VALUE_MAX, 0, 0); input_set_abs_params(dev, EVENT_TYPE_ACT_STILL, ACT_VALUE_MIN, ACT_VALUE_MAX, 0, 0); input_set_abs_params(dev, EVENT_TYPE_ACT_UNKNOWN, ACT_VALUE_MIN, ACT_VALUE_MAX, 0, 0); input_set_abs_params(dev, EVENT_TYPE_ACT_TILT, ACT_VALUE_MIN, ACT_VALUE_MAX, 0, 0); input_set_abs_params(dev, EVENT_TYPE_ACT_STATUS, ACT_STATUS_MIN, ACT_STATUS_MAX, 0, 0); input_set_drvdata(dev, cxt); err = input_register_device(dev); if (err < 0) { input_free_device(dev); return err; } cxt->idev = dev; return 0; } DEVICE_ATTR(actenablenodata, S_IWUSR | S_IRUGO, act_show_enable_nodata, act_store_enable_nodata); DEVICE_ATTR(actactive, S_IWUSR | S_IRUGO, act_show_active, act_store_active); DEVICE_ATTR(actdelay, S_IWUSR | S_IRUGO, act_show_delay, act_store_delay); DEVICE_ATTR(actbatch, S_IWUSR | S_IRUGO, act_show_batch, act_store_batch); DEVICE_ATTR(actflush, S_IWUSR | S_IRUGO, act_show_flush, act_store_flush); DEVICE_ATTR(actdevnum, S_IWUSR | S_IRUGO, act_show_devnum, NULL); static struct attribute *act_attributes[] = { &dev_attr_actenablenodata.attr, &dev_attr_actactive.attr, &dev_attr_actdelay.attr, &dev_attr_actbatch.attr, &dev_attr_actflush.attr, &dev_attr_actdevnum.attr, NULL }; static struct attribute_group act_attribute_group = { .attrs = act_attributes }; int act_register_data_path(struct act_data_path *data) { struct act_context *cxt = NULL; /* int err =0; */ cxt = act_context_obj; cxt->act_data.get_data = data->get_data; /* cxt->act_data.vender_div = data->vender_div; */ /* cxt->act_data.get_raw_data = data->get_raw_data; */ /* ACT_LOG("act register data path vender_div: %d\n", cxt->act_data.vender_div); */ if (NULL == cxt->act_data.get_data) { ACT_LOG("act register data path fail\n"); return -1; } return 0; } int act_register_control_path(struct act_control_path *ctl) { struct act_context *cxt = NULL; int err = 0; cxt = act_context_obj; cxt->act_ctl.set_delay = ctl->set_delay; cxt->act_ctl.open_report_data = ctl->open_report_data; cxt->act_ctl.enable_nodata = ctl->enable_nodata; cxt->act_ctl.is_support_batch = ctl->is_support_batch; if (NULL == cxt->act_ctl.set_delay || NULL == cxt->act_ctl.open_report_data || NULL == cxt->act_ctl.enable_nodata) { ACT_LOG("act register control path fail\n"); return -1; } /* add misc dev for sensor hal control cmd */ err = act_misc_init(act_context_obj); if (err) { ACT_ERR("unable to register act misc device!!\n"); return -2; } err = sysfs_create_group(&act_context_obj->mdev.this_device->kobj, &act_attribute_group); if (err < 0) { ACT_ERR("unable to create act attribute file\n"); return -3; } kobject_uevent(&act_context_obj->mdev.this_device->kobj, KOBJ_ADD); return 0; } int act_data_report(hwm_sensor_data data, int status) { struct act_context *cxt = NULL; int err = 0; /* ACT_LOG("+act_data_report! %d, %d, %d, %d\n",x,y,z,status); */ ACT_LOG("+act_data_report! %d, %d, %d, %d %d %d\n", data.values[0], data.values[1], data.values[2], data.values[3], data.values[4], data.values[5]); cxt = act_context_obj; input_report_abs(cxt->idev, EVENT_TYPE_ACT_IN_VEHICLE, data.values[0]); input_report_abs(cxt->idev, EVENT_TYPE_ACT_ON_BICYCLE, data.values[1]); input_report_abs(cxt->idev, EVENT_TYPE_ACT_ON_FOOT, data.values[2]); input_report_abs(cxt->idev, EVENT_TYPE_ACT_STILL, data.values[3]); input_report_abs(cxt->idev, EVENT_TYPE_ACT_UNKNOWN, data.values[4]); input_report_abs(cxt->idev, EVENT_TYPE_ACT_TILT, data.values[5]); input_report_abs(cxt->idev, EVENT_TYPE_ACT_STATUS, status); input_sync(cxt->idev); return err; } static int act_probe(struct platform_device *pdev) { int err; ACT_LOG("+++++++++++++act_probe!!\n"); act_context_obj = act_context_alloc_object(); if (!act_context_obj) { err = -ENOMEM; ACT_ERR("unable to allocate devobj!\n"); goto exit_alloc_data_failed; } /* init real acteleration driver */ err = act_real_driver_init(); if (err) { ACT_ERR("act real driver init fail\n"); goto real_driver_init_fail; } /* err = act_factory_device_init(); */ /* if(err) */ /* { */ /* ACT_ERR("act_factory_device_init fail\n"); */ /* } */ /* init input dev */ err = act_input_init(act_context_obj); if (err) { ACT_ERR("unable to register act input device!\n"); goto exit_alloc_input_dev_failed; } #if defined(CONFIG_HAS_EARLYSUSPEND) && defined(CONFIG_EARLYSUSPEND) atomic_set(&(act_context_obj->early_suspend), 0); act_context_obj->early_drv.level = EARLY_SUSPEND_LEVEL_STOP_DRAWING - 1, act_context_obj->early_drv.suspend = act_early_suspend, act_context_obj->early_drv.resume = act_late_resume, register_early_suspend(&act_context_obj->early_drv); #endif /* #if defined(CONFIG_HAS_EARLYSUSPEND) && defined(CONFIG_EARLYSUSPEND) */ ACT_LOG("----act_probe OK !!\n"); return 0; /* exit_hwmsen_create_attr_failed: */ /* exit_misc_register_failed: */ /* exit_err_sysfs: */ if (err) { ACT_ERR("sysfs node creation error\n"); act_input_destroy(act_context_obj); } real_driver_init_fail: exit_alloc_input_dev_failed: kfree(act_context_obj); exit_alloc_data_failed: ACT_LOG("----act_probe fail !!!\n"); return err; } static int act_remove(struct platform_device *pdev) { int err = 0; ACT_FUN(f); input_unregister_device(act_context_obj->idev); sysfs_remove_group(&act_context_obj->idev->dev.kobj, &act_attribute_group); err = misc_deregister(&act_context_obj->mdev); if (err) ACT_ERR("misc_deregister fail: %d\n", err); kfree(act_context_obj); return 0; } static void act_early_suspend(struct early_suspend *h) { atomic_set(&(act_context_obj->early_suspend), 1); ACT_LOG("act_early_suspend ok------->hwm_obj->early_suspend=%d\n", atomic_read(&(act_context_obj->early_suspend); } /*----------------------------------------------------------------------------*/ static void act_late_resume(struct early_suspend *h) { atomic_set(&(act_context_obj->early_suspend), 0); ACT_LOG("act_late_resume ok------->hwm_obj->early_suspend=%d\n", atomic_read(&(act_context_obj->early_suspend))); } static int act_suspend(struct platform_device *dev, pm_message_t state) { return 0; } /*----------------------------------------------------------------------------*/ static int act_resume(struct platform_device *dev) { return 0; } #ifdef CONFIG_OF static const struct of_device_id m_act_pl_of_match[] = { {.compatible = "mediatek,m_act_pl",}, {}, }; #endif static struct platform_driver act_driver = { .probe = act_probe, .remove = act_remove, .suspend = act_suspend, .resume = act_resume, .driver = { .name = ACT_PL_DEV_NAME, /* mt_act_pl */ #ifdef CONFIG_OF .of_match_table = m_act_pl_of_match, #endif } }; static int __init act_init(void) { ACT_FUN(f); if (platform_driver_register(&act_driver)) { ACT_ERR("failed to register act driver\n"); return -ENODEV; } return 0; } static void __exit act_exit(void) { platform_driver_unregister(&act_driver); platform_driver_unregister(&activity_driver); } late_initcall(act_init); MODULE_LICENSE("GPL"); MODULE_DESCRIPTION("ACTIVITY device driver"); MODULE_AUTHOR("Mediatek");