1*4882a593Smuzhiyun /* drivers/input/sensors/access/akm09911.c
2*4882a593Smuzhiyun *
3*4882a593Smuzhiyun * Copyright (C) 2012-2015 ROCKCHIP.
4*4882a593Smuzhiyun * Author: luowei <lw@rock-chips.com>
5*4882a593Smuzhiyun *
6*4882a593Smuzhiyun * This software is licensed under the terms of the GNU General Public
7*4882a593Smuzhiyun * License version 2, as published by the Free Software Foundation, and
8*4882a593Smuzhiyun * may be copied, distributed, and modified under those terms.
9*4882a593Smuzhiyun *
10*4882a593Smuzhiyun * This program is distributed in the hope that it will be useful,
11*4882a593Smuzhiyun * but WITHOUT ANY WARRANTY; without even the implied warranty of
12*4882a593Smuzhiyun * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
13*4882a593Smuzhiyun * GNU General Public License for more details.
14*4882a593Smuzhiyun *
15*4882a593Smuzhiyun */
16*4882a593Smuzhiyun #include <linux/interrupt.h>
17*4882a593Smuzhiyun #include <linux/i2c.h>
18*4882a593Smuzhiyun #include <linux/slab.h>
19*4882a593Smuzhiyun #include <linux/irq.h>
20*4882a593Smuzhiyun #include <linux/miscdevice.h>
21*4882a593Smuzhiyun #include <linux/gpio.h>
22*4882a593Smuzhiyun #include <linux/uaccess.h>
23*4882a593Smuzhiyun #include <linux/atomic.h>
24*4882a593Smuzhiyun #include <linux/delay.h>
25*4882a593Smuzhiyun #include <linux/input.h>
26*4882a593Smuzhiyun #include <linux/workqueue.h>
27*4882a593Smuzhiyun #include <linux/freezer.h>
28*4882a593Smuzhiyun #include <linux/of_gpio.h>
29*4882a593Smuzhiyun #ifdef CONFIG_HAS_EARLYSUSPEND
30*4882a593Smuzhiyun #include <linux/earlysuspend.h>
31*4882a593Smuzhiyun #endif
32*4882a593Smuzhiyun #include <linux/sensor-dev.h>
33*4882a593Smuzhiyun
34*4882a593Smuzhiyun #define SENSOR_DATA_SIZE 9
35*4882a593Smuzhiyun #define YPR_DATA_SIZE 16
36*4882a593Smuzhiyun #define RWBUF_SIZE 16
37*4882a593Smuzhiyun
38*4882a593Smuzhiyun #define ACC_DATA_FLAG 0
39*4882a593Smuzhiyun #define MAG_DATA_FLAG 1
40*4882a593Smuzhiyun #define ORI_DATA_FLAG 2
41*4882a593Smuzhiyun #define AKM_NUM_SENSORS 3
42*4882a593Smuzhiyun
43*4882a593Smuzhiyun #define ACC_DATA_READY (1 << (ACC_DATA_FLAG))
44*4882a593Smuzhiyun #define MAG_DATA_READY (1 << (MAG_DATA_FLAG))
45*4882a593Smuzhiyun #define ORI_DATA_READY (1 << (ORI_DATA_FLAG))
46*4882a593Smuzhiyun
47*4882a593Smuzhiyun /*Constant definitions of the AK09911.*/
48*4882a593Smuzhiyun #define AK09911_MEASUREMENT_TIME_US 10000
49*4882a593Smuzhiyun
50*4882a593Smuzhiyun #define AK09911_MODE_SNG_MEASURE 0x01
51*4882a593Smuzhiyun #define AK09911_MODE_SELF_TEST 0x10
52*4882a593Smuzhiyun #define AK09911_MODE_FUSE_ACCESS 0x1F
53*4882a593Smuzhiyun #define AK09911_MODE_POWERDOWN 0x00
54*4882a593Smuzhiyun #define AK09911_RESET_DATA 0x01
55*4882a593Smuzhiyun
56*4882a593Smuzhiyun /* Device specific constant values */
57*4882a593Smuzhiyun #define AK09911_REG_WIA1 0x00
58*4882a593Smuzhiyun #define AK09911_REG_WIA2 0x01
59*4882a593Smuzhiyun #define AK09911_REG_INFO1 0x02
60*4882a593Smuzhiyun #define AK09911_REG_INFO2 0x03
61*4882a593Smuzhiyun #define AK09911_REG_ST1 0x10
62*4882a593Smuzhiyun #define AK09911_REG_HXL 0x11
63*4882a593Smuzhiyun #define AK09911_REG_HXH 0x12
64*4882a593Smuzhiyun #define AK09911_REG_HYL 0x13
65*4882a593Smuzhiyun #define AK09911_REG_HYH 0x14
66*4882a593Smuzhiyun #define AK09911_REG_HZL 0x15
67*4882a593Smuzhiyun #define AK09911_REG_HZH 0x16
68*4882a593Smuzhiyun #define AK09911_REG_TMPS 0x17
69*4882a593Smuzhiyun #define AK09911_REG_ST2 0x18
70*4882a593Smuzhiyun #define AK09911_REG_CNTL1 0x30
71*4882a593Smuzhiyun #define AK09911_REG_CNTL2 0x31
72*4882a593Smuzhiyun #define AK09911_REG_CNTL3 0x32
73*4882a593Smuzhiyun
74*4882a593Smuzhiyun #define AK09911_FUSE_ASAX 0x60
75*4882a593Smuzhiyun #define AK09911_FUSE_ASAY 0x61
76*4882a593Smuzhiyun #define AK09911_FUSE_ASAZ 0x62
77*4882a593Smuzhiyun
78*4882a593Smuzhiyun #define AK09911_INFO_SIZE 2
79*4882a593Smuzhiyun #define AK09911_CONF_SIZE 3
80*4882a593Smuzhiyun
81*4882a593Smuzhiyun #define COMPASS_IOCTL_MAGIC 'c'
82*4882a593Smuzhiyun
83*4882a593Smuzhiyun /* IOCTLs for AKM library */
84*4882a593Smuzhiyun #define ECS_IOCTL_WRITE _IOW(COMPASS_IOCTL_MAGIC, 0x01, char*)
85*4882a593Smuzhiyun #define ECS_IOCTL_READ _IOWR(COMPASS_IOCTL_MAGIC, 0x02, char*)
86*4882a593Smuzhiyun #define ECS_IOCTL_RESET _IO(COMPASS_IOCTL_MAGIC, 0x03) /* NOT used in AK8975 */
87*4882a593Smuzhiyun #define ECS_IOCTL_SET_MODE _IOW(COMPASS_IOCTL_MAGIC, 0x04, short)
88*4882a593Smuzhiyun #define ECS_IOCTL_GETDATA _IOR(COMPASS_IOCTL_MAGIC, 0x05, char[8])
89*4882a593Smuzhiyun #define ECS_IOCTL_SET_YPR _IOW(COMPASS_IOCTL_MAGIC, 0x06, short[12])
90*4882a593Smuzhiyun #define ECS_IOCTL_GET_OPEN_STATUS _IOR(COMPASS_IOCTL_MAGIC, 0x07, int)
91*4882a593Smuzhiyun #define ECS_IOCTL_GET_CLOSE_STATUS _IOR(COMPASS_IOCTL_MAGIC, 0x08, int)
92*4882a593Smuzhiyun #define ECS_IOCTL_GET_LAYOUT _IOR(COMPASS_IOCTL_MAGIC, 0x09, char)
93*4882a593Smuzhiyun #define ECS_IOCTL_GET_ACCEL _IOR(COMPASS_IOCTL_MAGIC, 0x0A, short[3])
94*4882a593Smuzhiyun #define ECS_IOCTL_GET_OUTBIT _IOR(COMPASS_IOCTL_MAGIC, 0x0B, char)
95*4882a593Smuzhiyun #define ECS_IOCTL_GET_INFO _IOR(COMPASS_IOCTL_MAGIC, 0x27, unsigned char[AK09911_INFO_SIZE])
96*4882a593Smuzhiyun #define ECS_IOCTL_GET_CONF _IOR(COMPASS_IOCTL_MAGIC, 0x28, unsigned char[AK09911_CONF_SIZE])
97*4882a593Smuzhiyun #define ECS_IOCTL_GET_PLATFORM_DATA _IOR(COMPASS_IOCTL_MAGIC, 0x0E, struct akm_platform_data)
98*4882a593Smuzhiyun #define ECS_IOCTL_GET_DELAY _IOR(COMPASS_IOCTL_MAGIC, 0x30, short)
99*4882a593Smuzhiyun
100*4882a593Smuzhiyun #define AK09911_DEVICE_ID 0x05
101*4882a593Smuzhiyun static struct i2c_client *this_client;
102*4882a593Smuzhiyun static struct miscdevice compass_dev_device;
103*4882a593Smuzhiyun
104*4882a593Smuzhiyun static int g_akm_rbuf_ready;
105*4882a593Smuzhiyun static int g_akm_rbuf[12];
106*4882a593Smuzhiyun static char g_sensor_info[AK09911_INFO_SIZE];
107*4882a593Smuzhiyun static char g_sensor_conf[AK09911_CONF_SIZE];
108*4882a593Smuzhiyun
109*4882a593Smuzhiyun /****************operate according to sensor chip:start************/
sensor_active(struct i2c_client * client,int enable,int rate)110*4882a593Smuzhiyun static int sensor_active(struct i2c_client *client, int enable, int rate)
111*4882a593Smuzhiyun {
112*4882a593Smuzhiyun struct sensor_private_data *sensor =
113*4882a593Smuzhiyun (struct sensor_private_data *)i2c_get_clientdata(client);
114*4882a593Smuzhiyun int result = 0;
115*4882a593Smuzhiyun
116*4882a593Smuzhiyun if (enable)
117*4882a593Smuzhiyun sensor->ops->ctrl_data = AK09911_MODE_SNG_MEASURE;
118*4882a593Smuzhiyun else
119*4882a593Smuzhiyun sensor->ops->ctrl_data = AK09911_MODE_POWERDOWN;
120*4882a593Smuzhiyun
121*4882a593Smuzhiyun result = sensor_write_reg(client, sensor->ops->ctrl_reg, sensor->ops->ctrl_data);
122*4882a593Smuzhiyun if (result)
123*4882a593Smuzhiyun pr_err("%s:fail to active sensor\n", __func__);
124*4882a593Smuzhiyun
125*4882a593Smuzhiyun return result;
126*4882a593Smuzhiyun }
127*4882a593Smuzhiyun
sensor_init(struct i2c_client * client)128*4882a593Smuzhiyun static int sensor_init(struct i2c_client *client)
129*4882a593Smuzhiyun {
130*4882a593Smuzhiyun struct sensor_private_data *sensor =
131*4882a593Smuzhiyun (struct sensor_private_data *)i2c_get_clientdata(client);
132*4882a593Smuzhiyun int result = 0;
133*4882a593Smuzhiyun
134*4882a593Smuzhiyun this_client = client;
135*4882a593Smuzhiyun
136*4882a593Smuzhiyun result = sensor->ops->active(client, 0, 0);
137*4882a593Smuzhiyun if (result) {
138*4882a593Smuzhiyun pr_err("%s:line=%d,error\n", __func__, __LINE__);
139*4882a593Smuzhiyun return result;
140*4882a593Smuzhiyun }
141*4882a593Smuzhiyun
142*4882a593Smuzhiyun sensor->status_cur = SENSOR_OFF;
143*4882a593Smuzhiyun
144*4882a593Smuzhiyun result = misc_register(&compass_dev_device);
145*4882a593Smuzhiyun if (result < 0) {
146*4882a593Smuzhiyun pr_err("%s:fail to register misc device %s\n", __func__, compass_dev_device.name);
147*4882a593Smuzhiyun result = -1;
148*4882a593Smuzhiyun }
149*4882a593Smuzhiyun
150*4882a593Smuzhiyun g_sensor_info[0] = AK09911_REG_WIA1;
151*4882a593Smuzhiyun result = sensor_rx_data(client, g_sensor_info, AK09911_INFO_SIZE);
152*4882a593Smuzhiyun if (result) {
153*4882a593Smuzhiyun pr_err("%s:line=%d,error\n", __func__, __LINE__);
154*4882a593Smuzhiyun return result;
155*4882a593Smuzhiyun }
156*4882a593Smuzhiyun
157*4882a593Smuzhiyun g_sensor_conf[0] = AK09911_FUSE_ASAX;
158*4882a593Smuzhiyun result = sensor_rx_data(client, g_sensor_conf, AK09911_CONF_SIZE);
159*4882a593Smuzhiyun if (result) {
160*4882a593Smuzhiyun pr_err("%s:line=%d,error\n", __func__, __LINE__);
161*4882a593Smuzhiyun return result;
162*4882a593Smuzhiyun }
163*4882a593Smuzhiyun
164*4882a593Smuzhiyun return result;
165*4882a593Smuzhiyun }
166*4882a593Smuzhiyun
compass_report_value(void)167*4882a593Smuzhiyun static void compass_report_value(void)
168*4882a593Smuzhiyun {
169*4882a593Smuzhiyun struct sensor_private_data *sensor =
170*4882a593Smuzhiyun (struct sensor_private_data *)i2c_get_clientdata(this_client);
171*4882a593Smuzhiyun static int flag;
172*4882a593Smuzhiyun
173*4882a593Smuzhiyun if (!g_akm_rbuf_ready) {
174*4882a593Smuzhiyun pr_info("g_akm_rbuf not ready..............\n");
175*4882a593Smuzhiyun return;
176*4882a593Smuzhiyun }
177*4882a593Smuzhiyun
178*4882a593Smuzhiyun /* Report magnetic vector information */
179*4882a593Smuzhiyun if (atomic_read(&sensor->flags.mv_flag) && (g_akm_rbuf[0] & MAG_DATA_READY)) {
180*4882a593Smuzhiyun /*
181*4882a593Smuzhiyun *input dev will ignore report data if data value is the same with last_value,
182*4882a593Smuzhiyun *sample rate will not enough by this way, so just avoid this case
183*4882a593Smuzhiyun */
184*4882a593Smuzhiyun if ((sensor->axis.x == g_akm_rbuf[5]) &&
185*4882a593Smuzhiyun (sensor->axis.y == g_akm_rbuf[6]) && (sensor->axis.z == g_akm_rbuf[7])) {
186*4882a593Smuzhiyun if (flag) {
187*4882a593Smuzhiyun flag = 0;
188*4882a593Smuzhiyun sensor->axis.x += 1;
189*4882a593Smuzhiyun sensor->axis.y += 1;
190*4882a593Smuzhiyun sensor->axis.z += 1;
191*4882a593Smuzhiyun } else {
192*4882a593Smuzhiyun flag = 1;
193*4882a593Smuzhiyun sensor->axis.x -= 1;
194*4882a593Smuzhiyun sensor->axis.y -= 1;
195*4882a593Smuzhiyun sensor->axis.z -= 1;
196*4882a593Smuzhiyun }
197*4882a593Smuzhiyun } else {
198*4882a593Smuzhiyun sensor->axis.x = g_akm_rbuf[5];
199*4882a593Smuzhiyun sensor->axis.y = g_akm_rbuf[6];
200*4882a593Smuzhiyun sensor->axis.z = g_akm_rbuf[7];
201*4882a593Smuzhiyun }
202*4882a593Smuzhiyun input_report_abs(sensor->input_dev, ABS_HAT0X, sensor->axis.x);
203*4882a593Smuzhiyun input_report_abs(sensor->input_dev, ABS_HAT0Y, sensor->axis.y);
204*4882a593Smuzhiyun input_report_abs(sensor->input_dev, ABS_BRAKE, sensor->axis.z);
205*4882a593Smuzhiyun input_report_abs(sensor->input_dev, ABS_HAT1X, g_akm_rbuf[8]);
206*4882a593Smuzhiyun }
207*4882a593Smuzhiyun input_sync(sensor->input_dev);
208*4882a593Smuzhiyun }
209*4882a593Smuzhiyun
sensor_report_value(struct i2c_client * client)210*4882a593Smuzhiyun static int sensor_report_value(struct i2c_client *client)
211*4882a593Smuzhiyun {
212*4882a593Smuzhiyun struct sensor_private_data *sensor = (struct sensor_private_data *)i2c_get_clientdata(client);
213*4882a593Smuzhiyun char buffer[SENSOR_DATA_SIZE] = {0};
214*4882a593Smuzhiyun unsigned char *stat;
215*4882a593Smuzhiyun unsigned char *stat2;
216*4882a593Smuzhiyun int ret = 0;
217*4882a593Smuzhiyun char value = 0;
218*4882a593Smuzhiyun
219*4882a593Smuzhiyun mutex_lock(&sensor->data_mutex);
220*4882a593Smuzhiyun compass_report_value();
221*4882a593Smuzhiyun mutex_unlock(&sensor->data_mutex);
222*4882a593Smuzhiyun
223*4882a593Smuzhiyun if (sensor->ops->read_len < SENSOR_DATA_SIZE) {
224*4882a593Smuzhiyun pr_err("%s:length is error,len=%d\n", __func__, sensor->ops->read_len);
225*4882a593Smuzhiyun return -1;
226*4882a593Smuzhiyun }
227*4882a593Smuzhiyun
228*4882a593Smuzhiyun memset(buffer, 0, SENSOR_DATA_SIZE);
229*4882a593Smuzhiyun
230*4882a593Smuzhiyun /* Data bytes from hardware xL, xH, yL, yH, zL, zH */
231*4882a593Smuzhiyun do {
232*4882a593Smuzhiyun *buffer = sensor->ops->read_reg;
233*4882a593Smuzhiyun ret = sensor_rx_data(client, buffer, sensor->ops->read_len);
234*4882a593Smuzhiyun if (ret < 0)
235*4882a593Smuzhiyun return ret;
236*4882a593Smuzhiyun } while (0);
237*4882a593Smuzhiyun
238*4882a593Smuzhiyun stat = &buffer[0];
239*4882a593Smuzhiyun stat2 = &buffer[7];
240*4882a593Smuzhiyun
241*4882a593Smuzhiyun /*
242*4882a593Smuzhiyun * ST : data ready -
243*4882a593Smuzhiyun * Measurement has been completed and data is ready to be read.
244*4882a593Smuzhiyun */
245*4882a593Smuzhiyun if ((*stat & 0x01) != 0x01) {
246*4882a593Smuzhiyun pr_err("%s:ST is not set\n", __func__);
247*4882a593Smuzhiyun return -1;
248*4882a593Smuzhiyun }
249*4882a593Smuzhiyun
250*4882a593Smuzhiyun mutex_lock(&sensor->data_mutex);
251*4882a593Smuzhiyun memcpy(sensor->sensor_data, buffer, sensor->ops->read_len);
252*4882a593Smuzhiyun mutex_unlock(&sensor->data_mutex);
253*4882a593Smuzhiyun
254*4882a593Smuzhiyun if ((sensor->pdata->irq_enable) && (sensor->ops->int_status_reg >= 0))
255*4882a593Smuzhiyun value = sensor_read_reg(client, sensor->ops->int_status_reg);
256*4882a593Smuzhiyun
257*4882a593Smuzhiyun /* trigger next measurement */
258*4882a593Smuzhiyun ret = sensor_write_reg(client, sensor->ops->ctrl_reg, sensor->ops->ctrl_data);
259*4882a593Smuzhiyun if (ret) {
260*4882a593Smuzhiyun pr_err("%s:fail to set ctrl_data:0x%x\n", __func__, sensor->ops->ctrl_data);
261*4882a593Smuzhiyun return ret;
262*4882a593Smuzhiyun }
263*4882a593Smuzhiyun
264*4882a593Smuzhiyun return ret;
265*4882a593Smuzhiyun }
266*4882a593Smuzhiyun
compass_set_YPR(int * rbuf)267*4882a593Smuzhiyun static void compass_set_YPR(int *rbuf)
268*4882a593Smuzhiyun {
269*4882a593Smuzhiyun /* No events are reported */
270*4882a593Smuzhiyun if (!rbuf[0]) {
271*4882a593Smuzhiyun pr_info("%s:Don't waste a time.", __func__);
272*4882a593Smuzhiyun return;
273*4882a593Smuzhiyun }
274*4882a593Smuzhiyun
275*4882a593Smuzhiyun g_akm_rbuf_ready = 1;
276*4882a593Smuzhiyun memcpy(g_akm_rbuf, rbuf, 12 * sizeof(int));
277*4882a593Smuzhiyun }
278*4882a593Smuzhiyun
compass_dev_open(struct inode * inode,struct file * file)279*4882a593Smuzhiyun static int compass_dev_open(struct inode *inode, struct file *file)
280*4882a593Smuzhiyun {
281*4882a593Smuzhiyun return 0;
282*4882a593Smuzhiyun }
283*4882a593Smuzhiyun
compass_dev_release(struct inode * inode,struct file * file)284*4882a593Smuzhiyun static int compass_dev_release(struct inode *inode, struct file *file)
285*4882a593Smuzhiyun {
286*4882a593Smuzhiyun return 0;
287*4882a593Smuzhiyun }
288*4882a593Smuzhiyun
compass_akm_set_mode(struct i2c_client * client,char mode)289*4882a593Smuzhiyun static int compass_akm_set_mode(struct i2c_client *client, char mode)
290*4882a593Smuzhiyun {
291*4882a593Smuzhiyun struct sensor_private_data *sensor = (struct sensor_private_data *)i2c_get_clientdata(this_client);
292*4882a593Smuzhiyun int result = 0;
293*4882a593Smuzhiyun
294*4882a593Smuzhiyun switch (mode & 0x1f) {
295*4882a593Smuzhiyun case AK09911_MODE_SNG_MEASURE:
296*4882a593Smuzhiyun case AK09911_MODE_SELF_TEST:
297*4882a593Smuzhiyun case AK09911_MODE_FUSE_ACCESS:
298*4882a593Smuzhiyun if (sensor->status_cur == SENSOR_OFF) {
299*4882a593Smuzhiyun sensor->stop_work = 0;
300*4882a593Smuzhiyun sensor->status_cur = SENSOR_ON;
301*4882a593Smuzhiyun pr_info("compass ak09911 start measure");
302*4882a593Smuzhiyun schedule_delayed_work(&sensor->delaywork, 0);
303*4882a593Smuzhiyun }
304*4882a593Smuzhiyun break;
305*4882a593Smuzhiyun
306*4882a593Smuzhiyun case AK09911_MODE_POWERDOWN:
307*4882a593Smuzhiyun if (sensor->status_cur == SENSOR_ON) {
308*4882a593Smuzhiyun sensor->stop_work = 1;
309*4882a593Smuzhiyun cancel_delayed_work_sync(&sensor->delaywork);
310*4882a593Smuzhiyun pr_info("compass ak09911 stop measure");
311*4882a593Smuzhiyun g_akm_rbuf_ready = 0;
312*4882a593Smuzhiyun sensor->status_cur = SENSOR_OFF;
313*4882a593Smuzhiyun }
314*4882a593Smuzhiyun break;
315*4882a593Smuzhiyun }
316*4882a593Smuzhiyun
317*4882a593Smuzhiyun switch (mode & 0x1f) {
318*4882a593Smuzhiyun case AK09911_MODE_SNG_MEASURE:
319*4882a593Smuzhiyun result = sensor_write_reg(client, sensor->ops->ctrl_reg, AK09911_MODE_SNG_MEASURE);
320*4882a593Smuzhiyun if (result)
321*4882a593Smuzhiyun pr_err("%s:i2c error,mode=%d\n", __func__, mode);
322*4882a593Smuzhiyun break;
323*4882a593Smuzhiyun case AK09911_MODE_SELF_TEST:
324*4882a593Smuzhiyun result = sensor_write_reg(client, sensor->ops->ctrl_reg, AK09911_MODE_SELF_TEST);
325*4882a593Smuzhiyun if (result)
326*4882a593Smuzhiyun pr_err("%s:i2c error,mode=%d\n", __func__, mode);
327*4882a593Smuzhiyun break;
328*4882a593Smuzhiyun case AK09911_MODE_FUSE_ACCESS:
329*4882a593Smuzhiyun result = sensor_write_reg(client, sensor->ops->ctrl_reg, AK09911_MODE_FUSE_ACCESS);
330*4882a593Smuzhiyun if (result)
331*4882a593Smuzhiyun pr_err("%s:i2c error,mode=%d\n", __func__, mode);
332*4882a593Smuzhiyun break;
333*4882a593Smuzhiyun case AK09911_MODE_POWERDOWN:
334*4882a593Smuzhiyun /* Set powerdown mode */
335*4882a593Smuzhiyun result = sensor_write_reg(client, sensor->ops->ctrl_reg, AK09911_MODE_POWERDOWN);
336*4882a593Smuzhiyun if (result)
337*4882a593Smuzhiyun pr_err("%s:i2c error,mode=%d\n", __func__, mode);
338*4882a593Smuzhiyun udelay(100);
339*4882a593Smuzhiyun break;
340*4882a593Smuzhiyun default:
341*4882a593Smuzhiyun pr_info("%s: Unknown mode(%d)", __func__, mode);
342*4882a593Smuzhiyun result = -EINVAL;
343*4882a593Smuzhiyun break;
344*4882a593Smuzhiyun }
345*4882a593Smuzhiyun return result;
346*4882a593Smuzhiyun }
347*4882a593Smuzhiyun
compass_akm_reset(struct i2c_client * client)348*4882a593Smuzhiyun static int compass_akm_reset(struct i2c_client *client)
349*4882a593Smuzhiyun {
350*4882a593Smuzhiyun struct sensor_private_data *sensor = (struct sensor_private_data *)i2c_get_clientdata(this_client);
351*4882a593Smuzhiyun int result = 0;
352*4882a593Smuzhiyun
353*4882a593Smuzhiyun if (sensor->pdata->reset_pin > 0) {
354*4882a593Smuzhiyun gpio_direction_output(sensor->pdata->reset_pin, GPIO_LOW);
355*4882a593Smuzhiyun udelay(10);
356*4882a593Smuzhiyun gpio_direction_output(sensor->pdata->reset_pin, GPIO_HIGH);
357*4882a593Smuzhiyun } else {
358*4882a593Smuzhiyun /* Set measure mode */
359*4882a593Smuzhiyun result = sensor_write_reg(client, sensor->ops->ctrl_reg, AK09911_MODE_SNG_MEASURE);
360*4882a593Smuzhiyun if (result)
361*4882a593Smuzhiyun pr_err("%s:fail to Set measure mode\n", __func__);
362*4882a593Smuzhiyun }
363*4882a593Smuzhiyun
364*4882a593Smuzhiyun udelay(100);
365*4882a593Smuzhiyun
366*4882a593Smuzhiyun return result;
367*4882a593Smuzhiyun }
368*4882a593Smuzhiyun
compass_akm_get_openstatus(void)369*4882a593Smuzhiyun static int compass_akm_get_openstatus(void)
370*4882a593Smuzhiyun {
371*4882a593Smuzhiyun struct sensor_private_data *sensor = (struct sensor_private_data *)i2c_get_clientdata(this_client);
372*4882a593Smuzhiyun
373*4882a593Smuzhiyun wait_event_interruptible(sensor->flags.open_wq, (atomic_read(&sensor->flags.open_flag) != 0));
374*4882a593Smuzhiyun
375*4882a593Smuzhiyun return atomic_read(&sensor->flags.open_flag);
376*4882a593Smuzhiyun }
377*4882a593Smuzhiyun
compass_akm_get_closestatus(void)378*4882a593Smuzhiyun static int compass_akm_get_closestatus(void)
379*4882a593Smuzhiyun {
380*4882a593Smuzhiyun struct sensor_private_data *sensor = (struct sensor_private_data *)i2c_get_clientdata(this_client);
381*4882a593Smuzhiyun
382*4882a593Smuzhiyun wait_event_interruptible(sensor->flags.open_wq, (atomic_read(&sensor->flags.open_flag) <= 0));
383*4882a593Smuzhiyun
384*4882a593Smuzhiyun return atomic_read(&sensor->flags.open_flag);
385*4882a593Smuzhiyun }
386*4882a593Smuzhiyun
387*4882a593Smuzhiyun /* ioctl - I/O control */
compass_dev_ioctl(struct file * file,unsigned int cmd,unsigned long arg)388*4882a593Smuzhiyun static long compass_dev_ioctl(struct file *file, unsigned int cmd, unsigned long arg)
389*4882a593Smuzhiyun {
390*4882a593Smuzhiyun struct sensor_private_data *sensor = (struct sensor_private_data *)i2c_get_clientdata(this_client);
391*4882a593Smuzhiyun struct i2c_client *client = this_client;
392*4882a593Smuzhiyun void __user *argp = (void __user *)arg;
393*4882a593Smuzhiyun int result = 0;
394*4882a593Smuzhiyun struct akm_platform_data compass;
395*4882a593Smuzhiyun
396*4882a593Smuzhiyun /* NOTE: In this function the size of "char" should be 1-byte. */
397*4882a593Smuzhiyun char compass_data[SENSOR_DATA_SIZE]; /* for GETDATA */
398*4882a593Smuzhiyun char rwbuf[RWBUF_SIZE]; /* for READ/WRITE */
399*4882a593Smuzhiyun char mode; /* for SET_MODE*/
400*4882a593Smuzhiyun int value[YPR_DATA_SIZE]; /* for SET_YPR */
401*4882a593Smuzhiyun int status; /* for OPEN/CLOSE_STATUS */
402*4882a593Smuzhiyun int ret = -1; /* Return value. */
403*4882a593Smuzhiyun
404*4882a593Smuzhiyun int16_t acc_buf[3]; /* for GET_ACCEL */
405*4882a593Smuzhiyun int64_t delay[AKM_NUM_SENSORS]; /* for GET_DELAY */
406*4882a593Smuzhiyun char layout; /* for GET_LAYOUT */
407*4882a593Smuzhiyun char outbit; /* for GET_OUTBIT */
408*4882a593Smuzhiyun
409*4882a593Smuzhiyun switch (cmd) {
410*4882a593Smuzhiyun case ECS_IOCTL_WRITE:
411*4882a593Smuzhiyun case ECS_IOCTL_READ:
412*4882a593Smuzhiyun if (!argp)
413*4882a593Smuzhiyun return -EINVAL;
414*4882a593Smuzhiyun if (copy_from_user(&rwbuf, argp, sizeof(rwbuf)))
415*4882a593Smuzhiyun return -EFAULT;
416*4882a593Smuzhiyun break;
417*4882a593Smuzhiyun case ECS_IOCTL_SET_MODE:
418*4882a593Smuzhiyun if (!argp)
419*4882a593Smuzhiyun return -EINVAL;
420*4882a593Smuzhiyun if (copy_from_user(&mode, argp, sizeof(mode)))
421*4882a593Smuzhiyun return -EFAULT;
422*4882a593Smuzhiyun break;
423*4882a593Smuzhiyun case ECS_IOCTL_SET_YPR:
424*4882a593Smuzhiyun if (!argp)
425*4882a593Smuzhiyun return -EINVAL;
426*4882a593Smuzhiyun if (copy_from_user(&value, argp, sizeof(value)))
427*4882a593Smuzhiyun return -EFAULT;
428*4882a593Smuzhiyun break;
429*4882a593Smuzhiyun case ECS_IOCTL_GETDATA:
430*4882a593Smuzhiyun case ECS_IOCTL_GET_OPEN_STATUS:
431*4882a593Smuzhiyun case ECS_IOCTL_GET_CLOSE_STATUS:
432*4882a593Smuzhiyun case ECS_IOCTL_GET_DELAY:
433*4882a593Smuzhiyun case ECS_IOCTL_GET_LAYOUT:
434*4882a593Smuzhiyun case ECS_IOCTL_GET_OUTBIT:
435*4882a593Smuzhiyun case ECS_IOCTL_GET_ACCEL:
436*4882a593Smuzhiyun case ECS_IOCTL_GET_INFO:
437*4882a593Smuzhiyun case ECS_IOCTL_GET_CONF:
438*4882a593Smuzhiyun /* Just check buffer pointer */
439*4882a593Smuzhiyun if (!argp) {
440*4882a593Smuzhiyun pr_err("%s:invalid argument\n", __func__);
441*4882a593Smuzhiyun return -EINVAL;
442*4882a593Smuzhiyun }
443*4882a593Smuzhiyun break;
444*4882a593Smuzhiyun default:
445*4882a593Smuzhiyun break;
446*4882a593Smuzhiyun }
447*4882a593Smuzhiyun
448*4882a593Smuzhiyun switch (cmd) {
449*4882a593Smuzhiyun case ECS_IOCTL_WRITE:
450*4882a593Smuzhiyun mutex_lock(&sensor->operation_mutex);
451*4882a593Smuzhiyun if ((rwbuf[0] < 2) || (rwbuf[0] > (RWBUF_SIZE - 1))) {
452*4882a593Smuzhiyun mutex_unlock(&sensor->operation_mutex);
453*4882a593Smuzhiyun return -EINVAL;
454*4882a593Smuzhiyun }
455*4882a593Smuzhiyun ret = sensor_tx_data(client, &rwbuf[1], rwbuf[0]);
456*4882a593Smuzhiyun if (ret < 0) {
457*4882a593Smuzhiyun mutex_unlock(&sensor->operation_mutex);
458*4882a593Smuzhiyun pr_err("%s:fait to tx data\n", __func__);
459*4882a593Smuzhiyun return ret;
460*4882a593Smuzhiyun }
461*4882a593Smuzhiyun mutex_unlock(&sensor->operation_mutex);
462*4882a593Smuzhiyun break;
463*4882a593Smuzhiyun case ECS_IOCTL_READ:
464*4882a593Smuzhiyun mutex_lock(&sensor->operation_mutex);
465*4882a593Smuzhiyun if ((rwbuf[0] < 1) || (rwbuf[0] > (RWBUF_SIZE - 1))) {
466*4882a593Smuzhiyun mutex_unlock(&sensor->operation_mutex);
467*4882a593Smuzhiyun pr_err("%s:data is error\n", __func__);
468*4882a593Smuzhiyun return -EINVAL;
469*4882a593Smuzhiyun }
470*4882a593Smuzhiyun ret = sensor_rx_data(client, &rwbuf[1], rwbuf[0]);
471*4882a593Smuzhiyun if (ret < 0) {
472*4882a593Smuzhiyun mutex_unlock(&sensor->operation_mutex);
473*4882a593Smuzhiyun pr_err("%s:fait to rx data\n", __func__);
474*4882a593Smuzhiyun return ret;
475*4882a593Smuzhiyun }
476*4882a593Smuzhiyun mutex_unlock(&sensor->operation_mutex);
477*4882a593Smuzhiyun break;
478*4882a593Smuzhiyun case ECS_IOCTL_SET_MODE:
479*4882a593Smuzhiyun mutex_lock(&sensor->operation_mutex);
480*4882a593Smuzhiyun if (sensor->ops->ctrl_data != mode) {
481*4882a593Smuzhiyun ret = compass_akm_set_mode(client, mode);
482*4882a593Smuzhiyun if (ret < 0) {
483*4882a593Smuzhiyun pr_err("%s:fait to set mode\n", __func__);
484*4882a593Smuzhiyun mutex_unlock(&sensor->operation_mutex);
485*4882a593Smuzhiyun return ret;
486*4882a593Smuzhiyun }
487*4882a593Smuzhiyun
488*4882a593Smuzhiyun sensor->ops->ctrl_data = mode;
489*4882a593Smuzhiyun }
490*4882a593Smuzhiyun mutex_unlock(&sensor->operation_mutex);
491*4882a593Smuzhiyun break;
492*4882a593Smuzhiyun case ECS_IOCTL_GETDATA:
493*4882a593Smuzhiyun mutex_lock(&sensor->data_mutex);
494*4882a593Smuzhiyun memcpy(compass_data, sensor->sensor_data, SENSOR_DATA_SIZE);
495*4882a593Smuzhiyun mutex_unlock(&sensor->data_mutex);
496*4882a593Smuzhiyun break;
497*4882a593Smuzhiyun case ECS_IOCTL_SET_YPR:
498*4882a593Smuzhiyun mutex_lock(&sensor->data_mutex);
499*4882a593Smuzhiyun compass_set_YPR(value);
500*4882a593Smuzhiyun mutex_unlock(&sensor->data_mutex);
501*4882a593Smuzhiyun break;
502*4882a593Smuzhiyun case ECS_IOCTL_GET_OPEN_STATUS:
503*4882a593Smuzhiyun status = compass_akm_get_openstatus();
504*4882a593Smuzhiyun break;
505*4882a593Smuzhiyun case ECS_IOCTL_GET_CLOSE_STATUS:
506*4882a593Smuzhiyun status = compass_akm_get_closestatus();
507*4882a593Smuzhiyun break;
508*4882a593Smuzhiyun case ECS_IOCTL_GET_DELAY:
509*4882a593Smuzhiyun mutex_lock(&sensor->operation_mutex);
510*4882a593Smuzhiyun delay[0] = sensor->flags.delay;
511*4882a593Smuzhiyun delay[1] = sensor->flags.delay;
512*4882a593Smuzhiyun delay[2] = sensor->flags.delay;
513*4882a593Smuzhiyun mutex_unlock(&sensor->operation_mutex);
514*4882a593Smuzhiyun break;
515*4882a593Smuzhiyun
516*4882a593Smuzhiyun case ECS_IOCTL_GET_PLATFORM_DATA:
517*4882a593Smuzhiyun ret = copy_to_user(argp, &compass, sizeof(compass));
518*4882a593Smuzhiyun if (ret < 0) {
519*4882a593Smuzhiyun pr_err("%s:error,ret=%d\n", __func__, ret);
520*4882a593Smuzhiyun return ret;
521*4882a593Smuzhiyun }
522*4882a593Smuzhiyun break;
523*4882a593Smuzhiyun case ECS_IOCTL_GET_LAYOUT:
524*4882a593Smuzhiyun if ((sensor->pdata->layout >= 1) && (sensor->pdata->layout <= 8))
525*4882a593Smuzhiyun layout = sensor->pdata->layout;
526*4882a593Smuzhiyun else
527*4882a593Smuzhiyun layout = 1;
528*4882a593Smuzhiyun break;
529*4882a593Smuzhiyun case ECS_IOCTL_GET_OUTBIT:
530*4882a593Smuzhiyun outbit = 1;
531*4882a593Smuzhiyun break;
532*4882a593Smuzhiyun case ECS_IOCTL_RESET:
533*4882a593Smuzhiyun ret = compass_akm_reset(client);
534*4882a593Smuzhiyun if (ret < 0)
535*4882a593Smuzhiyun return ret;
536*4882a593Smuzhiyun break;
537*4882a593Smuzhiyun case ECS_IOCTL_GET_ACCEL:
538*4882a593Smuzhiyun break;
539*4882a593Smuzhiyun case ECS_IOCTL_GET_INFO:
540*4882a593Smuzhiyun ret = copy_to_user(argp, g_sensor_info, sizeof(g_sensor_info));
541*4882a593Smuzhiyun if (ret < 0) {
542*4882a593Smuzhiyun pr_err("%s:error,ret=%d\n", __func__, ret);
543*4882a593Smuzhiyun return ret;
544*4882a593Smuzhiyun }
545*4882a593Smuzhiyun break;
546*4882a593Smuzhiyun case ECS_IOCTL_GET_CONF:
547*4882a593Smuzhiyun ret = copy_to_user(argp, g_sensor_conf, sizeof(g_sensor_conf));
548*4882a593Smuzhiyun if (ret < 0) {
549*4882a593Smuzhiyun pr_err("%s:error,ret=%d\n", __func__, ret);
550*4882a593Smuzhiyun return ret;
551*4882a593Smuzhiyun }
552*4882a593Smuzhiyun break;
553*4882a593Smuzhiyun
554*4882a593Smuzhiyun default:
555*4882a593Smuzhiyun return -ENOTTY;
556*4882a593Smuzhiyun }
557*4882a593Smuzhiyun
558*4882a593Smuzhiyun switch (cmd) {
559*4882a593Smuzhiyun case ECS_IOCTL_READ:
560*4882a593Smuzhiyun if (copy_to_user(argp, &rwbuf, rwbuf[0] + 1))
561*4882a593Smuzhiyun return -EFAULT;
562*4882a593Smuzhiyun break;
563*4882a593Smuzhiyun case ECS_IOCTL_GETDATA:
564*4882a593Smuzhiyun if (copy_to_user(argp, &compass_data, sizeof(compass_data)))
565*4882a593Smuzhiyun return -EFAULT;
566*4882a593Smuzhiyun break;
567*4882a593Smuzhiyun case ECS_IOCTL_GET_OPEN_STATUS:
568*4882a593Smuzhiyun case ECS_IOCTL_GET_CLOSE_STATUS:
569*4882a593Smuzhiyun if (copy_to_user(argp, &status, sizeof(status)))
570*4882a593Smuzhiyun return -EFAULT;
571*4882a593Smuzhiyun break;
572*4882a593Smuzhiyun case ECS_IOCTL_GET_DELAY:
573*4882a593Smuzhiyun if (copy_to_user(argp, &delay, sizeof(delay)))
574*4882a593Smuzhiyun return -EFAULT;
575*4882a593Smuzhiyun break;
576*4882a593Smuzhiyun case ECS_IOCTL_GET_LAYOUT:
577*4882a593Smuzhiyun if (copy_to_user(argp, &layout, sizeof(layout))) {
578*4882a593Smuzhiyun pr_err("%s:error:%d\n", __func__, __LINE__);
579*4882a593Smuzhiyun return -EFAULT;
580*4882a593Smuzhiyun }
581*4882a593Smuzhiyun break;
582*4882a593Smuzhiyun case ECS_IOCTL_GET_OUTBIT:
583*4882a593Smuzhiyun if (copy_to_user(argp, &outbit, sizeof(outbit))) {
584*4882a593Smuzhiyun pr_err("%s:error:%d\n", __func__, __LINE__);
585*4882a593Smuzhiyun return -EFAULT;
586*4882a593Smuzhiyun }
587*4882a593Smuzhiyun break;
588*4882a593Smuzhiyun case ECS_IOCTL_GET_ACCEL:
589*4882a593Smuzhiyun if (copy_to_user(argp, &acc_buf, sizeof(acc_buf))) {
590*4882a593Smuzhiyun pr_err("%s:error:%d\n", __func__, __LINE__);
591*4882a593Smuzhiyun return -EFAULT;
592*4882a593Smuzhiyun }
593*4882a593Smuzhiyun break;
594*4882a593Smuzhiyun default:
595*4882a593Smuzhiyun break;
596*4882a593Smuzhiyun }
597*4882a593Smuzhiyun
598*4882a593Smuzhiyun return result;
599*4882a593Smuzhiyun }
600*4882a593Smuzhiyun
601*4882a593Smuzhiyun static const struct file_operations compass_dev_fops = {
602*4882a593Smuzhiyun .owner = THIS_MODULE,
603*4882a593Smuzhiyun .open = compass_dev_open,
604*4882a593Smuzhiyun .release = compass_dev_release,
605*4882a593Smuzhiyun .unlocked_ioctl = compass_dev_ioctl,
606*4882a593Smuzhiyun };
607*4882a593Smuzhiyun
608*4882a593Smuzhiyun static struct miscdevice compass_dev_device = {
609*4882a593Smuzhiyun .minor = MISC_DYNAMIC_MINOR,
610*4882a593Smuzhiyun .name = "akm_dev",
611*4882a593Smuzhiyun .fops = &compass_dev_fops,
612*4882a593Smuzhiyun };
613*4882a593Smuzhiyun
614*4882a593Smuzhiyun static struct sensor_operate compass_akm09911_ops = {
615*4882a593Smuzhiyun .name = "akm09911",
616*4882a593Smuzhiyun .type = SENSOR_TYPE_COMPASS,
617*4882a593Smuzhiyun .id_i2c = COMPASS_ID_AK09911,
618*4882a593Smuzhiyun .read_reg = AK09911_REG_ST1,
619*4882a593Smuzhiyun .read_len = SENSOR_DATA_SIZE,
620*4882a593Smuzhiyun .id_reg = AK09911_REG_WIA2,
621*4882a593Smuzhiyun .id_data = AK09911_DEVICE_ID,
622*4882a593Smuzhiyun .precision = 8,
623*4882a593Smuzhiyun .ctrl_reg = AK09911_REG_CNTL2,
624*4882a593Smuzhiyun .int_status_reg = SENSOR_UNKNOW_DATA,
625*4882a593Smuzhiyun .range = {-0xffff, 0xffff},
626*4882a593Smuzhiyun .trig = IRQF_TRIGGER_RISING,
627*4882a593Smuzhiyun .active = sensor_active,
628*4882a593Smuzhiyun .init = sensor_init,
629*4882a593Smuzhiyun .report = sensor_report_value,
630*4882a593Smuzhiyun .misc_dev = NULL,
631*4882a593Smuzhiyun };
632*4882a593Smuzhiyun
633*4882a593Smuzhiyun /****************operate according to sensor chip:end************/
compass_akm09911_probe(struct i2c_client * client,const struct i2c_device_id * devid)634*4882a593Smuzhiyun static int compass_akm09911_probe(struct i2c_client *client,
635*4882a593Smuzhiyun const struct i2c_device_id *devid)
636*4882a593Smuzhiyun {
637*4882a593Smuzhiyun return sensor_register_device(client, NULL, devid, &compass_akm09911_ops);
638*4882a593Smuzhiyun }
639*4882a593Smuzhiyun
compass_akm09911_remove(struct i2c_client * client)640*4882a593Smuzhiyun static int compass_akm09911_remove(struct i2c_client *client)
641*4882a593Smuzhiyun {
642*4882a593Smuzhiyun return sensor_unregister_device(client, NULL, &compass_akm09911_ops);
643*4882a593Smuzhiyun }
644*4882a593Smuzhiyun
645*4882a593Smuzhiyun static const struct i2c_device_id compass_akm09911_id[] = {
646*4882a593Smuzhiyun {"ak09911", COMPASS_ID_AK09911},
647*4882a593Smuzhiyun {}
648*4882a593Smuzhiyun };
649*4882a593Smuzhiyun
650*4882a593Smuzhiyun static struct i2c_driver compass_akm09911_driver = {
651*4882a593Smuzhiyun .probe = compass_akm09911_probe,
652*4882a593Smuzhiyun .remove = compass_akm09911_remove,
653*4882a593Smuzhiyun .shutdown = sensor_shutdown,
654*4882a593Smuzhiyun .id_table = compass_akm09911_id,
655*4882a593Smuzhiyun .driver = {
656*4882a593Smuzhiyun .name = "compass_akm09911",
657*4882a593Smuzhiyun #ifdef CONFIG_PM
658*4882a593Smuzhiyun .pm = &sensor_pm_ops,
659*4882a593Smuzhiyun #endif
660*4882a593Smuzhiyun },
661*4882a593Smuzhiyun };
662*4882a593Smuzhiyun
663*4882a593Smuzhiyun module_i2c_driver(compass_akm09911_driver);
664*4882a593Smuzhiyun
665*4882a593Smuzhiyun MODULE_AUTHOR("luowei <lw@rock-chips.com>");
666*4882a593Smuzhiyun MODULE_DESCRIPTION("akm09911 3-Axis compasss driver");
667*4882a593Smuzhiyun MODULE_LICENSE("GPL");
668