Fork me on GitHub

基于input子系统的sensor驱动调试(二)

继上一篇:http://www.cnblogs.com/linhaostudy/p/8303628.html#_label1_1

一、驱动流程解析:

1、模块加载:

 1 static struct of_device_id stk_match_table[] = {
 2     { .compatible = "stk,stk3x1x", },
 3     { },
 4 };
 5 
 6 static struct i2c_driver stk_ps_driver =
 7 {
 8     .driver = {
 9         .name = DEVICE_NAME,
10         .owner = THIS_MODULE,
11         .of_match_table = stk_match_table,
12     },
13     .probe = stk3x1x_probe,
14     .remove = stk3x1x_remove,
15     .id_table = stk_ps_id,
16 };
17 
18 
19 static int __init stk3x1x_init(void)
20 {
21     int ret;
22     ret = i2c_add_driver(&stk_ps_driver);
23     if (ret)
24         return ret;
25 
26     return 0;
27 }
28 
29 static void __exit stk3x1x_exit(void)
30 {
31     i2c_del_driver(&stk_ps_driver);
32 }

of_device_id与DTS中的匹配,这与内核2.6以前的i2c_board_info不一样;

内核加载驱动模块的时候将调用到stk3x1x_init()方法:

初始化了i2c_driver结构体给stk_ps_driver变量,将用于将设备注册到IIC。关键在于结构体中的probe()方法,注册完成的时候将调用;

 

