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