2 * A sensor driver for the magnetometer AK8975.
4 * Magnetic compass sensor driver for monitoring magnetic flux information.
6 * Copyright (c) 2010, NVIDIA Corporation.
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License as published by
10 * the Free Software Foundation; either version 2 of the License, or
11 * (at your option) any later version.
13 * This program is distributed in the hope that it will be useful, but WITHOUT
14 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
15 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
18 * You should have received a copy of the GNU General Public License along
19 * with this program; if not, write to the Free Software Foundation, Inc.,
20 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA.
23 #include <linux/module.h>
24 #include <linux/kernel.h>
25 #include <linux/slab.h>
26 #include <linux/i2c.h>
27 #include <linux/interrupt.h>
28 #include <linux/err.h>
29 #include <linux/mutex.h>
30 #include <linux/delay.h>
31 #include <linux/bitops.h>
32 #include <linux/gpio.h>
33 #include <linux/of_gpio.h>
34 #include <linux/acpi.h>
35 #include <linux/regulator/consumer.h>
36 #include <linux/pm_runtime.h>
38 #include <linux/iio/iio.h>
39 #include <linux/iio/sysfs.h>
40 #include <linux/iio/buffer.h>
41 #include <linux/iio/trigger.h>
42 #include <linux/iio/trigger_consumer.h>
43 #include <linux/iio/triggered_buffer.h>
45 #include <linux/iio/magnetometer/ak8975.h>
48 * Register definitions, as well as various shifts and masks to get at the
49 * individual fields of the registers.
51 #define AK8975_REG_WIA 0x00
52 #define AK8975_DEVICE_ID 0x48
54 #define AK8975_REG_INFO 0x01
56 #define AK8975_REG_ST1 0x02
57 #define AK8975_REG_ST1_DRDY_SHIFT 0
58 #define AK8975_REG_ST1_DRDY_MASK (1 << AK8975_REG_ST1_DRDY_SHIFT)
60 #define AK8975_REG_HXL 0x03
61 #define AK8975_REG_HXH 0x04
62 #define AK8975_REG_HYL 0x05
63 #define AK8975_REG_HYH 0x06
64 #define AK8975_REG_HZL 0x07
65 #define AK8975_REG_HZH 0x08
66 #define AK8975_REG_ST2 0x09
67 #define AK8975_REG_ST2_DERR_SHIFT 2
68 #define AK8975_REG_ST2_DERR_MASK (1 << AK8975_REG_ST2_DERR_SHIFT)
70 #define AK8975_REG_ST2_HOFL_SHIFT 3
71 #define AK8975_REG_ST2_HOFL_MASK (1 << AK8975_REG_ST2_HOFL_SHIFT)
73 #define AK8975_REG_CNTL 0x0A
74 #define AK8975_REG_CNTL_MODE_SHIFT 0
75 #define AK8975_REG_CNTL_MODE_MASK (0xF << AK8975_REG_CNTL_MODE_SHIFT)
76 #define AK8975_REG_CNTL_MODE_POWER_DOWN 0x00
77 #define AK8975_REG_CNTL_MODE_ONCE 0x01
78 #define AK8975_REG_CNTL_MODE_SELF_TEST 0x08
79 #define AK8975_REG_CNTL_MODE_FUSE_ROM 0x0F
81 #define AK8975_REG_RSVC 0x0B
82 #define AK8975_REG_ASTC 0x0C
83 #define AK8975_REG_TS1 0x0D
84 #define AK8975_REG_TS2 0x0E
85 #define AK8975_REG_I2CDIS 0x0F
86 #define AK8975_REG_ASAX 0x10
87 #define AK8975_REG_ASAY 0x11
88 #define AK8975_REG_ASAZ 0x12
90 #define AK8975_MAX_REGS AK8975_REG_ASAZ
93 * AK09912 Register definitions
95 #define AK09912_REG_WIA1 0x00
96 #define AK09912_REG_WIA2 0x01
97 #define AK09912_DEVICE_ID 0x04
98 #define AK09911_DEVICE_ID 0x05
100 #define AK09911_REG_INFO1 0x02
101 #define AK09911_REG_INFO2 0x03
103 #define AK09912_REG_ST1 0x10
105 #define AK09912_REG_ST1_DRDY_SHIFT 0
106 #define AK09912_REG_ST1_DRDY_MASK (1 << AK09912_REG_ST1_DRDY_SHIFT)
108 #define AK09912_REG_HXL 0x11
109 #define AK09912_REG_HXH 0x12
110 #define AK09912_REG_HYL 0x13
111 #define AK09912_REG_HYH 0x14
112 #define AK09912_REG_HZL 0x15
113 #define AK09912_REG_HZH 0x16
114 #define AK09912_REG_TMPS 0x17
116 #define AK09912_REG_ST2 0x18
117 #define AK09912_REG_ST2_HOFL_SHIFT 3
118 #define AK09912_REG_ST2_HOFL_MASK (1 << AK09912_REG_ST2_HOFL_SHIFT)
120 #define AK09912_REG_CNTL1 0x30
122 #define AK09912_REG_CNTL2 0x31
123 #define AK09912_REG_CNTL_MODE_POWER_DOWN 0x00
124 #define AK09912_REG_CNTL_MODE_ONCE 0x01
125 #define AK09912_REG_CNTL_MODE_SELF_TEST 0x10
126 #define AK09912_REG_CNTL_MODE_FUSE_ROM 0x1F
127 #define AK09912_REG_CNTL2_MODE_SHIFT 0
128 #define AK09912_REG_CNTL2_MODE_MASK (0x1F << AK09912_REG_CNTL2_MODE_SHIFT)
130 #define AK09912_REG_CNTL3 0x32
132 #define AK09912_REG_TS1 0x33
133 #define AK09912_REG_TS2 0x34
134 #define AK09912_REG_TS3 0x35
135 #define AK09912_REG_I2CDIS 0x36
136 #define AK09912_REG_TS4 0x37
138 #define AK09912_REG_ASAX 0x60
139 #define AK09912_REG_ASAY 0x61
140 #define AK09912_REG_ASAZ 0x62
142 #define AK09912_MAX_REGS AK09912_REG_ASAZ
145 * Miscellaneous values.
147 #define AK8975_MAX_CONVERSION_TIMEOUT 500
148 #define AK8975_CONVERSION_DONE_POLL_TIME 10
149 #define AK8975_DATA_READY_TIMEOUT ((100*HZ)/1000)
152 * Precalculate scale factor (in Gauss units) for each axis and
153 * store in the device data.
155 * This scale factor is axis-dependent, and is derived from 3 calibration
156 * factors ASA(x), ASA(y), and ASA(z).
158 * These ASA values are read from the sensor device at start of day, and
159 * cached in the device context struct.
161 * Adjusting the flux value with the sensitivity adjustment value should be
162 * done via the following formula:
164 * Hadj = H * ( ( ( (ASA-128)*0.5 ) / 128 ) + 1 )
165 * where H is the raw value, ASA is the sensitivity adjustment, and Hadj
166 * is the resultant adjusted value.
168 * We reduce the formula to:
170 * Hadj = H * (ASA + 128) / 256
172 * H is in the range of -4096 to 4095. The magnetometer has a range of
173 * +-1229uT. To go from the raw value to uT is:
175 * HuT = H * 1229/4096, or roughly, 3/10.
177 * Since 1uT = 0.01 gauss, our final scale factor becomes:
179 * Hadj = H * ((ASA + 128) / 256) * 3/10 * 1/100
180 * Hadj = H * ((ASA + 128) * 0.003) / 256
182 * Since ASA doesn't change, we cache the resultant scale factor into the
183 * device context in ak8975_setup().
185 * Given we use IIO_VAL_INT_PLUS_MICRO bit when displaying the scale, we
186 * multiply the stored scale value by 1e6.
188 static long ak8975_raw_to_gauss(u16 data
)
190 return (((long)data
+ 128) * 3000) / 256;
194 * For AK8963 and AK09911, same calculation, but the device is less sensitive:
196 * H is in the range of +-8190. The magnetometer has a range of
197 * +-4912uT. To go from the raw value to uT is:
199 * HuT = H * 4912/8190, or roughly, 6/10, instead of 3/10.
202 static long ak8963_09911_raw_to_gauss(u16 data
)
204 return (((long)data
+ 128) * 6000) / 256;
208 * For AK09912, same calculation, except the device is more sensitive:
210 * H is in the range of -32752 to 32752. The magnetometer has a range of
211 * +-4912uT. To go from the raw value to uT is:
213 * HuT = H * 4912/32752, or roughly, 3/20, instead of 3/10.
215 static long ak09912_raw_to_gauss(u16 data
)
217 return (((long)data
+ 128) * 1500) / 256;
220 /* Compatible Asahi Kasei Compass parts */
221 enum asahi_compass_chipset
{
229 enum ak_ctrl_reg_addr
{
238 enum ak_ctrl_reg_mask
{
255 enum asahi_compass_chipset type
;
256 long (*raw_to_gauss
)(u16 data
);
258 u8 ctrl_regs
[REGS_END
];
259 u8 ctrl_masks
[MASK_END
];
260 u8 ctrl_modes
[MODE_END
];
264 static const struct ak_def ak_def_array
[AK_MAX_TYPE
] = {
267 .raw_to_gauss
= ak8975_raw_to_gauss
,
276 AK8975_REG_ST1_DRDY_MASK
,
277 AK8975_REG_ST2_HOFL_MASK
,
278 AK8975_REG_ST2_DERR_MASK
,
279 AK8975_REG_CNTL_MODE_MASK
},
281 AK8975_REG_CNTL_MODE_POWER_DOWN
,
282 AK8975_REG_CNTL_MODE_ONCE
,
283 AK8975_REG_CNTL_MODE_SELF_TEST
,
284 AK8975_REG_CNTL_MODE_FUSE_ROM
},
292 .raw_to_gauss
= ak8963_09911_raw_to_gauss
,
301 AK8975_REG_ST1_DRDY_MASK
,
302 AK8975_REG_ST2_HOFL_MASK
,
304 AK8975_REG_CNTL_MODE_MASK
},
306 AK8975_REG_CNTL_MODE_POWER_DOWN
,
307 AK8975_REG_CNTL_MODE_ONCE
,
308 AK8975_REG_CNTL_MODE_SELF_TEST
,
309 AK8975_REG_CNTL_MODE_FUSE_ROM
},
317 .raw_to_gauss
= ak8963_09911_raw_to_gauss
,
326 AK09912_REG_ST1_DRDY_MASK
,
327 AK09912_REG_ST2_HOFL_MASK
,
329 AK09912_REG_CNTL2_MODE_MASK
},
331 AK09912_REG_CNTL_MODE_POWER_DOWN
,
332 AK09912_REG_CNTL_MODE_ONCE
,
333 AK09912_REG_CNTL_MODE_SELF_TEST
,
334 AK09912_REG_CNTL_MODE_FUSE_ROM
},
342 .raw_to_gauss
= ak09912_raw_to_gauss
,
351 AK09912_REG_ST1_DRDY_MASK
,
352 AK09912_REG_ST2_HOFL_MASK
,
354 AK09912_REG_CNTL2_MODE_MASK
},
356 AK09912_REG_CNTL_MODE_POWER_DOWN
,
357 AK09912_REG_CNTL_MODE_ONCE
,
358 AK09912_REG_CNTL_MODE_SELF_TEST
,
359 AK09912_REG_CNTL_MODE_FUSE_ROM
},
368 * Per-instance context data for the device.
371 struct i2c_client
*client
;
372 const struct ak_def
*def
;
375 long raw_to_gauss
[3];
378 wait_queue_head_t data_ready_queue
;
381 struct iio_mount_matrix orientation
;
382 struct regulator
*vdd
;
383 struct regulator
*vid
;
386 /* Enable attached power regulator if any. */
387 static int ak8975_power_on(const struct ak8975_data
*data
)
391 ret
= regulator_enable(data
->vdd
);
393 dev_warn(&data
->client
->dev
,
394 "Failed to enable specified Vdd supply\n");
397 ret
= regulator_enable(data
->vid
);
399 dev_warn(&data
->client
->dev
,
400 "Failed to enable specified Vid supply\n");
404 * According to the datasheet the power supply rise time i 200us
405 * and the minimum wait time before mode setting is 100us, in
406 * total 300 us. Add some margin and say minimum 500us here.
408 usleep_range(500, 1000);
412 /* Disable attached power regulator if any. */
413 static void ak8975_power_off(const struct ak8975_data
*data
)
415 regulator_disable(data
->vid
);
416 regulator_disable(data
->vdd
);
420 * Return 0 if the i2c device is the one we expect.
421 * return a negative error number otherwise
423 static int ak8975_who_i_am(struct i2c_client
*client
,
424 enum asahi_compass_chipset type
)
430 * Signature for each device:
431 * Device | WIA1 | WIA2
432 * AK09912 | DEVICE_ID | AK09912_DEVICE_ID
433 * AK09911 | DEVICE_ID | AK09911_DEVICE_ID
434 * AK8975 | DEVICE_ID | NA
435 * AK8963 | DEVICE_ID | NA
437 ret
= i2c_smbus_read_i2c_block_data_or_emulated(
438 client
, AK09912_REG_WIA1
, 2, wia_val
);
440 dev_err(&client
->dev
, "Error reading WIA\n");
444 if (wia_val
[0] != AK8975_DEVICE_ID
)
452 if (wia_val
[1] == AK09911_DEVICE_ID
)
456 if (wia_val
[1] == AK09912_DEVICE_ID
)
460 dev_err(&client
->dev
, "Type %d unknown\n", type
);
466 * Helper function to write to CNTL register.
468 static int ak8975_set_mode(struct ak8975_data
*data
, enum ak_ctrl_mode mode
)
473 regval
= (data
->cntl_cache
& ~data
->def
->ctrl_masks
[CNTL_MODE
]) |
474 data
->def
->ctrl_modes
[mode
];
475 ret
= i2c_smbus_write_byte_data(data
->client
,
476 data
->def
->ctrl_regs
[CNTL
], regval
);
480 data
->cntl_cache
= regval
;
481 /* After mode change wait atleast 100us */
482 usleep_range(100, 500);
488 * Handle data ready irq
490 static irqreturn_t
ak8975_irq_handler(int irq
, void *data
)
492 struct ak8975_data
*ak8975
= data
;
494 set_bit(0, &ak8975
->flags
);
495 wake_up(&ak8975
->data_ready_queue
);
501 * Install data ready interrupt handler
503 static int ak8975_setup_irq(struct ak8975_data
*data
)
505 struct i2c_client
*client
= data
->client
;
509 init_waitqueue_head(&data
->data_ready_queue
);
510 clear_bit(0, &data
->flags
);
514 irq
= gpio_to_irq(data
->eoc_gpio
);
516 rc
= devm_request_irq(&client
->dev
, irq
, ak8975_irq_handler
,
517 IRQF_TRIGGER_RISING
| IRQF_ONESHOT
,
518 dev_name(&client
->dev
), data
);
520 dev_err(&client
->dev
,
521 "irq %d request failed, (gpio %d): %d\n",
522 irq
, data
->eoc_gpio
, rc
);
533 * Perform some start-of-day setup, including reading the asa calibration
534 * values and caching them.
536 static int ak8975_setup(struct i2c_client
*client
)
538 struct iio_dev
*indio_dev
= i2c_get_clientdata(client
);
539 struct ak8975_data
*data
= iio_priv(indio_dev
);
542 /* Write the fused rom access mode. */
543 ret
= ak8975_set_mode(data
, FUSE_ROM
);
545 dev_err(&client
->dev
, "Error in setting fuse access mode\n");
549 /* Get asa data and store in the device data. */
550 ret
= i2c_smbus_read_i2c_block_data_or_emulated(
551 client
, data
->def
->ctrl_regs
[ASA_BASE
],
554 dev_err(&client
->dev
, "Not able to read asa data\n");
558 /* After reading fuse ROM data set power-down mode */
559 ret
= ak8975_set_mode(data
, POWER_DOWN
);
561 dev_err(&client
->dev
, "Error in setting power-down mode\n");
565 if (data
->eoc_gpio
> 0 || client
->irq
> 0) {
566 ret
= ak8975_setup_irq(data
);
568 dev_err(&client
->dev
,
569 "Error setting data ready interrupt\n");
574 data
->raw_to_gauss
[0] = data
->def
->raw_to_gauss(data
->asa
[0]);
575 data
->raw_to_gauss
[1] = data
->def
->raw_to_gauss(data
->asa
[1]);
576 data
->raw_to_gauss
[2] = data
->def
->raw_to_gauss(data
->asa
[2]);
581 static int wait_conversion_complete_gpio(struct ak8975_data
*data
)
583 struct i2c_client
*client
= data
->client
;
584 u32 timeout_ms
= AK8975_MAX_CONVERSION_TIMEOUT
;
587 /* Wait for the conversion to complete. */
589 msleep(AK8975_CONVERSION_DONE_POLL_TIME
);
590 if (gpio_get_value(data
->eoc_gpio
))
592 timeout_ms
-= AK8975_CONVERSION_DONE_POLL_TIME
;
595 dev_err(&client
->dev
, "Conversion timeout happened\n");
599 ret
= i2c_smbus_read_byte_data(client
, data
->def
->ctrl_regs
[ST1
]);
601 dev_err(&client
->dev
, "Error in reading ST1\n");
606 static int wait_conversion_complete_polled(struct ak8975_data
*data
)
608 struct i2c_client
*client
= data
->client
;
610 u32 timeout_ms
= AK8975_MAX_CONVERSION_TIMEOUT
;
613 /* Wait for the conversion to complete. */
615 msleep(AK8975_CONVERSION_DONE_POLL_TIME
);
616 ret
= i2c_smbus_read_byte_data(client
,
617 data
->def
->ctrl_regs
[ST1
]);
619 dev_err(&client
->dev
, "Error in reading ST1\n");
625 timeout_ms
-= AK8975_CONVERSION_DONE_POLL_TIME
;
628 dev_err(&client
->dev
, "Conversion timeout happened\n");
635 /* Returns 0 if the end of conversion interrupt occured or -ETIME otherwise */
636 static int wait_conversion_complete_interrupt(struct ak8975_data
*data
)
640 ret
= wait_event_timeout(data
->data_ready_queue
,
641 test_bit(0, &data
->flags
),
642 AK8975_DATA_READY_TIMEOUT
);
643 clear_bit(0, &data
->flags
);
645 return ret
> 0 ? 0 : -ETIME
;
648 static int ak8975_start_read_axis(struct ak8975_data
*data
,
649 const struct i2c_client
*client
)
651 /* Set up the device for taking a sample. */
652 int ret
= ak8975_set_mode(data
, MODE_ONCE
);
655 dev_err(&client
->dev
, "Error in setting operating mode\n");
659 /* Wait for the conversion to complete. */
661 ret
= wait_conversion_complete_interrupt(data
);
662 else if (gpio_is_valid(data
->eoc_gpio
))
663 ret
= wait_conversion_complete_gpio(data
);
665 ret
= wait_conversion_complete_polled(data
);
669 /* This will be executed only for non-interrupt based waiting case */
670 if (ret
& data
->def
->ctrl_masks
[ST1_DRDY
]) {
671 ret
= i2c_smbus_read_byte_data(client
,
672 data
->def
->ctrl_regs
[ST2
]);
674 dev_err(&client
->dev
, "Error in reading ST2\n");
677 if (ret
& (data
->def
->ctrl_masks
[ST2_DERR
] |
678 data
->def
->ctrl_masks
[ST2_HOFL
])) {
679 dev_err(&client
->dev
, "ST2 status error 0x%x\n", ret
);
687 /* Retrieve raw flux value for one of the x, y, or z axis. */
688 static int ak8975_read_axis(struct iio_dev
*indio_dev
, int index
, int *val
)
690 struct ak8975_data
*data
= iio_priv(indio_dev
);
691 const struct i2c_client
*client
= data
->client
;
692 const struct ak_def
*def
= data
->def
;
697 pm_runtime_get_sync(&data
->client
->dev
);
699 mutex_lock(&data
->lock
);
701 ret
= ak8975_start_read_axis(data
, client
);
705 ret
= i2c_smbus_read_i2c_block_data_or_emulated(
706 client
, def
->data_regs
[index
],
707 sizeof(rval
), (u8
*)&rval
);
711 mutex_unlock(&data
->lock
);
713 pm_runtime_mark_last_busy(&data
->client
->dev
);
714 pm_runtime_put_autosuspend(&data
->client
->dev
);
716 /* Swap bytes and convert to valid range. */
717 buff
= le16_to_cpu(rval
);
718 *val
= clamp_t(s16
, buff
, -def
->range
, def
->range
);
722 mutex_unlock(&data
->lock
);
723 dev_err(&client
->dev
, "Error in reading axis\n");
727 static int ak8975_read_raw(struct iio_dev
*indio_dev
,
728 struct iio_chan_spec
const *chan
,
732 struct ak8975_data
*data
= iio_priv(indio_dev
);
735 case IIO_CHAN_INFO_RAW
:
736 return ak8975_read_axis(indio_dev
, chan
->address
, val
);
737 case IIO_CHAN_INFO_SCALE
:
739 *val2
= data
->raw_to_gauss
[chan
->address
];
740 return IIO_VAL_INT_PLUS_MICRO
;
745 static const struct iio_mount_matrix
*
746 ak8975_get_mount_matrix(const struct iio_dev
*indio_dev
,
747 const struct iio_chan_spec
*chan
)
749 return &((struct ak8975_data
*)iio_priv(indio_dev
))->orientation
;
752 static const struct iio_chan_spec_ext_info ak8975_ext_info
[] = {
753 IIO_MOUNT_MATRIX(IIO_SHARED_BY_DIR
, ak8975_get_mount_matrix
),
757 #define AK8975_CHANNEL(axis, index) \
761 .channel2 = IIO_MOD_##axis, \
762 .info_mask_separate = BIT(IIO_CHAN_INFO_RAW) | \
763 BIT(IIO_CHAN_INFO_SCALE), \
765 .scan_index = index, \
770 .endianness = IIO_CPU \
772 .ext_info = ak8975_ext_info, \
775 static const struct iio_chan_spec ak8975_channels
[] = {
776 AK8975_CHANNEL(X
, 0), AK8975_CHANNEL(Y
, 1), AK8975_CHANNEL(Z
, 2),
777 IIO_CHAN_SOFT_TIMESTAMP(3),
780 static const unsigned long ak8975_scan_masks
[] = { 0x7, 0 };
782 static const struct iio_info ak8975_info
= {
783 .read_raw
= &ak8975_read_raw
,
784 .driver_module
= THIS_MODULE
,
787 static const struct acpi_device_id ak_acpi_match
[] = {
790 {"INVN6500", AK8963
},
791 {"AK09911", AK09911
},
792 {"AK09912", AK09912
},
795 MODULE_DEVICE_TABLE(acpi
, ak_acpi_match
);
797 static const char *ak8975_match_acpi_device(struct device
*dev
,
798 enum asahi_compass_chipset
*chipset
)
800 const struct acpi_device_id
*id
;
802 id
= acpi_match_device(dev
->driver
->acpi_match_table
, dev
);
805 *chipset
= (int)id
->driver_data
;
807 return dev_name(dev
);
810 static void ak8975_fill_buffer(struct iio_dev
*indio_dev
)
812 struct ak8975_data
*data
= iio_priv(indio_dev
);
813 const struct i2c_client
*client
= data
->client
;
814 const struct ak_def
*def
= data
->def
;
816 s16 buff
[8]; /* 3 x 16 bits axis values + 1 aligned 64 bits timestamp */
819 mutex_lock(&data
->lock
);
821 ret
= ak8975_start_read_axis(data
, client
);
826 * For each axis, read the flux value from the appropriate register
827 * (the register is specified in the iio device attributes).
829 ret
= i2c_smbus_read_i2c_block_data_or_emulated(client
,
836 mutex_unlock(&data
->lock
);
838 /* Clamp to valid range. */
839 buff
[0] = clamp_t(s16
, le16_to_cpu(fval
[0]), -def
->range
, def
->range
);
840 buff
[1] = clamp_t(s16
, le16_to_cpu(fval
[1]), -def
->range
, def
->range
);
841 buff
[2] = clamp_t(s16
, le16_to_cpu(fval
[2]), -def
->range
, def
->range
);
843 iio_push_to_buffers_with_timestamp(indio_dev
, buff
,
844 iio_get_time_ns(indio_dev
));
848 mutex_unlock(&data
->lock
);
849 dev_err(&client
->dev
, "Error in reading axes block\n");
852 static irqreturn_t
ak8975_handle_trigger(int irq
, void *p
)
854 const struct iio_poll_func
*pf
= p
;
855 struct iio_dev
*indio_dev
= pf
->indio_dev
;
857 ak8975_fill_buffer(indio_dev
);
858 iio_trigger_notify_done(indio_dev
->trig
);
862 static int ak8975_probe(struct i2c_client
*client
,
863 const struct i2c_device_id
*id
)
865 struct ak8975_data
*data
;
866 struct iio_dev
*indio_dev
;
869 const char *name
= NULL
;
870 enum asahi_compass_chipset chipset
= AK_MAX_TYPE
;
871 const struct ak8975_platform_data
*pdata
=
872 dev_get_platdata(&client
->dev
);
874 /* Grab and set up the supplied GPIO. */
876 eoc_gpio
= pdata
->eoc_gpio
;
877 else if (client
->dev
.of_node
)
878 eoc_gpio
= of_get_gpio(client
->dev
.of_node
, 0);
882 if (eoc_gpio
== -EPROBE_DEFER
)
883 return -EPROBE_DEFER
;
885 /* We may not have a GPIO based IRQ to scan, that is fine, we will
887 if (gpio_is_valid(eoc_gpio
)) {
888 err
= devm_gpio_request_one(&client
->dev
, eoc_gpio
,
889 GPIOF_IN
, "ak_8975");
891 dev_err(&client
->dev
,
892 "failed to request GPIO %d, error %d\n",
898 /* Register with IIO */
899 indio_dev
= devm_iio_device_alloc(&client
->dev
, sizeof(*data
));
900 if (indio_dev
== NULL
)
903 data
= iio_priv(indio_dev
);
904 i2c_set_clientdata(client
, indio_dev
);
906 data
->client
= client
;
907 data
->eoc_gpio
= eoc_gpio
;
911 err
= of_iio_read_mount_matrix(&client
->dev
,
917 data
->orientation
= pdata
->orientation
;
919 /* id will be NULL when enumerated via ACPI */
921 chipset
= (enum asahi_compass_chipset
)(id
->driver_data
);
923 } else if (ACPI_HANDLE(&client
->dev
)) {
924 name
= ak8975_match_acpi_device(&client
->dev
, &chipset
);
930 if (chipset
>= AK_MAX_TYPE
) {
931 dev_err(&client
->dev
, "AKM device type unsupported: %d\n",
936 data
->def
= &ak_def_array
[chipset
];
938 /* Fetch the regulators */
939 data
->vdd
= devm_regulator_get(&client
->dev
, "vdd");
940 if (IS_ERR(data
->vdd
))
941 return PTR_ERR(data
->vdd
);
942 data
->vid
= devm_regulator_get(&client
->dev
, "vid");
943 if (IS_ERR(data
->vid
))
944 return PTR_ERR(data
->vid
);
946 err
= ak8975_power_on(data
);
950 err
= ak8975_who_i_am(client
, data
->def
->type
);
952 dev_err(&client
->dev
, "Unexpected device\n");
955 dev_dbg(&client
->dev
, "Asahi compass chip %s\n", name
);
957 /* Perform some basic start-of-day setup of the device. */
958 err
= ak8975_setup(client
);
960 dev_err(&client
->dev
, "%s initialization fails\n", name
);
964 mutex_init(&data
->lock
);
965 indio_dev
->dev
.parent
= &client
->dev
;
966 indio_dev
->channels
= ak8975_channels
;
967 indio_dev
->num_channels
= ARRAY_SIZE(ak8975_channels
);
968 indio_dev
->info
= &ak8975_info
;
969 indio_dev
->available_scan_masks
= ak8975_scan_masks
;
970 indio_dev
->modes
= INDIO_DIRECT_MODE
;
971 indio_dev
->name
= name
;
973 err
= iio_triggered_buffer_setup(indio_dev
, NULL
, ak8975_handle_trigger
,
976 dev_err(&client
->dev
, "triggered buffer setup failed\n");
980 err
= iio_device_register(indio_dev
);
982 dev_err(&client
->dev
, "device register failed\n");
986 /* Enable runtime PM */
987 pm_runtime_get_noresume(&client
->dev
);
988 pm_runtime_set_active(&client
->dev
);
989 pm_runtime_enable(&client
->dev
);
991 * The device comes online in 500us, so add two orders of magnitude
992 * of delay before autosuspending: 50 ms.
994 pm_runtime_set_autosuspend_delay(&client
->dev
, 50);
995 pm_runtime_use_autosuspend(&client
->dev
);
996 pm_runtime_put(&client
->dev
);
1001 iio_triggered_buffer_cleanup(indio_dev
);
1003 ak8975_power_off(data
);
1007 static int ak8975_remove(struct i2c_client
*client
)
1009 struct iio_dev
*indio_dev
= i2c_get_clientdata(client
);
1010 struct ak8975_data
*data
= iio_priv(indio_dev
);
1012 pm_runtime_get_sync(&client
->dev
);
1013 pm_runtime_put_noidle(&client
->dev
);
1014 pm_runtime_disable(&client
->dev
);
1015 iio_device_unregister(indio_dev
);
1016 iio_triggered_buffer_cleanup(indio_dev
);
1017 ak8975_set_mode(data
, POWER_DOWN
);
1018 ak8975_power_off(data
);
1024 static int ak8975_runtime_suspend(struct device
*dev
)
1026 struct i2c_client
*client
= to_i2c_client(dev
);
1027 struct iio_dev
*indio_dev
= i2c_get_clientdata(client
);
1028 struct ak8975_data
*data
= iio_priv(indio_dev
);
1031 /* Set the device in power down if it wasn't already */
1032 ret
= ak8975_set_mode(data
, POWER_DOWN
);
1034 dev_err(&client
->dev
, "Error in setting power-down mode\n");
1037 /* Next cut the regulators */
1038 ak8975_power_off(data
);
1043 static int ak8975_runtime_resume(struct device
*dev
)
1045 struct i2c_client
*client
= to_i2c_client(dev
);
1046 struct iio_dev
*indio_dev
= i2c_get_clientdata(client
);
1047 struct ak8975_data
*data
= iio_priv(indio_dev
);
1050 /* Take up the regulators */
1051 ak8975_power_on(data
);
1053 * We come up in powered down mode, the reading routines will
1054 * put us in the mode to read values later.
1056 ret
= ak8975_set_mode(data
, POWER_DOWN
);
1058 dev_err(&client
->dev
, "Error in setting power-down mode\n");
1064 #endif /* CONFIG_PM */
1066 static const struct dev_pm_ops ak8975_dev_pm_ops
= {
1067 SET_SYSTEM_SLEEP_PM_OPS(pm_runtime_force_suspend
,
1068 pm_runtime_force_resume
)
1069 SET_RUNTIME_PM_OPS(ak8975_runtime_suspend
,
1070 ak8975_runtime_resume
, NULL
)
1073 static const struct i2c_device_id ak8975_id
[] = {
1077 {"ak09911", AK09911
},
1078 {"ak09912", AK09912
},
1082 MODULE_DEVICE_TABLE(i2c
, ak8975_id
);
1084 static const struct of_device_id ak8975_of_match
[] = {
1085 { .compatible
= "asahi-kasei,ak8975", },
1086 { .compatible
= "ak8975", },
1087 { .compatible
= "asahi-kasei,ak8963", },
1088 { .compatible
= "ak8963", },
1089 { .compatible
= "asahi-kasei,ak09911", },
1090 { .compatible
= "ak09911", },
1091 { .compatible
= "asahi-kasei,ak09912", },
1092 { .compatible
= "ak09912", },
1095 MODULE_DEVICE_TABLE(of
, ak8975_of_match
);
1097 static struct i2c_driver ak8975_driver
= {
1100 .pm
= &ak8975_dev_pm_ops
,
1101 .of_match_table
= of_match_ptr(ak8975_of_match
),
1102 .acpi_match_table
= ACPI_PTR(ak_acpi_match
),
1104 .probe
= ak8975_probe
,
1105 .remove
= ak8975_remove
,
1106 .id_table
= ak8975_id
,
1108 module_i2c_driver(ak8975_driver
);
1110 MODULE_AUTHOR("Laxman Dewangan <ldewangan@nvidia.com>");
1111 MODULE_DESCRIPTION("AK8975 magnetometer driver");
1112 MODULE_LICENSE("GPL");