2、stk3x1x驱动初始化-probe函数:

  1 static int stk3x1x_probe(struct i2c_client *client,
  2                         const struct i2c_device_id *id)
  3 {
  4     int err = -ENODEV;
  5     struct stk3x1x_data *ps_data;
  6     struct stk3x1x_platform_data *plat_data;
  7     printk(KERN_INFO "%s: driver version = %s\n", __func__, DRIVER_VERSION);
  8 
  9     if (!i2c_check_functionality(client->adapter, I2C_FUNC_SMBUS_BYTE_DATA))
 10     {
 11         printk(KERN_ERR "%s: No Support for I2C_FUNC_SMBUS_BYTE_DATA\n", __func__);
 12         return -ENODEV;
 13     }
 14     if (!i2c_check_functionality(client->adapter, I2C_FUNC_SMBUS_WORD_DATA))
 15     {
 16         printk(KERN_ERR "%s: No Support for I2C_FUNC_SMBUS_WORD_DATA\n", __func__);
 17         return -ENODEV;
 18     }
 19 
 20     ps_data = kzalloc(sizeof(struct stk3x1x_data),GFP_KERNEL);
 21     if(!ps_data)
 22     {
 23         printk(KERN_ERR "%s: failed to allocate stk3x1x_data\n", __func__);
 24         return -ENOMEM;
 25     }
 26     ps_data->client = client;
 27     i2c_set_clientdata(client,ps_data);
 28     mutex_init(&ps_data->io_lock);
 29     wake_lock_init(&ps_data->ps_wakelock,WAKE_LOCK_SUSPEND, "stk_input_wakelock");
 30 
 31 #ifdef STK_POLL_PS
 32     wake_lock_init(&ps_data->ps_nosuspend_wl,WAKE_LOCK_SUSPEND, "stk_nosuspend_wakelock");
 33 #endif
 34     if (client->dev.of_node) {
 35         plat_data = devm_kzalloc(&client->dev,
 36             sizeof(struct stk3x1x_platform_data), GFP_KERNEL);
 37         if (!plat_data) {
 38             dev_err(&client->dev, "Failed to allocate memory\n");
 39             return -ENOMEM;
 40         }
 41 
 42         err = stk3x1x_parse_dt(&client->dev, plat_data);
 43         dev_err(&client->dev,
 44             "%s: stk3x1x_parse_dt ret=%d\n", __func__, err);
 45         if (err)
 46             return err;
 47     } else
 48         plat_data = client->dev.platform_data;
 49 
 50     if (!plat_data) {
 51         dev_err(&client->dev,
 52             "%s: no stk3x1x platform data!\n", __func__);
 53         goto err_als_input_allocate;
 54     }
 55     ps_data->als_transmittance = plat_data->transmittance;
 56     ps_data->int_pin = plat_data->int_pin;
 57     ps_data->use_fir = plat_data->use_fir;
 58     ps_data->pdata = plat_data;
 59 
 60     if (ps_data->als_transmittance == 0) {
 61         dev_err(&client->dev,
 62             "%s: Please set als_transmittance\n", __func__);
 63         goto err_als_input_allocate;
 64     }
 65 
 66     ps_data->als_input_dev = devm_input_allocate_device(&client->dev);
 67     if (ps_data->als_input_dev==NULL)
 68     {
 69         printk(KERN_ERR "%s: could not allocate als device\n", __func__);
 70         err = -ENOMEM;
 71         goto err_als_input_allocate;
 72     }
 73     ps_data->ps_input_dev = devm_input_allocate_device(&client->dev);
 74     if (ps_data->ps_input_dev==NULL)
 75     {
 76         printk(KERN_ERR "%s: could not allocate ps device\n", __func__);
 77         err = -ENOMEM;
 78         goto err_als_input_allocate;
 79     }
 80     ps_data->als_input_dev->name = ALS_NAME;
 81     ps_data->ps_input_dev->name = PS_NAME;
 82     set_bit(EV_ABS, ps_data->als_input_dev->evbit);
 83     set_bit(EV_ABS, ps_data->ps_input_dev->evbit);
 84     input_set_abs_params(ps_data->als_input_dev, ABS_MISC, 0, stk_alscode2lux(ps_data, (1<<16)-1), 0, 0);
 85     input_set_abs_params(ps_data->ps_input_dev, ABS_DISTANCE, 0,1, 0, 0);
 86     err = input_register_device(ps_data->als_input_dev);
 87     if (err<0)
 88     {
 89         printk(KERN_ERR "%s: can not register als input device\n", __func__);
 90         goto err_als_input_allocate;
 91     }
 92     err = input_register_device(ps_data->ps_input_dev);
 93     if (err<0)
 94     {
 95         printk(KERN_ERR "%s: can not register ps input device\n", __func__);
 96         goto err_als_input_allocate;
 97     }
 98 
 99     err = sysfs_create_group(&ps_data->als_input_dev->dev.kobj, &stk_als_attribute_group);
100     if (err < 0)
101     {
102         printk(KERN_ERR "%s:could not create sysfs group for als\n", __func__);
103         goto err_als_input_allocate;
104     }
105     err = sysfs_create_group(&ps_data->ps_input_dev->dev.kobj, &stk_ps_attribute_group);
106     if (err < 0)
107     {
108         printk(KERN_ERR "%s:could not create sysfs group for ps\n", __func__);
109         goto err_ps_sysfs_create_group;
110     }
111     input_set_drvdata(ps_data->als_input_dev, ps_data);
112     input_set_drvdata(ps_data->ps_input_dev, ps_data);
113 
114 #ifdef STK_POLL_ALS
115     ps_data->stk_als_wq = create_singlethread_workqueue("stk_als_wq");
116     INIT_WORK(&ps_data->stk_als_work, stk_als_work_func);
117     hrtimer_init(&ps_data->als_timer, CLOCK_MONOTONIC, HRTIMER_MODE_REL);
118     ps_data->als_poll_delay = ns_to_ktime(110 * NSEC_PER_MSEC);
119     ps_data->als_timer.function = stk_als_timer_func;
120 #endif
121 
122     ps_data->stk_ps_wq = create_singlethread_workqueue("stk_ps_wq");
123     INIT_WORK(&ps_data->stk_ps_work, stk_ps_work_func);
124     hrtimer_init(&ps_data->ps_timer, CLOCK_MONOTONIC, HRTIMER_MODE_REL);
125     ps_data->ps_poll_delay = ns_to_ktime(110 * NSEC_PER_MSEC);
126     ps_data->ps_timer.function = stk_ps_timer_func;
127 #if (!defined(STK_POLL_ALS) || !defined(STK_POLL_PS))
128     ps_data->stk_wq = create_singlethread_workqueue("stk_wq");
129     INIT_WORK(&ps_data->stk_work, stk_work_func);
130     err = stk3x1x_setup_irq(client);
131     if(err < 0)
132         goto err_stk3x1x_setup_irq;
133 #endif
134 
135     err = stk3x1x_power_init(ps_data, true);
136     if (err)
137         goto err_power_init;
138 
139     err = stk3x1x_power_ctl(ps_data, true);
140     if (err)
141         goto err_power_on;
142 
143     ps_data->als_enabled = false;
144     ps_data->ps_enabled = false;
145 #ifdef CONFIG_HAS_EARLYSUSPEND
146     ps_data->stk_early_suspend.level = EARLY_SUSPEND_LEVEL_BLANK_SCREEN + 1;
147     ps_data->stk_early_suspend.suspend = stk3x1x_early_suspend;
148     ps_data->stk_early_suspend.resume = stk3x1x_late_resume;
149     register_early_suspend(&ps_data->stk_early_suspend);
150 #endif
151     /* make sure everything is ok before registering the class device */
152     ps_data->als_cdev = sensors_light_cdev;
153     ps_data->als_cdev.sensors_enable = stk_als_enable_set;
154     ps_data->als_cdev.sensors_poll_delay = stk_als_poll_delay_set;
155     err = sensors_classdev_register(&client->dev, &ps_data->als_cdev);
156     if (err)
157         goto err_power_on;
158 
159     ps_data->ps_cdev = sensors_proximity_cdev;
160     ps_data->ps_cdev.sensors_enable = stk_ps_enable_set;
161     err = sensors_classdev_register(&client->dev, &ps_data->ps_cdev);
162     if (err)
163         goto err_class_sysfs;
164 
165     /* enable device power only when it is enabled */
166     err = stk3x1x_power_ctl(ps_data, false);
167     if (err)
168         goto err_init_all_setting;
169 
170     dev_dbg(&client->dev, "%s: probe successfully", __func__);
171 
172     return 0;
173 
174 err_init_all_setting:
175     stk3x1x_power_ctl(ps_data, false);
176     sensors_classdev_unregister(&ps_data->ps_cdev);
177 err_class_sysfs:
178     sensors_classdev_unregister(&ps_data->als_cdev);
179 err_power_on:
180     stk3x1x_power_init(ps_data, false);
181 err_power_init:
182 #ifndef STK_POLL_PS
183     free_irq(ps_data->irq, ps_data);
184     gpio_free(plat_data->int_pin);
185 #endif
186 #if (!defined(STK_POLL_ALS) || !defined(STK_POLL_PS))
187 err_stk3x1x_setup_irq:
188 #endif
189 #ifdef STK_POLL_ALS
190     hrtimer_try_to_cancel(&ps_data->als_timer);
191     destroy_workqueue(ps_data->stk_als_wq);
192 #endif
193     destroy_workqueue(ps_data->stk_ps_wq);
194 #if (!defined(STK_POLL_ALS) || !defined(STK_POLL_PS))
195     destroy_workqueue(ps_data->stk_wq);
196 #endif
197     sysfs_remove_group(&ps_data->ps_input_dev->dev.kobj, &stk_ps_attribute_group);
198 err_ps_sysfs_create_group:
199     sysfs_remove_group(&ps_data->als_input_dev->dev.kobj, &stk_als_attribute_group);
200 err_als_input_allocate:
201 #ifdef STK_POLL_PS
202     wake_lock_destroy(&ps_data->ps_nosuspend_wl);
203 #endif
204     wake_lock_destroy(&ps_data->ps_wakelock);
205     mutex_destroy(&ps_data->io_lock);
206     kfree(ps_data);
207     return err;
208 }
View Code

 在stk3x1x_probe函数中主要做了:

