| 123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783 |
- #include "linearacceleration.h"
- static struct la_context *la_context_obj;
- static struct la_init_info *linearaccelerationsensor_init_list[MAX_CHOOSE_LA_NUM] = { 0 }; /* modified */
- #if defined(CONFIG_HAS_EARLYSUSPEND) && defined(CONFIG_EARLYSUSPEND)
- static void la_early_suspend(struct early_suspend *h);
- static void la_late_resume(struct early_suspend *h);
- #endif
- static void la_work_func(struct work_struct *work)
- {
- struct la_context *cxt = NULL;
- int x, y, z, status;
- int64_t nt;
- struct timespec time;
- int err;
- LA_FUN();
- cxt = la_context_obj;
- if (NULL == cxt->la_data.get_data)
- LA_LOG("la 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;
- err = cxt->la_data.get_data(&x, &y, &z, &status);
- if (err) {
- LA_ERR("get la data fails!!\n");
- goto la_loop;
- } else {
- {
- if (0 == x && 0 == y && 0 == z)
- goto la_loop;
- cxt->drv_data.la_data.values[0] = x + cxt->cali_sw[0];
- cxt->drv_data.la_data.values[1] = y + cxt->cali_sw[1];
- cxt->drv_data.la_data.values[2] = z + cxt->cali_sw[2];
- cxt->drv_data.la_data.status = status;
- cxt->drv_data.la_data.time = nt;
- }
- }
- if (true == cxt->is_first_data_after_enable) {
- cxt->is_first_data_after_enable = false;
- if (LA_INVALID_VALUE == cxt->drv_data.la_data.values[0] ||
- LA_INVALID_VALUE == cxt->drv_data.la_data.values[1] ||
- LA_INVALID_VALUE == cxt->drv_data.la_data.values[2]) {
- LA_LOG(" read invalid data\n");
- goto la_loop;
- }
- }
- la_data_report(cxt->drv_data.la_data.values[0],
- cxt->drv_data.la_data.values[1], cxt->drv_data.la_data.values[2],
- cxt->drv_data.la_data.status);
- la_loop:
- if (true == cxt->is_polling_run)
- mod_timer(&cxt->timer, jiffies + atomic_read(&cxt->delay) / (1000 / HZ));
- }
- static void la_poll(unsigned long data)
- {
- struct la_context *obj = (struct la_context *)data;
- if (obj != NULL)
- schedule_work(&obj->report);
- }
- static struct la_context *la_context_alloc_object(void)
- {
- struct la_context *obj = kzalloc(sizeof(*obj), GFP_KERNEL);
- LA_LOG("la_context_alloc_object++++\n");
- if (!obj) {
- LA_ERR("Alloc linearacceleration 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, la_work_func);
- init_timer(&obj->timer);
- obj->timer.expires = jiffies + atomic_read(&obj->delay) / (1000 / HZ);
- obj->timer.function = la_poll;
- obj->timer.data = (unsigned long)obj;
- obj->is_first_data_after_enable = false;
- obj->is_polling_run = false;
- mutex_init(&obj->la_op_mutex);
- obj->is_batch_enable = false; /* for batch mode init */
- obj->cali_sw[LA_AXIS_X] = 0;
- obj->cali_sw[LA_AXIS_Y] = 0;
- obj->cali_sw[LA_AXIS_Z] = 0;
- LA_LOG("la_context_alloc_object----\n");
- return obj;
- }
- static int la_real_enable(int enable)
- {
- int err = 0;
- struct la_context *cxt = NULL;
- LA_FUN();
- cxt = la_context_obj;
- if (1 == enable) {
- if (true == cxt->is_active_data || true == cxt->is_active_nodata) {
- err = cxt->la_ctl.enable_nodata(1);
- if (err) {
- err = cxt->la_ctl.enable_nodata(1);
- if (err) {
- err = cxt->la_ctl.enable_nodata(1);
- if (err)
- LA_ERR("la enable(%d) err 3 timers = %d\n", enable,
- err);
- }
- }
- LA_LOG("la real enable\n");
- }
- }
- if (0 == enable) {
- if (false == cxt->is_active_data && false == cxt->is_active_nodata) {
- err = cxt->la_ctl.enable_nodata(0);
- if (err)
- LA_ERR("la enable(%d) err = %d\n", enable, err);
- LA_LOG("la real disable\n");
- }
- }
- return err;
- }
- static int la_enable_data(int enable)
- {
- struct la_context *cxt = NULL;
- LA_FUN();
- /* int err =0; */
- cxt = la_context_obj;
- if (NULL == cxt->la_ctl.open_report_data) {
- LA_ERR("no la control path\n");
- return -1;
- }
- if (1 == enable) {
- LA_LOG("LA enable data\n");
- cxt->is_active_data = true;
- cxt->is_first_data_after_enable = true;
- cxt->la_ctl.open_report_data(1);
- la_real_enable(enable);
- if (false == cxt->is_polling_run && cxt->is_batch_enable == false) {
- if (false == cxt->la_ctl.is_report_input_direct) {
- mod_timer(&cxt->timer,
- jiffies + atomic_read(&cxt->delay) / (1000 / HZ));
- cxt->is_polling_run = true;
- }
- }
- }
- if (0 == enable) {
- LA_LOG("LA disable\n");
- cxt->is_active_data = false;
- cxt->la_ctl.open_report_data(0);
- if (true == cxt->is_polling_run) {
- if (false == cxt->la_ctl.is_report_input_direct) {
- cxt->is_polling_run = false;
- del_timer_sync(&cxt->timer);
- cancel_work_sync(&cxt->report);
- cxt->drv_data.la_data.values[0] = LA_INVALID_VALUE;
- cxt->drv_data.la_data.values[1] = LA_INVALID_VALUE;
- cxt->drv_data.la_data.values[2] = LA_INVALID_VALUE;
- }
- }
- la_real_enable(enable);
- }
- return 0;
- }
- int la_enable_nodata(int enable)
- {
- struct la_context *cxt = NULL;
- /* int err =0; */
- cxt = la_context_obj;
- if (NULL == cxt->la_ctl.enable_nodata) {
- LA_ERR("la_enable_nodata:la ctl path is NULL\n");
- return -1;
- }
- if (1 == enable)
- cxt->is_active_nodata = true;
- if (0 == enable)
- cxt->is_active_nodata = false;
- la_real_enable(enable);
- return 0;
- }
- static ssize_t la_show_enable_nodata(struct device *dev, struct device_attribute *attr, char *buf)
- {
- int len = 0;
- LA_LOG(" not support now\n");
- return len;
- }
- static ssize_t la_store_enable_nodata(struct device *dev, struct device_attribute *attr,
- const char *buf, size_t count)
- {
- struct la_context *cxt = NULL;
- /* int err =0; */
- LA_LOG("la_store_enable nodata buf=%s\n", buf);
- mutex_lock(&la_context_obj->la_op_mutex);
- cxt = la_context_obj;
- if (NULL == cxt->la_ctl.enable_nodata) {
- LA_LOG("la_ctl enable nodata NULL\n");
- mutex_unlock(&la_context_obj->la_op_mutex);
- return count;
- }
- if (!strncmp(buf, "1", 1)) {
- /* cxt->la_ctl.enable_nodata(1); */
- la_enable_nodata(1);
- } else if (!strncmp(buf, "0", 1)) {
- /* cxt->la_ctl.enable_nodata(0); */
- la_enable_nodata(0);
- } else {
- LA_ERR(" la_store enable nodata cmd error !!\n");
- }
- mutex_unlock(&la_context_obj->la_op_mutex);
- return count;
- }
- static ssize_t la_store_active(struct device *dev, struct device_attribute *attr,
- const char *buf, size_t count)
- {
- struct la_context *cxt = NULL;
- LA_LOG("la_store_active buf=%s\n", buf);
- mutex_lock(&la_context_obj->la_op_mutex);
- cxt = la_context_obj;
- if (NULL == cxt->la_ctl.open_report_data) {
- LA_LOG("la_ctl enable NULL\n");
- mutex_unlock(&la_context_obj->la_op_mutex);
- return count;
- }
- if (!strncmp(buf, "1", 1)) {
- /* cxt->la_ctl.enable(1); */
- la_enable_data(1);
- } else if (!strncmp(buf, "0", 1)) {
- /* cxt->la_ctl.enable(0); */
- la_enable_data(0);
- } else {
- LA_ERR(" la_store_active error !!\n");
- }
- mutex_unlock(&la_context_obj->la_op_mutex);
- LA_LOG(" la_store_active done\n");
- return count;
- }
- /*----------------------------------------------------------------------------*/
- static ssize_t la_show_active(struct device *dev, struct device_attribute *attr, char *buf)
- {
- struct la_context *cxt = NULL;
- int div = 0;
- cxt = la_context_obj;
- div = cxt->la_data.vender_div;
- LA_LOG("la vender_div value: %d\n", div);
- return snprintf(buf, PAGE_SIZE, "%d\n", div);
- }
- static ssize_t la_store_delay(struct device *dev, struct device_attribute *attr,
- const char *buf, size_t count)
- {
- /* struct la_context *devobj = (struct la_context*)dev_get_drvdata(dev); */
- int delay = 0;
- int mdelay = 0;
- struct la_context *cxt = NULL;
- int err;
- mutex_lock(&la_context_obj->la_op_mutex);
- /* int err =0; */
- cxt = la_context_obj;
- if (NULL == cxt->la_ctl.set_delay) {
- LA_LOG("la_ctl set_delay NULL\n");
- mutex_unlock(&la_context_obj->la_op_mutex);
- return count;
- }
- err = kstrtoint(buf, 10, &delay);
- if (err != 0) {
- LA_ERR("invalid format!!\n");
- mutex_unlock(&la_context_obj->la_op_mutex);
- return count;
- }
- if (false == cxt->la_ctl.is_report_input_direct) {
- mdelay = (int)delay / 1000 / 1000;
- atomic_set(&la_context_obj->delay, mdelay);
- }
- cxt->la_ctl.set_delay(delay);
- LA_LOG(" la_delay %d ns\n", delay);
- mutex_unlock(&la_context_obj->la_op_mutex);
- return count;
- }
- static ssize_t la_show_delay(struct device *dev, struct device_attribute *attr, char *buf)
- {
- int len = 0;
- LA_LOG(" not support now\n");
- return len;
- }
- static ssize_t la_show_sensordevnum(struct device *dev, struct device_attribute *attr, char *buf)
- {
- struct la_context *cxt = NULL;
- const char *devname = NULL;
- cxt = la_context_obj;
- devname = dev_name(&cxt->idev->dev);
- return snprintf(buf, PAGE_SIZE, "%s\n", devname + 5);
- }
- static ssize_t la_store_batch(struct device *dev, struct device_attribute *attr,
- const char *buf, size_t count)
- {
- struct la_context *cxt = NULL;
- /* int err =0; */
- LA_LOG("la_store_batch buf=%s\n", buf);
- mutex_lock(&la_context_obj->la_op_mutex);
- cxt = la_context_obj;
- if (cxt->la_ctl.is_support_batch) {
- if (!strncmp(buf, "1", 1)) {
- cxt->is_batch_enable = true;
- /* MTK problem fix - start */
- if (cxt->is_active_data && cxt->is_polling_run) {
- cxt->is_polling_run = false;
- del_timer_sync(&cxt->timer);
- cancel_work_sync(&cxt->report);
- }
- /* MTK problem fix - end */
- } else if (!strncmp(buf, "0", 1)) {
- cxt->is_batch_enable = false;
- /* MTK problem fix - start */
- if (cxt->is_active_data)
- la_enable_data(true);
- /* MTK problem fix - end */
- } else {
- LA_ERR(" la_store_batch error !!\n");
- }
- } else {
- LA_LOG(" la_store_batch mot supported\n");
- }
- mutex_unlock(&la_context_obj->la_op_mutex);
- LA_LOG(" la_store_batch done: %d\n", cxt->is_batch_enable);
- return count;
- }
- static ssize_t la_show_batch(struct device *dev, struct device_attribute *attr, char *buf)
- {
- return snprintf(buf, PAGE_SIZE, "%d\n", 0);
- }
- static ssize_t la_store_flush(struct device *dev, struct device_attribute *attr,
- const char *buf, size_t count)
- {
- /* mutex_lock(&la_context_obj->la_op_mutex); */
- /* struct la_context *devobj = (struct la_context*)dev_get_drvdata(dev); */
- /* do read FIFO data function and report data immediately */
- /* mutex_unlock(&la_context_obj->la_op_mutex); */
- return count;
- }
- static ssize_t la_show_flush(struct device *dev, struct device_attribute *attr, char *buf)
- {
- return snprintf(buf, PAGE_SIZE, "%d\n", 0);
- }
- static int linearaccelerationsensor_remove(struct platform_device *pdev)
- {
- LA_LOG("linearaccelerationsensor_remove\n");
- return 0;
- }
- static int linearaccelerationsensor_probe(struct platform_device *pdev)
- {
- LA_LOG("linearaccelerationsensor_probe\n");
- return 0;
- }
- #ifdef CONFIG_OF
- static const struct of_device_id linearaccelerationsensor_of_match[] = {
- {.compatible = "mediatek,linearaccelerationsensor",},
- {},
- };
- #endif
- static struct platform_driver linearaccelerationsensor_driver = {
- .probe = linearaccelerationsensor_probe,
- .remove = linearaccelerationsensor_remove,
- .driver = {
- .name = "linearaccelerationsensor",
- #ifdef CONFIG_OF
- .of_match_table = linearaccelerationsensor_of_match,
- #endif
- }
- };
- static int la_real_driver_init(void)
- {
- int i = 0;
- int err = 0;
- LA_LOG(" la_real_driver_init +\n");
- for (i = 0; i < MAX_CHOOSE_LA_NUM; i++) {
- LA_LOG(" i=%d\n", i);
- if (0 != linearaccelerationsensor_init_list[i]) {
- LA_LOG(" la try to init driver %s\n",
- linearaccelerationsensor_init_list[i]->name);
- err = linearaccelerationsensor_init_list[i]->init();
- if (0 == err) {
- LA_LOG(" la real driver %s probe ok\n",
- linearaccelerationsensor_init_list[i]->name);
- break;
- }
- }
- }
- if (i == MAX_CHOOSE_LA_NUM) {
- LA_LOG(" la_real_driver_init fail\n");
- err = -1;
- }
- return err;
- }
- static int la_misc_init(struct la_context *cxt)
- {
- int err = 0;
- cxt->mdev.minor = MISC_DYNAMIC_MINOR;
- cxt->mdev.name = LA_MISC_DEV_NAME;
- err = misc_register(&cxt->mdev);
- if (err)
- LA_ERR("unable to register la misc device!!\n");
- /* dev_set_drvdata(cxt->mdev.this_device, cxt); */
- return err;
- }
- static void la_input_destroy(struct la_context *cxt)
- {
- struct input_dev *dev = cxt->idev;
- input_unregister_device(dev);
- input_free_device(dev);
- }
- static int la_input_init(struct la_context *cxt)
- {
- struct input_dev *dev;
- int err = 0;
- dev = input_allocate_device();
- if (NULL == dev)
- return -ENOMEM;
- dev->name = LA_INPUTDEV_NAME;
- input_set_capability(dev, EV_ABS, EVENT_TYPE_LA_X);
- input_set_capability(dev, EV_ABS, EVENT_TYPE_LA_Y);
- input_set_capability(dev, EV_ABS, EVENT_TYPE_LA_Z);
- input_set_capability(dev, EV_REL, EVENT_TYPE_LA_STATUS);
- input_set_abs_params(dev, EVENT_TYPE_LA_X, LA_VALUE_MIN, LA_VALUE_MAX, 0, 0);
- input_set_abs_params(dev, EVENT_TYPE_LA_Y, LA_VALUE_MIN, LA_VALUE_MAX, 0, 0);
- input_set_abs_params(dev, EVENT_TYPE_LA_Z, LA_VALUE_MIN, LA_VALUE_MAX, 0, 0);
- input_set_drvdata(dev, cxt);
- input_set_events_per_packet(dev, 32); /* test */
- err = input_register_device(dev);
- if (err < 0) {
- input_free_device(dev);
- return err;
- }
- cxt->idev = dev;
- return 0;
- }
- DEVICE_ATTR(laenablenodata, S_IWUSR | S_IRUGO, la_show_enable_nodata, la_store_enable_nodata);
- DEVICE_ATTR(laactive, S_IWUSR | S_IRUGO, la_show_active, la_store_active);
- DEVICE_ATTR(ladelay, S_IWUSR | S_IRUGO, la_show_delay, la_store_delay);
- DEVICE_ATTR(labatch, S_IWUSR | S_IRUGO, la_show_batch, la_store_batch);
- DEVICE_ATTR(laflush, S_IWUSR | S_IRUGO, la_show_flush, la_store_flush);
- DEVICE_ATTR(ladevnum, S_IWUSR | S_IRUGO, la_show_sensordevnum, NULL);
- static struct attribute *la_attributes[] = {
- &dev_attr_laenablenodata.attr,
- &dev_attr_laactive.attr,
- &dev_attr_ladelay.attr,
- &dev_attr_labatch.attr,
- &dev_attr_laflush.attr,
- &dev_attr_ladevnum.attr,
- NULL
- };
- static struct attribute_group la_attribute_group = {
- .attrs = la_attributes
- };
- int la_register_data_path(struct la_data_path *data)
- {
- struct la_context *cxt = NULL;
- /* int err =0; */
- cxt = la_context_obj;
- cxt->la_data.get_data = data->get_data;
- cxt->la_data.get_raw_data = data->get_raw_data;
- cxt->la_data.vender_div = data->vender_div;
- LA_LOG("la register data path vender_div: %d\n", cxt->la_data.vender_div);
- if (NULL == cxt->la_data.get_data) {
- LA_LOG("la register data path fail\n");
- return -1;
- }
- return 0;
- }
- int la_register_control_path(struct la_control_path *ctl)
- {
- struct la_context *cxt = NULL;
- int err = 0;
- cxt = la_context_obj;
- cxt->la_ctl.set_delay = ctl->set_delay;
- cxt->la_ctl.open_report_data = ctl->open_report_data;
- cxt->la_ctl.enable_nodata = ctl->enable_nodata;
- cxt->la_ctl.is_support_batch = ctl->is_support_batch;
- cxt->la_ctl.is_report_input_direct = ctl->is_report_input_direct;
- cxt->la_ctl.la_calibration = ctl->la_calibration;
- if (NULL == cxt->la_ctl.set_delay || NULL == cxt->la_ctl.open_report_data
- || NULL == cxt->la_ctl.enable_nodata) {
- LA_LOG("la register control path fail\n");
- return -1;
- }
- /* add misc dev for sensor hal control cmd */
- err = la_misc_init(la_context_obj);
- if (err) {
- LA_ERR("unable to register la misc device!!\n");
- return -2;
- }
- err = sysfs_create_group(&la_context_obj->mdev.this_device->kobj, &la_attribute_group);
- if (err < 0) {
- LA_ERR("unable to create la attribute file\n");
- return -3;
- }
- kobject_uevent(&la_context_obj->mdev.this_device->kobj, KOBJ_ADD);
- return 0;
- }
- int la_data_report(int x, int y, int z, int status)
- {
- struct la_context *cxt = NULL;
- int err = 0;
- cxt = la_context_obj;
- LA_LOG("la_data_report! %d, %d, %d, %d\n", x, y, z, status);
- input_report_abs(cxt->idev, EVENT_TYPE_LA_X, x);
- input_report_abs(cxt->idev, EVENT_TYPE_LA_Y, y);
- input_report_abs(cxt->idev, EVENT_TYPE_LA_Z, z);
- input_report_rel(cxt->idev, EVENT_TYPE_LA_STATUS, status);
- input_sync(cxt->idev);
- return err;
- }
- static int la_probe(struct platform_device *pdev)
- {
- int err;
- LA_LOG("+++++++++++++linearacceleration_probe!!\n");
- la_context_obj = la_context_alloc_object();
- if (!la_context_obj) {
- err = -ENOMEM;
- LA_ERR("unable to allocate devobj!\n");
- goto exit_alloc_data_failed;
- }
- /* init real linearaccelerationeration driver */
- err = la_real_driver_init();
- if (err) {
- LA_ERR("la real driver init fail\n");
- goto real_driver_init_fail;
- }
- /* init input dev */
- err = la_input_init(la_context_obj);
- if (err) {
- LA_ERR("unable to register la input device!\n");
- goto exit_alloc_input_dev_failed;
- }
- #if defined(CONFIG_HAS_EARLYSUSPEND) && defined(CONFIG_EARLYSUSPEND)
- atomic_set(&(la_context_obj->early_suspend), 0);
- la_context_obj->early_drv.level = 1; /* EARLY_SUSPEND_LEVEL_STOP_DRAWING - 1, */
- la_context_obj->early_drv.suspend = la_early_suspend,
- la_context_obj->early_drv.resume = la_late_resume,
- register_early_suspend(&la_context_obj->early_drv);
- #endif
- LA_LOG("----linearacceleration_probe OK !!\n");
- return 0;
- /* exit_hwmsen_create_attr_failed: */
- /* exit_misc_register_failed: */
- /* exit_err_sysfs: */
- if (err) {
- LA_ERR("sysfs node creation error\n");
- la_input_destroy(la_context_obj);
- }
- real_driver_init_fail:
- exit_alloc_input_dev_failed:
- kfree(la_context_obj);
- exit_alloc_data_failed:
- LA_LOG("----linearacceleration_probe fail !!!\n");
- return err;
- }
- static int la_remove(struct platform_device *pdev)
- {
- int err = 0;
- LA_FUN(f);
- input_unregister_device(la_context_obj->idev);
- sysfs_remove_group(&la_context_obj->idev->dev.kobj, &la_attribute_group);
- err = misc_deregister(&la_context_obj->mdev);
- if (err)
- LA_ERR("misc_deregister fail: %d\n", err);
- kfree(la_context_obj);
- return 0;
- }
- #if defined(CONFIG_HAS_EARLYSUSPEND) && defined(CONFIG_EARLYSUSPEND)
- static void la_early_suspend(struct early_suspend *h)
- {
- atomic_set(&(la_context_obj->early_suspend), 1);
- LA_LOG(" la_early_suspend ok------->hwm_obj->early_suspend=%d\n",
- atomic_read(&(la_context_obj->early_suspend)));
- }
- /*----------------------------------------------------------------------------*/
- static void la_late_resume(struct early_suspend *h)
- {
- atomic_set(&(la_context_obj->early_suspend), 0);
- LA_LOG(" la_late_resume ok------->hwm_obj->early_suspend=%d\n",
- atomic_read(&(la_context_obj->early_suspend)));
- }
- #endif
- static int la_suspend(struct platform_device *dev, pm_message_t state)
- {
- return 0;
- }
- /*----------------------------------------------------------------------------*/
- static int la_resume(struct platform_device *dev)
- {
- return 0;
- }
- #ifdef CONFIG_OF
- static const struct of_device_id m_la_pl_of_match[] = {
- {.compatible = "mediatek,m_la_pl",},
- {},
- };
- #endif
- static struct platform_driver la_driver = {
- .probe = la_probe,
- .remove = la_remove,
- .suspend = la_suspend,
- .resume = la_resume,
- .driver = {
- .name = LA_PL_DEV_NAME,
- #ifdef CONFIG_OF
- .of_match_table = m_la_pl_of_match,
- #endif
- }
- };
- int la_driver_add(struct la_init_info *obj)
- {
- int err = 0;
- int i = 0;
- LA_FUN();
- for (i = 0; i < MAX_CHOOSE_LA_NUM; i++) {
- if ((i == 0) && (NULL == linearaccelerationsensor_init_list[0])) {
- LA_LOG("register gensor driver for the first time\n");
- if (platform_driver_register(&linearaccelerationsensor_driver))
- LA_ERR("failed to register gensor driver already exist\n");
- }
- if (NULL == linearaccelerationsensor_init_list[i]) {
- obj->platform_diver_addr = &linearaccelerationsensor_driver;
- linearaccelerationsensor_init_list[i] = obj;
- break;
- }
- }
- if (i >= MAX_CHOOSE_LA_NUM) {
- LA_ERR("LA driver add err\n");
- err = -1;
- }
- return err;
- } EXPORT_SYMBOL_GPL(la_driver_add);
- static int __init la_init(void)
- {
- LA_FUN();
- if (platform_driver_register(&la_driver)) {
- LA_ERR("failed to register la driver\n");
- return -ENODEV;
- }
- return 0;
- }
- static void __exit la_exit(void)
- {
- platform_driver_unregister(&la_driver);
- platform_driver_unregister(&linearaccelerationsensor_driver);
- }
- late_initcall(la_init);
- /* module_init(la_init); */
- /* module_exit(la_exit); */
- MODULE_LICENSE("GPL");
- MODULE_DESCRIPTION("LINEARACCEL device driver");
- MODULE_AUTHOR("Mediatek");
|