1、为驱动私有数据结构体stk3x1x_data分配内存空间;

2、 将设备驱动的私有数据(stk3x1x_data)连接到设备client(i2c_client)中;(bma255会增加一步:读取i2c的id);

3、将stk3x1x驱动注册到linux input子系统;

4、创建工作队列(主要是对sensor的数据采集);

5、创建sysfs接口;

2.1 创建input子系统:

http://blog.csdn.net/ielife/article/details/7798952

1、 在驱动加载模块中,设置你的input设备支持的事件类型;

2、 注册中断处理函数,例如键盘设备需要编写按键的抬起、放下,触摸屏设备需要编写按下、抬起、绝对移动,鼠标设备需要编写单击、抬起、相对移动,并且需要在必要的时候提交硬件数据(键值/坐标/状态等等);

3、将输入设备注册到输入子系统中;

 1   ps_data->als_input_dev = devm_input_allocate_device(&client->dev);    //分配内存空间
 2     if (ps_data->als_input_dev==NULL)
 3     {
 4         printk(KERN_ERR "%s: could not allocate als device\n", __func__);
 5         err = -ENOMEM;
 6         goto err_als_input_allocate;
 7     }
 8     ps_data->ps_input_dev = devm_input_allocate_device(&client->dev);
 9     if (ps_data->ps_input_dev==NULL)
10     {
11         printk(KERN_ERR "%s: could not allocate ps device\n", __func__);
12         err = -ENOMEM;
13         goto err_als_input_allocate;
14     }
15     ps_data->als_input_dev->name = ALS_NAME;     
16     ps_data->ps_input_dev->name = PS_NAME;
17     set_bit(EV_ABS, ps_data->als_input_dev->evbit);
18     set_bit(EV_ABS, ps_data->ps_input_dev->evbit);
19     input_set_abs_params(ps_data->als_input_dev, ABS_MISC, 0, stk_alscode2lux(ps_data, (1<<16)-1), 0, 0);    //设置input加载类型;
20     input_set_abs_params(ps_data->ps_input_dev, ABS_DISTANCE, 0,1, 0, 0);
21     err = input_register_device(ps_data->als_input_dev);
22     if (err<0)
23     {
24         printk(KERN_ERR "%s: can not register als input device\n", __func__);
25         goto err_als_input_allocate;
26     }
27     err = input_register_device(ps_data->ps_input_dev);
28     if (err<0)
29     {
30         printk(KERN_ERR "%s: can not register ps input device\n", __func__);
31         goto err_als_input_allocate;
32     }
1     err = stk3x1x_setup_irq(client);        //设置驱动中断函数
2     if(err < 0)
3         goto err_stk3x1x_setup_irq;

 

 

 

2.2 创建工作队列:

先提一个问题,为什么要创建工作队列?在前面的介绍中我们知道,sensor传感器获取数据后,将数据传给controller的寄存器中,供主控去查询读取数据。所以这里创建的工作队列,就是在一个工作者线程,通过IIC不断的去查询读取controller上的数据。

工作队列的作用就是把工作推后,交由一个内核线程去执行,更直接的说就是如果写了一个函数,而现在不想马上执行它,想在将来某个时刻去执行它,那用工作队列准没错.大概会想到中断也是这样,提供一个中断服务函数,在发生中断的时候去执行,没错,和中断相比,工作队列最大的好处就是可以调度可以睡眠,灵活性更好。

上面代码中我们看到INIT_WORK(&ps_data->stk_ps_work, stk_ps_work_func);,其实是一个宏的定义,在include/linux/workqueue.h中。stk_ps_work_func()就是我们定义的功能函数,用于查询读取Sensor的距离传感器数据的,并上报Input子系统,代码如下:

 1 static void stk_ps_work_func(struct work_struct *work)
 2 {
 3     struct stk3x1x_data *ps_data = container_of(work, struct stk3x1x_data, stk_ps_work);
 4     uint32_t reading;
 5     int32_t near_far_state;
 6     uint8_t org_flag_reg;
 7     int32_t ret;
 8     uint8_t disable_flag = 0;
 9     mutex_lock(&ps_data->io_lock);
10 
11     org_flag_reg = stk3x1x_get_flag(ps_data);
12     if(org_flag_reg < 0)
13     {
14         printk(KERN_ERR "%s: get_status_reg fail, ret=%d", __func__, org_flag_reg);
15         goto err_i2c_rw;
16     }
17     near_far_state = (org_flag_reg & STK_FLG_NF_MASK)?1:0;
18     reading = stk3x1x_get_ps_reading(ps_data);
19     if(ps_data->ps_distance_last != near_far_state)
20     {
21         ps_data->ps_distance_last = near_far_state;
22         input_report_abs(ps_data->ps_input_dev, ABS_DISTANCE, near_far_state);    //input上报数据
23         input_sync(ps_data->ps_input_dev);                    //input_sync()在这里不起关键作用。但如果是一个触摸屏,即有x坐标和y坐标,则需要通过input_sync()函数把x和y坐标完整地传递给输入子系统。
24         wake_lock_timeout(&ps_data->ps_wakelock, 3*HZ);
25 #ifdef STK_DEBUG_PRINTF
26         printk(KERN_INFO "%s: ps input event %d cm, ps code = %d\n",__func__, near_far_state, reading);
27 #endif
28     }
29     ret = stk3x1x_set_flag(ps_data, org_flag_reg, disable_flag);
30     if(ret < 0)
31     {
32         printk(KERN_ERR "%s:stk3x1x_set_flag fail, ret=%d\n", __func__, ret);
33         goto err_i2c_rw;
34     }
35 
36     mutex_unlock(&ps_data->io_lock);
37     return;
38 
39 err_i2c_rw:
40     mutex_unlock(&ps_data->io_lock);
41     msleep(30);
42     return;
43 }

 

 2.3 创建sysfs接口:

为什么要创建sysfs接口?在驱动层创建了sysfs接口,HAL层通过这些sysfs接口,对Sensor进行操作,如使能、设置delay等。

 

DEVICE_ATTR的使用:http://blog.csdn.net/njuitjf/article/details/16849333

 

函数宏DEVICE_ATTR内封装的是__ATTR(_name,_mode,_show,_stroe)方法:

 _show:表示的是读方法,_stroe表示的是写方法。

1、 调用宏DEVICE_ATTR完成对功能函数的注册:

 1 static struct device_attribute ps_enable_attribute = __ATTR(enable,0664,stk_ps_enable_show,stk_ps_enable_store);
 2 static struct device_attribute ps_enable_aso_attribute = __ATTR(enableaso,0664,stk_ps_enable_aso_show,stk_ps_enable_aso_store);
 3 static struct device_attribute ps_distance_attribute = __ATTR(distance,0664,stk_ps_distance_show, stk_ps_distance_store);
 4 static struct device_attribute ps_offset_attribute = __ATTR(offset,0664,stk_ps_offset_show, stk_ps_offset_store);
 5 static struct device_attribute ps_code_attribute = __ATTR(code, 0444, stk_ps_code_show, NULL);
 6 static struct device_attribute ps_code_thd_l_attribute = __ATTR(codethdl,0664,stk_ps_code_thd_l_show,stk_ps_code_thd_l_store);
 7 static struct device_attribute ps_code_thd_h_attribute = __ATTR(codethdh,0664,stk_ps_code_thd_h_show,stk_ps_code_thd_h_store);
 8 static struct device_attribute recv_attribute = __ATTR(recv,0664,stk_recv_show,stk_recv_store);
 9 static struct device_attribute send_attribute = __ATTR(send,0664,stk_send_show, stk_send_store);
10 static struct device_attribute all_reg_attribute = __ATTR(allreg, 0444, stk_all_reg_show, NULL);
11 
12 static struct attribute *stk_ps_attrs [] =
13 {
14     &ps_enable_attribute.attr,
15     &ps_enable_aso_attribute.attr,
16     &ps_distance_attribute.attr,
17     &ps_offset_attribute.attr,
18     &ps_code_attribute.attr,
19     &ps_code_thd_l_attribute.attr,
20     &ps_code_thd_h_attribute.attr,
21     &recv_attribute.attr,
22     &send_attribute.attr,
23     &all_reg_attribute.attr,
24     NULL
25 };
26 
27 static struct attribute_group stk_ps_attribute_group = {
28     .attrs = stk_ps_attrs,
29 };

 

在probe函数中:

 1   err = sysfs_create_group(&ps_data->als_input_dev->dev.kobj, &stk_als_attribute_group);
 2     if (err < 0)
 3     {
 4         printk(KERN_ERR "%s:could not create sysfs group for als\n", __func__);
 5         goto err_als_input_allocate;
 6     }
 7     err = sysfs_create_group(&ps_data->ps_input_dev->dev.kobj, &stk_ps_attribute_group);
 8     if (err < 0)
 9     {
10         printk(KERN_ERR "%s:could not create sysfs group for ps\n", __func__);
11         goto err_ps_sysfs_create_group;
12     }

 

到此,完成了sysfs接口的创建,我们可以在根文件系统中看到/sys/class/input/input1/目录,在该目录下我们可以看到多个节点,其中就包含了enable和delay。我们以enable为例子,可以有两种方法完成对Gsensor的使能工作:

 

3、读取上报数据:

Android的HAL层,通过对/sys/class/input/input3/enable节点的写操作,使能sensor。调用到的方法是stk_ps_enable_store函数:

 1 static struct device_attribute ps_enable_attribute = __ATTR(enable,0664,stk_ps_enable_show,stk_ps_enable_store);
 2 static struct device_attribute ps_enable_aso_attribute = __ATTR(enableaso,0664,stk_ps_enable_aso_show,stk_ps_enable_aso_store);
 3 static struct device_attribute ps_distance_attribute = __ATTR(distance,0664,stk_ps_distance_show, stk_ps_distance_store);
 4 static struct device_attribute ps_offset_attribute = __ATTR(offset,0664,stk_ps_offset_show, stk_ps_offset_store);
 5 static struct device_attribute ps_code_attribute = __ATTR(code, 0444, stk_ps_code_show, NULL);
 6 static struct device_attribute ps_code_thd_l_attribute = __ATTR(codethdl,0664,stk_ps_code_thd_l_show,stk_ps_code_thd_l_store);
 7 static struct device_attribute ps_code_thd_h_attribute = __ATTR(codethdh,0664,stk_ps_code_thd_h_show,stk_ps_code_thd_h_store);
 8 static struct device_attribute recv_attribute = __ATTR(recv,0664,stk_recv_show,stk_recv_store);
 9 static struct device_attribute send_attribute = __ATTR(send,0664,stk_send_show, stk_send_store);
10 static struct device_attribute all_reg_attribute = __ATTR(allreg, 0444, stk_all_reg_show, NULL);

 

 里面的show和store函数;

 1 static ssize_t stk_ps_enable_store(struct device *dev, struct device_attribute *attr, const char *buf, size_t size)
 2 {
 3     struct stk3x1x_data *ps_data =  dev_get_drvdata(dev);
 4     uint8_t en;
 5     if (sysfs_streq(buf, "1"))
 6         en = 1;
 7     else if (sysfs_streq(buf, "0"))
 8         en = 0;
 9     else
10     {
11         printk(KERN_ERR "%s, invalid value %d\n", __func__, *buf);
12         return -EINVAL;
13     }
14     dev_dbg(dev, "%s: Enable PS : %d\n", __func__, en);
15     mutex_lock(&ps_data->io_lock);
16     stk3x1x_enable_ps(ps_data, en);
17     mutex_unlock(&ps_data->io_lock);
18     return size;
19 }

 

 1 static int32_t stk3x1x_enable_ps(struct stk3x1x_data *ps_data, uint8_t enable)
 2 {
 3     int32_t ret;
 4     uint8_t w_state_reg;
 5     uint8_t curr_ps_enable;
 6     curr_ps_enable = ps_data->ps_enabled?1:0;
 7     if(curr_ps_enable == enable)
 8         return 0;
 9 
10     if (enable) {
11         ret = stk3x1x_device_ctl(ps_data, enable);
12         if (ret)
13             return ret;
14     }
15 
16     ret = i2c_smbus_read_byte_data(ps_data->client, STK_STATE_REG);
17     if (ret < 0)
18     {
19             printk(KERN_ERR "%s: write i2c error, ret=%d\n", __func__, ret);
20         return ret;
21     }
22     w_state_reg = ret;
23     w_state_reg &= ~(STK_STATE_EN_PS_MASK | STK_STATE_EN_WAIT_MASK | 0x60);
24     if(enable)
25     {
26         w_state_reg |= STK_STATE_EN_PS_MASK;
27         if(!(ps_data->als_enabled))
28             w_state_reg |= STK_STATE_EN_WAIT_MASK;
29     }
30     ret = i2c_smbus_write_byte_data(ps_data->client, STK_STATE_REG, w_state_reg);
31     if (ret < 0)
32     {
33         printk(KERN_ERR "%s: write i2c error, ret=%d\n", __func__, ret);
34         return ret;
35     }
36 
37     if(enable)
38     {
39 #ifdef STK_POLL_PS
40         hrtimer_start(&ps_data->ps_timer, ps_data->ps_poll_delay, HRTIMER_MODE_REL);    //定时一段时间后,开始开启工作队列
41         ps_data->ps_distance_last = -1;
42 #endif
43         ps_data->ps_enabled = true;
44 #ifndef STK_POLL_PS
45 #ifndef STK_POLL_ALS
46         if(!(ps_data->als_enabled))
47 #endif    /* #ifndef STK_POLL_ALS    */
48             enable_irq(ps_data->irq);
49         msleep(1);
50         ret = stk3x1x_get_flag(ps_data);
51         if (ret < 0)
52         {
53             printk(KERN_ERR "%s: read i2c error, ret=%d\n", __func__, ret);
54             return ret;
55         }
56 
57         near_far_state = ret & STK_FLG_NF_MASK;
58         ps_data->ps_distance_last = near_far_state;
59         input_report_abs(ps_data->ps_input_dev, ABS_DISTANCE, near_far_state);
60         input_sync(ps_data->ps_input_dev);
61         wake_lock_timeout(&ps_data->ps_wakelock, 3*HZ);
62         reading = stk3x1x_get_ps_reading(ps_data);
63         dev_dbg(&ps_data->client->dev,
64             "%s: ps input event=%d, ps code = %d\n",
65             __func__, near_far_state, reading);
66 #endif    /* #ifndef STK_POLL_PS */
67     }
68     else
69     {
70 #ifdef STK_POLL_PS
71         hrtimer_cancel(&ps_data->ps_timer);
72 #else
73 #ifndef STK_POLL_ALS
74         if(!(ps_data->als_enabled))
75 #endif
76             disable_irq(ps_data->irq);
77 #endif
78         ps_data->ps_enabled = false;
79     }
80     if (!enable) {
81         ret = stk3x1x_device_ctl(ps_data, enable);
82         if (ret)
83             return ret;
84     }
85 
86     return ret;
87 }
1 static enum hrtimer_restart stk_als_timer_func(struct hrtimer *timer)
2 {
3     struct stk3x1x_data *ps_data = container_of(timer, struct stk3x1x_data, als_timer);
4     queue_work(ps_data->stk_als_wq, &ps_data->stk_als_work);        //开启工作队列
5     hrtimer_forward_now(&ps_data->als_timer, ps_data->als_poll_delay);
6     return HRTIMER_RESTART;
7 }

 

那么对于HAL层,将通过/dev/input/event1设备节点读取到sensor数据。到此,sensor驱动的工作流程完毕。应该很好理解吧!

 

posted @ 2018-01-17 18:57  yooooooo  阅读(2244)  评论(0编辑  收藏  举报