18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-or-later 28c2ecf20Sopenharmony_ci/* 38c2ecf20Sopenharmony_ci * A sensor driver for the magnetometer AK8975. 48c2ecf20Sopenharmony_ci * 58c2ecf20Sopenharmony_ci * Magnetic compass sensor driver for monitoring magnetic flux information. 68c2ecf20Sopenharmony_ci * 78c2ecf20Sopenharmony_ci * Copyright (c) 2010, NVIDIA Corporation. 88c2ecf20Sopenharmony_ci */ 98c2ecf20Sopenharmony_ci 108c2ecf20Sopenharmony_ci#include <linux/module.h> 118c2ecf20Sopenharmony_ci#include <linux/mod_devicetable.h> 128c2ecf20Sopenharmony_ci#include <linux/kernel.h> 138c2ecf20Sopenharmony_ci#include <linux/slab.h> 148c2ecf20Sopenharmony_ci#include <linux/i2c.h> 158c2ecf20Sopenharmony_ci#include <linux/interrupt.h> 168c2ecf20Sopenharmony_ci#include <linux/err.h> 178c2ecf20Sopenharmony_ci#include <linux/mutex.h> 188c2ecf20Sopenharmony_ci#include <linux/delay.h> 198c2ecf20Sopenharmony_ci#include <linux/bitops.h> 208c2ecf20Sopenharmony_ci#include <linux/gpio/consumer.h> 218c2ecf20Sopenharmony_ci#include <linux/regulator/consumer.h> 228c2ecf20Sopenharmony_ci#include <linux/pm_runtime.h> 238c2ecf20Sopenharmony_ci 248c2ecf20Sopenharmony_ci#include <linux/iio/iio.h> 258c2ecf20Sopenharmony_ci#include <linux/iio/sysfs.h> 268c2ecf20Sopenharmony_ci#include <linux/iio/buffer.h> 278c2ecf20Sopenharmony_ci#include <linux/iio/trigger.h> 288c2ecf20Sopenharmony_ci#include <linux/iio/trigger_consumer.h> 298c2ecf20Sopenharmony_ci#include <linux/iio/triggered_buffer.h> 308c2ecf20Sopenharmony_ci 318c2ecf20Sopenharmony_ci/* 328c2ecf20Sopenharmony_ci * Register definitions, as well as various shifts and masks to get at the 338c2ecf20Sopenharmony_ci * individual fields of the registers. 348c2ecf20Sopenharmony_ci */ 358c2ecf20Sopenharmony_ci#define AK8975_REG_WIA 0x00 368c2ecf20Sopenharmony_ci#define AK8975_DEVICE_ID 0x48 378c2ecf20Sopenharmony_ci 388c2ecf20Sopenharmony_ci#define AK8975_REG_INFO 0x01 398c2ecf20Sopenharmony_ci 408c2ecf20Sopenharmony_ci#define AK8975_REG_ST1 0x02 418c2ecf20Sopenharmony_ci#define AK8975_REG_ST1_DRDY_SHIFT 0 428c2ecf20Sopenharmony_ci#define AK8975_REG_ST1_DRDY_MASK (1 << AK8975_REG_ST1_DRDY_SHIFT) 438c2ecf20Sopenharmony_ci 448c2ecf20Sopenharmony_ci#define AK8975_REG_HXL 0x03 458c2ecf20Sopenharmony_ci#define AK8975_REG_HXH 0x04 468c2ecf20Sopenharmony_ci#define AK8975_REG_HYL 0x05 478c2ecf20Sopenharmony_ci#define AK8975_REG_HYH 0x06 488c2ecf20Sopenharmony_ci#define AK8975_REG_HZL 0x07 498c2ecf20Sopenharmony_ci#define AK8975_REG_HZH 0x08 508c2ecf20Sopenharmony_ci#define AK8975_REG_ST2 0x09 518c2ecf20Sopenharmony_ci#define AK8975_REG_ST2_DERR_SHIFT 2 528c2ecf20Sopenharmony_ci#define AK8975_REG_ST2_DERR_MASK (1 << AK8975_REG_ST2_DERR_SHIFT) 538c2ecf20Sopenharmony_ci 548c2ecf20Sopenharmony_ci#define AK8975_REG_ST2_HOFL_SHIFT 3 558c2ecf20Sopenharmony_ci#define AK8975_REG_ST2_HOFL_MASK (1 << AK8975_REG_ST2_HOFL_SHIFT) 568c2ecf20Sopenharmony_ci 578c2ecf20Sopenharmony_ci#define AK8975_REG_CNTL 0x0A 588c2ecf20Sopenharmony_ci#define AK8975_REG_CNTL_MODE_SHIFT 0 598c2ecf20Sopenharmony_ci#define AK8975_REG_CNTL_MODE_MASK (0xF << AK8975_REG_CNTL_MODE_SHIFT) 608c2ecf20Sopenharmony_ci#define AK8975_REG_CNTL_MODE_POWER_DOWN 0x00 618c2ecf20Sopenharmony_ci#define AK8975_REG_CNTL_MODE_ONCE 0x01 628c2ecf20Sopenharmony_ci#define AK8975_REG_CNTL_MODE_SELF_TEST 0x08 638c2ecf20Sopenharmony_ci#define AK8975_REG_CNTL_MODE_FUSE_ROM 0x0F 648c2ecf20Sopenharmony_ci 658c2ecf20Sopenharmony_ci#define AK8975_REG_RSVC 0x0B 668c2ecf20Sopenharmony_ci#define AK8975_REG_ASTC 0x0C 678c2ecf20Sopenharmony_ci#define AK8975_REG_TS1 0x0D 688c2ecf20Sopenharmony_ci#define AK8975_REG_TS2 0x0E 698c2ecf20Sopenharmony_ci#define AK8975_REG_I2CDIS 0x0F 708c2ecf20Sopenharmony_ci#define AK8975_REG_ASAX 0x10 718c2ecf20Sopenharmony_ci#define AK8975_REG_ASAY 0x11 728c2ecf20Sopenharmony_ci#define AK8975_REG_ASAZ 0x12 738c2ecf20Sopenharmony_ci 748c2ecf20Sopenharmony_ci#define AK8975_MAX_REGS AK8975_REG_ASAZ 758c2ecf20Sopenharmony_ci 768c2ecf20Sopenharmony_ci/* 778c2ecf20Sopenharmony_ci * AK09912 Register definitions 788c2ecf20Sopenharmony_ci */ 798c2ecf20Sopenharmony_ci#define AK09912_REG_WIA1 0x00 808c2ecf20Sopenharmony_ci#define AK09912_REG_WIA2 0x01 818c2ecf20Sopenharmony_ci#define AK09912_DEVICE_ID 0x04 828c2ecf20Sopenharmony_ci#define AK09911_DEVICE_ID 0x05 838c2ecf20Sopenharmony_ci 848c2ecf20Sopenharmony_ci#define AK09911_REG_INFO1 0x02 858c2ecf20Sopenharmony_ci#define AK09911_REG_INFO2 0x03 868c2ecf20Sopenharmony_ci 878c2ecf20Sopenharmony_ci#define AK09912_REG_ST1 0x10 888c2ecf20Sopenharmony_ci 898c2ecf20Sopenharmony_ci#define AK09912_REG_ST1_DRDY_SHIFT 0 908c2ecf20Sopenharmony_ci#define AK09912_REG_ST1_DRDY_MASK (1 << AK09912_REG_ST1_DRDY_SHIFT) 918c2ecf20Sopenharmony_ci 928c2ecf20Sopenharmony_ci#define AK09912_REG_HXL 0x11 938c2ecf20Sopenharmony_ci#define AK09912_REG_HXH 0x12 948c2ecf20Sopenharmony_ci#define AK09912_REG_HYL 0x13 958c2ecf20Sopenharmony_ci#define AK09912_REG_HYH 0x14 968c2ecf20Sopenharmony_ci#define AK09912_REG_HZL 0x15 978c2ecf20Sopenharmony_ci#define AK09912_REG_HZH 0x16 988c2ecf20Sopenharmony_ci#define AK09912_REG_TMPS 0x17 998c2ecf20Sopenharmony_ci 1008c2ecf20Sopenharmony_ci#define AK09912_REG_ST2 0x18 1018c2ecf20Sopenharmony_ci#define AK09912_REG_ST2_HOFL_SHIFT 3 1028c2ecf20Sopenharmony_ci#define AK09912_REG_ST2_HOFL_MASK (1 << AK09912_REG_ST2_HOFL_SHIFT) 1038c2ecf20Sopenharmony_ci 1048c2ecf20Sopenharmony_ci#define AK09912_REG_CNTL1 0x30 1058c2ecf20Sopenharmony_ci 1068c2ecf20Sopenharmony_ci#define AK09912_REG_CNTL2 0x31 1078c2ecf20Sopenharmony_ci#define AK09912_REG_CNTL_MODE_POWER_DOWN 0x00 1088c2ecf20Sopenharmony_ci#define AK09912_REG_CNTL_MODE_ONCE 0x01 1098c2ecf20Sopenharmony_ci#define AK09912_REG_CNTL_MODE_SELF_TEST 0x10 1108c2ecf20Sopenharmony_ci#define AK09912_REG_CNTL_MODE_FUSE_ROM 0x1F 1118c2ecf20Sopenharmony_ci#define AK09912_REG_CNTL2_MODE_SHIFT 0 1128c2ecf20Sopenharmony_ci#define AK09912_REG_CNTL2_MODE_MASK (0x1F << AK09912_REG_CNTL2_MODE_SHIFT) 1138c2ecf20Sopenharmony_ci 1148c2ecf20Sopenharmony_ci#define AK09912_REG_CNTL3 0x32 1158c2ecf20Sopenharmony_ci 1168c2ecf20Sopenharmony_ci#define AK09912_REG_TS1 0x33 1178c2ecf20Sopenharmony_ci#define AK09912_REG_TS2 0x34 1188c2ecf20Sopenharmony_ci#define AK09912_REG_TS3 0x35 1198c2ecf20Sopenharmony_ci#define AK09912_REG_I2CDIS 0x36 1208c2ecf20Sopenharmony_ci#define AK09912_REG_TS4 0x37 1218c2ecf20Sopenharmony_ci 1228c2ecf20Sopenharmony_ci#define AK09912_REG_ASAX 0x60 1238c2ecf20Sopenharmony_ci#define AK09912_REG_ASAY 0x61 1248c2ecf20Sopenharmony_ci#define AK09912_REG_ASAZ 0x62 1258c2ecf20Sopenharmony_ci 1268c2ecf20Sopenharmony_ci#define AK09912_MAX_REGS AK09912_REG_ASAZ 1278c2ecf20Sopenharmony_ci 1288c2ecf20Sopenharmony_ci/* 1298c2ecf20Sopenharmony_ci * Miscellaneous values. 1308c2ecf20Sopenharmony_ci */ 1318c2ecf20Sopenharmony_ci#define AK8975_MAX_CONVERSION_TIMEOUT 500 1328c2ecf20Sopenharmony_ci#define AK8975_CONVERSION_DONE_POLL_TIME 10 1338c2ecf20Sopenharmony_ci#define AK8975_DATA_READY_TIMEOUT ((100*HZ)/1000) 1348c2ecf20Sopenharmony_ci 1358c2ecf20Sopenharmony_ci/* 1368c2ecf20Sopenharmony_ci * Precalculate scale factor (in Gauss units) for each axis and 1378c2ecf20Sopenharmony_ci * store in the device data. 1388c2ecf20Sopenharmony_ci * 1398c2ecf20Sopenharmony_ci * This scale factor is axis-dependent, and is derived from 3 calibration 1408c2ecf20Sopenharmony_ci * factors ASA(x), ASA(y), and ASA(z). 1418c2ecf20Sopenharmony_ci * 1428c2ecf20Sopenharmony_ci * These ASA values are read from the sensor device at start of day, and 1438c2ecf20Sopenharmony_ci * cached in the device context struct. 1448c2ecf20Sopenharmony_ci * 1458c2ecf20Sopenharmony_ci * Adjusting the flux value with the sensitivity adjustment value should be 1468c2ecf20Sopenharmony_ci * done via the following formula: 1478c2ecf20Sopenharmony_ci * 1488c2ecf20Sopenharmony_ci * Hadj = H * ( ( ( (ASA-128)*0.5 ) / 128 ) + 1 ) 1498c2ecf20Sopenharmony_ci * where H is the raw value, ASA is the sensitivity adjustment, and Hadj 1508c2ecf20Sopenharmony_ci * is the resultant adjusted value. 1518c2ecf20Sopenharmony_ci * 1528c2ecf20Sopenharmony_ci * We reduce the formula to: 1538c2ecf20Sopenharmony_ci * 1548c2ecf20Sopenharmony_ci * Hadj = H * (ASA + 128) / 256 1558c2ecf20Sopenharmony_ci * 1568c2ecf20Sopenharmony_ci * H is in the range of -4096 to 4095. The magnetometer has a range of 1578c2ecf20Sopenharmony_ci * +-1229uT. To go from the raw value to uT is: 1588c2ecf20Sopenharmony_ci * 1598c2ecf20Sopenharmony_ci * HuT = H * 1229/4096, or roughly, 3/10. 1608c2ecf20Sopenharmony_ci * 1618c2ecf20Sopenharmony_ci * Since 1uT = 0.01 gauss, our final scale factor becomes: 1628c2ecf20Sopenharmony_ci * 1638c2ecf20Sopenharmony_ci * Hadj = H * ((ASA + 128) / 256) * 3/10 * 1/100 1648c2ecf20Sopenharmony_ci * Hadj = H * ((ASA + 128) * 0.003) / 256 1658c2ecf20Sopenharmony_ci * 1668c2ecf20Sopenharmony_ci * Since ASA doesn't change, we cache the resultant scale factor into the 1678c2ecf20Sopenharmony_ci * device context in ak8975_setup(). 1688c2ecf20Sopenharmony_ci * 1698c2ecf20Sopenharmony_ci * Given we use IIO_VAL_INT_PLUS_MICRO bit when displaying the scale, we 1708c2ecf20Sopenharmony_ci * multiply the stored scale value by 1e6. 1718c2ecf20Sopenharmony_ci */ 1728c2ecf20Sopenharmony_cistatic long ak8975_raw_to_gauss(u16 data) 1738c2ecf20Sopenharmony_ci{ 1748c2ecf20Sopenharmony_ci return (((long)data + 128) * 3000) / 256; 1758c2ecf20Sopenharmony_ci} 1768c2ecf20Sopenharmony_ci 1778c2ecf20Sopenharmony_ci/* 1788c2ecf20Sopenharmony_ci * For AK8963 and AK09911, same calculation, but the device is less sensitive: 1798c2ecf20Sopenharmony_ci * 1808c2ecf20Sopenharmony_ci * H is in the range of +-8190. The magnetometer has a range of 1818c2ecf20Sopenharmony_ci * +-4912uT. To go from the raw value to uT is: 1828c2ecf20Sopenharmony_ci * 1838c2ecf20Sopenharmony_ci * HuT = H * 4912/8190, or roughly, 6/10, instead of 3/10. 1848c2ecf20Sopenharmony_ci */ 1858c2ecf20Sopenharmony_ci 1868c2ecf20Sopenharmony_cistatic long ak8963_09911_raw_to_gauss(u16 data) 1878c2ecf20Sopenharmony_ci{ 1888c2ecf20Sopenharmony_ci return (((long)data + 128) * 6000) / 256; 1898c2ecf20Sopenharmony_ci} 1908c2ecf20Sopenharmony_ci 1918c2ecf20Sopenharmony_ci/* 1928c2ecf20Sopenharmony_ci * For AK09912, same calculation, except the device is more sensitive: 1938c2ecf20Sopenharmony_ci * 1948c2ecf20Sopenharmony_ci * H is in the range of -32752 to 32752. The magnetometer has a range of 1958c2ecf20Sopenharmony_ci * +-4912uT. To go from the raw value to uT is: 1968c2ecf20Sopenharmony_ci * 1978c2ecf20Sopenharmony_ci * HuT = H * 4912/32752, or roughly, 3/20, instead of 3/10. 1988c2ecf20Sopenharmony_ci */ 1998c2ecf20Sopenharmony_cistatic long ak09912_raw_to_gauss(u16 data) 2008c2ecf20Sopenharmony_ci{ 2018c2ecf20Sopenharmony_ci return (((long)data + 128) * 1500) / 256; 2028c2ecf20Sopenharmony_ci} 2038c2ecf20Sopenharmony_ci 2048c2ecf20Sopenharmony_ci/* Compatible Asahi Kasei Compass parts */ 2058c2ecf20Sopenharmony_cienum asahi_compass_chipset { 2068c2ecf20Sopenharmony_ci AKXXXX = 0, 2078c2ecf20Sopenharmony_ci AK8975, 2088c2ecf20Sopenharmony_ci AK8963, 2098c2ecf20Sopenharmony_ci AK09911, 2108c2ecf20Sopenharmony_ci AK09912, 2118c2ecf20Sopenharmony_ci}; 2128c2ecf20Sopenharmony_ci 2138c2ecf20Sopenharmony_cienum ak_ctrl_reg_addr { 2148c2ecf20Sopenharmony_ci ST1, 2158c2ecf20Sopenharmony_ci ST2, 2168c2ecf20Sopenharmony_ci CNTL, 2178c2ecf20Sopenharmony_ci ASA_BASE, 2188c2ecf20Sopenharmony_ci MAX_REGS, 2198c2ecf20Sopenharmony_ci REGS_END, 2208c2ecf20Sopenharmony_ci}; 2218c2ecf20Sopenharmony_ci 2228c2ecf20Sopenharmony_cienum ak_ctrl_reg_mask { 2238c2ecf20Sopenharmony_ci ST1_DRDY, 2248c2ecf20Sopenharmony_ci ST2_HOFL, 2258c2ecf20Sopenharmony_ci ST2_DERR, 2268c2ecf20Sopenharmony_ci CNTL_MODE, 2278c2ecf20Sopenharmony_ci MASK_END, 2288c2ecf20Sopenharmony_ci}; 2298c2ecf20Sopenharmony_ci 2308c2ecf20Sopenharmony_cienum ak_ctrl_mode { 2318c2ecf20Sopenharmony_ci POWER_DOWN, 2328c2ecf20Sopenharmony_ci MODE_ONCE, 2338c2ecf20Sopenharmony_ci SELF_TEST, 2348c2ecf20Sopenharmony_ci FUSE_ROM, 2358c2ecf20Sopenharmony_ci MODE_END, 2368c2ecf20Sopenharmony_ci}; 2378c2ecf20Sopenharmony_ci 2388c2ecf20Sopenharmony_cistruct ak_def { 2398c2ecf20Sopenharmony_ci enum asahi_compass_chipset type; 2408c2ecf20Sopenharmony_ci long (*raw_to_gauss)(u16 data); 2418c2ecf20Sopenharmony_ci u16 range; 2428c2ecf20Sopenharmony_ci u8 ctrl_regs[REGS_END]; 2438c2ecf20Sopenharmony_ci u8 ctrl_masks[MASK_END]; 2448c2ecf20Sopenharmony_ci u8 ctrl_modes[MODE_END]; 2458c2ecf20Sopenharmony_ci u8 data_regs[3]; 2468c2ecf20Sopenharmony_ci}; 2478c2ecf20Sopenharmony_ci 2488c2ecf20Sopenharmony_cistatic const struct ak_def ak_def_array[] = { 2498c2ecf20Sopenharmony_ci { 2508c2ecf20Sopenharmony_ci .type = AK8975, 2518c2ecf20Sopenharmony_ci .raw_to_gauss = ak8975_raw_to_gauss, 2528c2ecf20Sopenharmony_ci .range = 4096, 2538c2ecf20Sopenharmony_ci .ctrl_regs = { 2548c2ecf20Sopenharmony_ci AK8975_REG_ST1, 2558c2ecf20Sopenharmony_ci AK8975_REG_ST2, 2568c2ecf20Sopenharmony_ci AK8975_REG_CNTL, 2578c2ecf20Sopenharmony_ci AK8975_REG_ASAX, 2588c2ecf20Sopenharmony_ci AK8975_MAX_REGS}, 2598c2ecf20Sopenharmony_ci .ctrl_masks = { 2608c2ecf20Sopenharmony_ci AK8975_REG_ST1_DRDY_MASK, 2618c2ecf20Sopenharmony_ci AK8975_REG_ST2_HOFL_MASK, 2628c2ecf20Sopenharmony_ci AK8975_REG_ST2_DERR_MASK, 2638c2ecf20Sopenharmony_ci AK8975_REG_CNTL_MODE_MASK}, 2648c2ecf20Sopenharmony_ci .ctrl_modes = { 2658c2ecf20Sopenharmony_ci AK8975_REG_CNTL_MODE_POWER_DOWN, 2668c2ecf20Sopenharmony_ci AK8975_REG_CNTL_MODE_ONCE, 2678c2ecf20Sopenharmony_ci AK8975_REG_CNTL_MODE_SELF_TEST, 2688c2ecf20Sopenharmony_ci AK8975_REG_CNTL_MODE_FUSE_ROM}, 2698c2ecf20Sopenharmony_ci .data_regs = { 2708c2ecf20Sopenharmony_ci AK8975_REG_HXL, 2718c2ecf20Sopenharmony_ci AK8975_REG_HYL, 2728c2ecf20Sopenharmony_ci AK8975_REG_HZL}, 2738c2ecf20Sopenharmony_ci }, 2748c2ecf20Sopenharmony_ci { 2758c2ecf20Sopenharmony_ci .type = AK8963, 2768c2ecf20Sopenharmony_ci .raw_to_gauss = ak8963_09911_raw_to_gauss, 2778c2ecf20Sopenharmony_ci .range = 8190, 2788c2ecf20Sopenharmony_ci .ctrl_regs = { 2798c2ecf20Sopenharmony_ci AK8975_REG_ST1, 2808c2ecf20Sopenharmony_ci AK8975_REG_ST2, 2818c2ecf20Sopenharmony_ci AK8975_REG_CNTL, 2828c2ecf20Sopenharmony_ci AK8975_REG_ASAX, 2838c2ecf20Sopenharmony_ci AK8975_MAX_REGS}, 2848c2ecf20Sopenharmony_ci .ctrl_masks = { 2858c2ecf20Sopenharmony_ci AK8975_REG_ST1_DRDY_MASK, 2868c2ecf20Sopenharmony_ci AK8975_REG_ST2_HOFL_MASK, 2878c2ecf20Sopenharmony_ci 0, 2888c2ecf20Sopenharmony_ci AK8975_REG_CNTL_MODE_MASK}, 2898c2ecf20Sopenharmony_ci .ctrl_modes = { 2908c2ecf20Sopenharmony_ci AK8975_REG_CNTL_MODE_POWER_DOWN, 2918c2ecf20Sopenharmony_ci AK8975_REG_CNTL_MODE_ONCE, 2928c2ecf20Sopenharmony_ci AK8975_REG_CNTL_MODE_SELF_TEST, 2938c2ecf20Sopenharmony_ci AK8975_REG_CNTL_MODE_FUSE_ROM}, 2948c2ecf20Sopenharmony_ci .data_regs = { 2958c2ecf20Sopenharmony_ci AK8975_REG_HXL, 2968c2ecf20Sopenharmony_ci AK8975_REG_HYL, 2978c2ecf20Sopenharmony_ci AK8975_REG_HZL}, 2988c2ecf20Sopenharmony_ci }, 2998c2ecf20Sopenharmony_ci { 3008c2ecf20Sopenharmony_ci .type = AK09911, 3018c2ecf20Sopenharmony_ci .raw_to_gauss = ak8963_09911_raw_to_gauss, 3028c2ecf20Sopenharmony_ci .range = 8192, 3038c2ecf20Sopenharmony_ci .ctrl_regs = { 3048c2ecf20Sopenharmony_ci AK09912_REG_ST1, 3058c2ecf20Sopenharmony_ci AK09912_REG_ST2, 3068c2ecf20Sopenharmony_ci AK09912_REG_CNTL2, 3078c2ecf20Sopenharmony_ci AK09912_REG_ASAX, 3088c2ecf20Sopenharmony_ci AK09912_MAX_REGS}, 3098c2ecf20Sopenharmony_ci .ctrl_masks = { 3108c2ecf20Sopenharmony_ci AK09912_REG_ST1_DRDY_MASK, 3118c2ecf20Sopenharmony_ci AK09912_REG_ST2_HOFL_MASK, 3128c2ecf20Sopenharmony_ci 0, 3138c2ecf20Sopenharmony_ci AK09912_REG_CNTL2_MODE_MASK}, 3148c2ecf20Sopenharmony_ci .ctrl_modes = { 3158c2ecf20Sopenharmony_ci AK09912_REG_CNTL_MODE_POWER_DOWN, 3168c2ecf20Sopenharmony_ci AK09912_REG_CNTL_MODE_ONCE, 3178c2ecf20Sopenharmony_ci AK09912_REG_CNTL_MODE_SELF_TEST, 3188c2ecf20Sopenharmony_ci AK09912_REG_CNTL_MODE_FUSE_ROM}, 3198c2ecf20Sopenharmony_ci .data_regs = { 3208c2ecf20Sopenharmony_ci AK09912_REG_HXL, 3218c2ecf20Sopenharmony_ci AK09912_REG_HYL, 3228c2ecf20Sopenharmony_ci AK09912_REG_HZL}, 3238c2ecf20Sopenharmony_ci }, 3248c2ecf20Sopenharmony_ci { 3258c2ecf20Sopenharmony_ci .type = AK09912, 3268c2ecf20Sopenharmony_ci .raw_to_gauss = ak09912_raw_to_gauss, 3278c2ecf20Sopenharmony_ci .range = 32752, 3288c2ecf20Sopenharmony_ci .ctrl_regs = { 3298c2ecf20Sopenharmony_ci AK09912_REG_ST1, 3308c2ecf20Sopenharmony_ci AK09912_REG_ST2, 3318c2ecf20Sopenharmony_ci AK09912_REG_CNTL2, 3328c2ecf20Sopenharmony_ci AK09912_REG_ASAX, 3338c2ecf20Sopenharmony_ci AK09912_MAX_REGS}, 3348c2ecf20Sopenharmony_ci .ctrl_masks = { 3358c2ecf20Sopenharmony_ci AK09912_REG_ST1_DRDY_MASK, 3368c2ecf20Sopenharmony_ci AK09912_REG_ST2_HOFL_MASK, 3378c2ecf20Sopenharmony_ci 0, 3388c2ecf20Sopenharmony_ci AK09912_REG_CNTL2_MODE_MASK}, 3398c2ecf20Sopenharmony_ci .ctrl_modes = { 3408c2ecf20Sopenharmony_ci AK09912_REG_CNTL_MODE_POWER_DOWN, 3418c2ecf20Sopenharmony_ci AK09912_REG_CNTL_MODE_ONCE, 3428c2ecf20Sopenharmony_ci AK09912_REG_CNTL_MODE_SELF_TEST, 3438c2ecf20Sopenharmony_ci AK09912_REG_CNTL_MODE_FUSE_ROM}, 3448c2ecf20Sopenharmony_ci .data_regs = { 3458c2ecf20Sopenharmony_ci AK09912_REG_HXL, 3468c2ecf20Sopenharmony_ci AK09912_REG_HYL, 3478c2ecf20Sopenharmony_ci AK09912_REG_HZL}, 3488c2ecf20Sopenharmony_ci } 3498c2ecf20Sopenharmony_ci}; 3508c2ecf20Sopenharmony_ci 3518c2ecf20Sopenharmony_ci/* 3528c2ecf20Sopenharmony_ci * Per-instance context data for the device. 3538c2ecf20Sopenharmony_ci */ 3548c2ecf20Sopenharmony_cistruct ak8975_data { 3558c2ecf20Sopenharmony_ci struct i2c_client *client; 3568c2ecf20Sopenharmony_ci const struct ak_def *def; 3578c2ecf20Sopenharmony_ci struct mutex lock; 3588c2ecf20Sopenharmony_ci u8 asa[3]; 3598c2ecf20Sopenharmony_ci long raw_to_gauss[3]; 3608c2ecf20Sopenharmony_ci struct gpio_desc *eoc_gpiod; 3618c2ecf20Sopenharmony_ci struct gpio_desc *reset_gpiod; 3628c2ecf20Sopenharmony_ci int eoc_irq; 3638c2ecf20Sopenharmony_ci wait_queue_head_t data_ready_queue; 3648c2ecf20Sopenharmony_ci unsigned long flags; 3658c2ecf20Sopenharmony_ci u8 cntl_cache; 3668c2ecf20Sopenharmony_ci struct iio_mount_matrix orientation; 3678c2ecf20Sopenharmony_ci struct regulator *vdd; 3688c2ecf20Sopenharmony_ci struct regulator *vid; 3698c2ecf20Sopenharmony_ci 3708c2ecf20Sopenharmony_ci /* Ensure natural alignment of timestamp */ 3718c2ecf20Sopenharmony_ci struct { 3728c2ecf20Sopenharmony_ci s16 channels[3]; 3738c2ecf20Sopenharmony_ci s64 ts __aligned(8); 3748c2ecf20Sopenharmony_ci } scan; 3758c2ecf20Sopenharmony_ci}; 3768c2ecf20Sopenharmony_ci 3778c2ecf20Sopenharmony_ci/* Enable attached power regulator if any. */ 3788c2ecf20Sopenharmony_cistatic int ak8975_power_on(const struct ak8975_data *data) 3798c2ecf20Sopenharmony_ci{ 3808c2ecf20Sopenharmony_ci int ret; 3818c2ecf20Sopenharmony_ci 3828c2ecf20Sopenharmony_ci ret = regulator_enable(data->vdd); 3838c2ecf20Sopenharmony_ci if (ret) { 3848c2ecf20Sopenharmony_ci dev_warn(&data->client->dev, 3858c2ecf20Sopenharmony_ci "Failed to enable specified Vdd supply\n"); 3868c2ecf20Sopenharmony_ci return ret; 3878c2ecf20Sopenharmony_ci } 3888c2ecf20Sopenharmony_ci ret = regulator_enable(data->vid); 3898c2ecf20Sopenharmony_ci if (ret) { 3908c2ecf20Sopenharmony_ci dev_warn(&data->client->dev, 3918c2ecf20Sopenharmony_ci "Failed to enable specified Vid supply\n"); 3928c2ecf20Sopenharmony_ci regulator_disable(data->vdd); 3938c2ecf20Sopenharmony_ci return ret; 3948c2ecf20Sopenharmony_ci } 3958c2ecf20Sopenharmony_ci 3968c2ecf20Sopenharmony_ci gpiod_set_value_cansleep(data->reset_gpiod, 0); 3978c2ecf20Sopenharmony_ci 3988c2ecf20Sopenharmony_ci /* 3998c2ecf20Sopenharmony_ci * According to the datasheet the power supply rise time is 200us 4008c2ecf20Sopenharmony_ci * and the minimum wait time before mode setting is 100us, in 4018c2ecf20Sopenharmony_ci * total 300us. Add some margin and say minimum 500us here. 4028c2ecf20Sopenharmony_ci */ 4038c2ecf20Sopenharmony_ci usleep_range(500, 1000); 4048c2ecf20Sopenharmony_ci return 0; 4058c2ecf20Sopenharmony_ci} 4068c2ecf20Sopenharmony_ci 4078c2ecf20Sopenharmony_ci/* Disable attached power regulator if any. */ 4088c2ecf20Sopenharmony_cistatic void ak8975_power_off(const struct ak8975_data *data) 4098c2ecf20Sopenharmony_ci{ 4108c2ecf20Sopenharmony_ci gpiod_set_value_cansleep(data->reset_gpiod, 1); 4118c2ecf20Sopenharmony_ci 4128c2ecf20Sopenharmony_ci regulator_disable(data->vid); 4138c2ecf20Sopenharmony_ci regulator_disable(data->vdd); 4148c2ecf20Sopenharmony_ci} 4158c2ecf20Sopenharmony_ci 4168c2ecf20Sopenharmony_ci/* 4178c2ecf20Sopenharmony_ci * Return 0 if the i2c device is the one we expect. 4188c2ecf20Sopenharmony_ci * return a negative error number otherwise 4198c2ecf20Sopenharmony_ci */ 4208c2ecf20Sopenharmony_cistatic int ak8975_who_i_am(struct i2c_client *client, 4218c2ecf20Sopenharmony_ci enum asahi_compass_chipset type) 4228c2ecf20Sopenharmony_ci{ 4238c2ecf20Sopenharmony_ci u8 wia_val[2]; 4248c2ecf20Sopenharmony_ci int ret; 4258c2ecf20Sopenharmony_ci 4268c2ecf20Sopenharmony_ci /* 4278c2ecf20Sopenharmony_ci * Signature for each device: 4288c2ecf20Sopenharmony_ci * Device | WIA1 | WIA2 4298c2ecf20Sopenharmony_ci * AK09912 | DEVICE_ID | AK09912_DEVICE_ID 4308c2ecf20Sopenharmony_ci * AK09911 | DEVICE_ID | AK09911_DEVICE_ID 4318c2ecf20Sopenharmony_ci * AK8975 | DEVICE_ID | NA 4328c2ecf20Sopenharmony_ci * AK8963 | DEVICE_ID | NA 4338c2ecf20Sopenharmony_ci */ 4348c2ecf20Sopenharmony_ci ret = i2c_smbus_read_i2c_block_data_or_emulated( 4358c2ecf20Sopenharmony_ci client, AK09912_REG_WIA1, 2, wia_val); 4368c2ecf20Sopenharmony_ci if (ret < 0) { 4378c2ecf20Sopenharmony_ci dev_err(&client->dev, "Error reading WIA\n"); 4388c2ecf20Sopenharmony_ci return ret; 4398c2ecf20Sopenharmony_ci } 4408c2ecf20Sopenharmony_ci 4418c2ecf20Sopenharmony_ci if (wia_val[0] != AK8975_DEVICE_ID) 4428c2ecf20Sopenharmony_ci return -ENODEV; 4438c2ecf20Sopenharmony_ci 4448c2ecf20Sopenharmony_ci switch (type) { 4458c2ecf20Sopenharmony_ci case AK8975: 4468c2ecf20Sopenharmony_ci case AK8963: 4478c2ecf20Sopenharmony_ci return 0; 4488c2ecf20Sopenharmony_ci case AK09911: 4498c2ecf20Sopenharmony_ci if (wia_val[1] == AK09911_DEVICE_ID) 4508c2ecf20Sopenharmony_ci return 0; 4518c2ecf20Sopenharmony_ci break; 4528c2ecf20Sopenharmony_ci case AK09912: 4538c2ecf20Sopenharmony_ci if (wia_val[1] == AK09912_DEVICE_ID) 4548c2ecf20Sopenharmony_ci return 0; 4558c2ecf20Sopenharmony_ci break; 4568c2ecf20Sopenharmony_ci default: 4578c2ecf20Sopenharmony_ci dev_err(&client->dev, "Type %d unknown\n", type); 4588c2ecf20Sopenharmony_ci } 4598c2ecf20Sopenharmony_ci return -ENODEV; 4608c2ecf20Sopenharmony_ci} 4618c2ecf20Sopenharmony_ci 4628c2ecf20Sopenharmony_ci/* 4638c2ecf20Sopenharmony_ci * Helper function to write to CNTL register. 4648c2ecf20Sopenharmony_ci */ 4658c2ecf20Sopenharmony_cistatic int ak8975_set_mode(struct ak8975_data *data, enum ak_ctrl_mode mode) 4668c2ecf20Sopenharmony_ci{ 4678c2ecf20Sopenharmony_ci u8 regval; 4688c2ecf20Sopenharmony_ci int ret; 4698c2ecf20Sopenharmony_ci 4708c2ecf20Sopenharmony_ci regval = (data->cntl_cache & ~data->def->ctrl_masks[CNTL_MODE]) | 4718c2ecf20Sopenharmony_ci data->def->ctrl_modes[mode]; 4728c2ecf20Sopenharmony_ci ret = i2c_smbus_write_byte_data(data->client, 4738c2ecf20Sopenharmony_ci data->def->ctrl_regs[CNTL], regval); 4748c2ecf20Sopenharmony_ci if (ret < 0) { 4758c2ecf20Sopenharmony_ci return ret; 4768c2ecf20Sopenharmony_ci } 4778c2ecf20Sopenharmony_ci data->cntl_cache = regval; 4788c2ecf20Sopenharmony_ci /* After mode change wait atleast 100us */ 4798c2ecf20Sopenharmony_ci usleep_range(100, 500); 4808c2ecf20Sopenharmony_ci 4818c2ecf20Sopenharmony_ci return 0; 4828c2ecf20Sopenharmony_ci} 4838c2ecf20Sopenharmony_ci 4848c2ecf20Sopenharmony_ci/* 4858c2ecf20Sopenharmony_ci * Handle data ready irq 4868c2ecf20Sopenharmony_ci */ 4878c2ecf20Sopenharmony_cistatic irqreturn_t ak8975_irq_handler(int irq, void *data) 4888c2ecf20Sopenharmony_ci{ 4898c2ecf20Sopenharmony_ci struct ak8975_data *ak8975 = data; 4908c2ecf20Sopenharmony_ci 4918c2ecf20Sopenharmony_ci set_bit(0, &ak8975->flags); 4928c2ecf20Sopenharmony_ci wake_up(&ak8975->data_ready_queue); 4938c2ecf20Sopenharmony_ci 4948c2ecf20Sopenharmony_ci return IRQ_HANDLED; 4958c2ecf20Sopenharmony_ci} 4968c2ecf20Sopenharmony_ci 4978c2ecf20Sopenharmony_ci/* 4988c2ecf20Sopenharmony_ci * Install data ready interrupt handler 4998c2ecf20Sopenharmony_ci */ 5008c2ecf20Sopenharmony_cistatic int ak8975_setup_irq(struct ak8975_data *data) 5018c2ecf20Sopenharmony_ci{ 5028c2ecf20Sopenharmony_ci struct i2c_client *client = data->client; 5038c2ecf20Sopenharmony_ci int rc; 5048c2ecf20Sopenharmony_ci int irq; 5058c2ecf20Sopenharmony_ci 5068c2ecf20Sopenharmony_ci init_waitqueue_head(&data->data_ready_queue); 5078c2ecf20Sopenharmony_ci clear_bit(0, &data->flags); 5088c2ecf20Sopenharmony_ci if (client->irq) 5098c2ecf20Sopenharmony_ci irq = client->irq; 5108c2ecf20Sopenharmony_ci else 5118c2ecf20Sopenharmony_ci irq = gpiod_to_irq(data->eoc_gpiod); 5128c2ecf20Sopenharmony_ci 5138c2ecf20Sopenharmony_ci rc = devm_request_irq(&client->dev, irq, ak8975_irq_handler, 5148c2ecf20Sopenharmony_ci IRQF_TRIGGER_RISING | IRQF_ONESHOT, 5158c2ecf20Sopenharmony_ci dev_name(&client->dev), data); 5168c2ecf20Sopenharmony_ci if (rc < 0) { 5178c2ecf20Sopenharmony_ci dev_err(&client->dev, "irq %d request failed: %d\n", irq, rc); 5188c2ecf20Sopenharmony_ci return rc; 5198c2ecf20Sopenharmony_ci } 5208c2ecf20Sopenharmony_ci 5218c2ecf20Sopenharmony_ci data->eoc_irq = irq; 5228c2ecf20Sopenharmony_ci 5238c2ecf20Sopenharmony_ci return rc; 5248c2ecf20Sopenharmony_ci} 5258c2ecf20Sopenharmony_ci 5268c2ecf20Sopenharmony_ci 5278c2ecf20Sopenharmony_ci/* 5288c2ecf20Sopenharmony_ci * Perform some start-of-day setup, including reading the asa calibration 5298c2ecf20Sopenharmony_ci * values and caching them. 5308c2ecf20Sopenharmony_ci */ 5318c2ecf20Sopenharmony_cistatic int ak8975_setup(struct i2c_client *client) 5328c2ecf20Sopenharmony_ci{ 5338c2ecf20Sopenharmony_ci struct iio_dev *indio_dev = i2c_get_clientdata(client); 5348c2ecf20Sopenharmony_ci struct ak8975_data *data = iio_priv(indio_dev); 5358c2ecf20Sopenharmony_ci int ret; 5368c2ecf20Sopenharmony_ci 5378c2ecf20Sopenharmony_ci /* Write the fused rom access mode. */ 5388c2ecf20Sopenharmony_ci ret = ak8975_set_mode(data, FUSE_ROM); 5398c2ecf20Sopenharmony_ci if (ret < 0) { 5408c2ecf20Sopenharmony_ci dev_err(&client->dev, "Error in setting fuse access mode\n"); 5418c2ecf20Sopenharmony_ci return ret; 5428c2ecf20Sopenharmony_ci } 5438c2ecf20Sopenharmony_ci 5448c2ecf20Sopenharmony_ci /* Get asa data and store in the device data. */ 5458c2ecf20Sopenharmony_ci ret = i2c_smbus_read_i2c_block_data_or_emulated( 5468c2ecf20Sopenharmony_ci client, data->def->ctrl_regs[ASA_BASE], 5478c2ecf20Sopenharmony_ci 3, data->asa); 5488c2ecf20Sopenharmony_ci if (ret < 0) { 5498c2ecf20Sopenharmony_ci dev_err(&client->dev, "Not able to read asa data\n"); 5508c2ecf20Sopenharmony_ci return ret; 5518c2ecf20Sopenharmony_ci } 5528c2ecf20Sopenharmony_ci 5538c2ecf20Sopenharmony_ci /* After reading fuse ROM data set power-down mode */ 5548c2ecf20Sopenharmony_ci ret = ak8975_set_mode(data, POWER_DOWN); 5558c2ecf20Sopenharmony_ci if (ret < 0) { 5568c2ecf20Sopenharmony_ci dev_err(&client->dev, "Error in setting power-down mode\n"); 5578c2ecf20Sopenharmony_ci return ret; 5588c2ecf20Sopenharmony_ci } 5598c2ecf20Sopenharmony_ci 5608c2ecf20Sopenharmony_ci if (data->eoc_gpiod || client->irq > 0) { 5618c2ecf20Sopenharmony_ci ret = ak8975_setup_irq(data); 5628c2ecf20Sopenharmony_ci if (ret < 0) { 5638c2ecf20Sopenharmony_ci dev_err(&client->dev, 5648c2ecf20Sopenharmony_ci "Error setting data ready interrupt\n"); 5658c2ecf20Sopenharmony_ci return ret; 5668c2ecf20Sopenharmony_ci } 5678c2ecf20Sopenharmony_ci } 5688c2ecf20Sopenharmony_ci 5698c2ecf20Sopenharmony_ci data->raw_to_gauss[0] = data->def->raw_to_gauss(data->asa[0]); 5708c2ecf20Sopenharmony_ci data->raw_to_gauss[1] = data->def->raw_to_gauss(data->asa[1]); 5718c2ecf20Sopenharmony_ci data->raw_to_gauss[2] = data->def->raw_to_gauss(data->asa[2]); 5728c2ecf20Sopenharmony_ci 5738c2ecf20Sopenharmony_ci return 0; 5748c2ecf20Sopenharmony_ci} 5758c2ecf20Sopenharmony_ci 5768c2ecf20Sopenharmony_cistatic int wait_conversion_complete_gpio(struct ak8975_data *data) 5778c2ecf20Sopenharmony_ci{ 5788c2ecf20Sopenharmony_ci struct i2c_client *client = data->client; 5798c2ecf20Sopenharmony_ci u32 timeout_ms = AK8975_MAX_CONVERSION_TIMEOUT; 5808c2ecf20Sopenharmony_ci int ret; 5818c2ecf20Sopenharmony_ci 5828c2ecf20Sopenharmony_ci /* Wait for the conversion to complete. */ 5838c2ecf20Sopenharmony_ci while (timeout_ms) { 5848c2ecf20Sopenharmony_ci msleep(AK8975_CONVERSION_DONE_POLL_TIME); 5858c2ecf20Sopenharmony_ci if (gpiod_get_value(data->eoc_gpiod)) 5868c2ecf20Sopenharmony_ci break; 5878c2ecf20Sopenharmony_ci timeout_ms -= AK8975_CONVERSION_DONE_POLL_TIME; 5888c2ecf20Sopenharmony_ci } 5898c2ecf20Sopenharmony_ci if (!timeout_ms) { 5908c2ecf20Sopenharmony_ci dev_err(&client->dev, "Conversion timeout happened\n"); 5918c2ecf20Sopenharmony_ci return -EINVAL; 5928c2ecf20Sopenharmony_ci } 5938c2ecf20Sopenharmony_ci 5948c2ecf20Sopenharmony_ci ret = i2c_smbus_read_byte_data(client, data->def->ctrl_regs[ST1]); 5958c2ecf20Sopenharmony_ci if (ret < 0) 5968c2ecf20Sopenharmony_ci dev_err(&client->dev, "Error in reading ST1\n"); 5978c2ecf20Sopenharmony_ci 5988c2ecf20Sopenharmony_ci return ret; 5998c2ecf20Sopenharmony_ci} 6008c2ecf20Sopenharmony_ci 6018c2ecf20Sopenharmony_cistatic int wait_conversion_complete_polled(struct ak8975_data *data) 6028c2ecf20Sopenharmony_ci{ 6038c2ecf20Sopenharmony_ci struct i2c_client *client = data->client; 6048c2ecf20Sopenharmony_ci u8 read_status; 6058c2ecf20Sopenharmony_ci u32 timeout_ms = AK8975_MAX_CONVERSION_TIMEOUT; 6068c2ecf20Sopenharmony_ci int ret; 6078c2ecf20Sopenharmony_ci 6088c2ecf20Sopenharmony_ci /* Wait for the conversion to complete. */ 6098c2ecf20Sopenharmony_ci while (timeout_ms) { 6108c2ecf20Sopenharmony_ci msleep(AK8975_CONVERSION_DONE_POLL_TIME); 6118c2ecf20Sopenharmony_ci ret = i2c_smbus_read_byte_data(client, 6128c2ecf20Sopenharmony_ci data->def->ctrl_regs[ST1]); 6138c2ecf20Sopenharmony_ci if (ret < 0) { 6148c2ecf20Sopenharmony_ci dev_err(&client->dev, "Error in reading ST1\n"); 6158c2ecf20Sopenharmony_ci return ret; 6168c2ecf20Sopenharmony_ci } 6178c2ecf20Sopenharmony_ci read_status = ret; 6188c2ecf20Sopenharmony_ci if (read_status) 6198c2ecf20Sopenharmony_ci break; 6208c2ecf20Sopenharmony_ci timeout_ms -= AK8975_CONVERSION_DONE_POLL_TIME; 6218c2ecf20Sopenharmony_ci } 6228c2ecf20Sopenharmony_ci if (!timeout_ms) { 6238c2ecf20Sopenharmony_ci dev_err(&client->dev, "Conversion timeout happened\n"); 6248c2ecf20Sopenharmony_ci return -EINVAL; 6258c2ecf20Sopenharmony_ci } 6268c2ecf20Sopenharmony_ci 6278c2ecf20Sopenharmony_ci return read_status; 6288c2ecf20Sopenharmony_ci} 6298c2ecf20Sopenharmony_ci 6308c2ecf20Sopenharmony_ci/* Returns 0 if the end of conversion interrupt occured or -ETIME otherwise */ 6318c2ecf20Sopenharmony_cistatic int wait_conversion_complete_interrupt(struct ak8975_data *data) 6328c2ecf20Sopenharmony_ci{ 6338c2ecf20Sopenharmony_ci int ret; 6348c2ecf20Sopenharmony_ci 6358c2ecf20Sopenharmony_ci ret = wait_event_timeout(data->data_ready_queue, 6368c2ecf20Sopenharmony_ci test_bit(0, &data->flags), 6378c2ecf20Sopenharmony_ci AK8975_DATA_READY_TIMEOUT); 6388c2ecf20Sopenharmony_ci clear_bit(0, &data->flags); 6398c2ecf20Sopenharmony_ci 6408c2ecf20Sopenharmony_ci return ret > 0 ? 0 : -ETIME; 6418c2ecf20Sopenharmony_ci} 6428c2ecf20Sopenharmony_ci 6438c2ecf20Sopenharmony_cistatic int ak8975_start_read_axis(struct ak8975_data *data, 6448c2ecf20Sopenharmony_ci const struct i2c_client *client) 6458c2ecf20Sopenharmony_ci{ 6468c2ecf20Sopenharmony_ci /* Set up the device for taking a sample. */ 6478c2ecf20Sopenharmony_ci int ret = ak8975_set_mode(data, MODE_ONCE); 6488c2ecf20Sopenharmony_ci 6498c2ecf20Sopenharmony_ci if (ret < 0) { 6508c2ecf20Sopenharmony_ci dev_err(&client->dev, "Error in setting operating mode\n"); 6518c2ecf20Sopenharmony_ci return ret; 6528c2ecf20Sopenharmony_ci } 6538c2ecf20Sopenharmony_ci 6548c2ecf20Sopenharmony_ci /* Wait for the conversion to complete. */ 6558c2ecf20Sopenharmony_ci if (data->eoc_irq) 6568c2ecf20Sopenharmony_ci ret = wait_conversion_complete_interrupt(data); 6578c2ecf20Sopenharmony_ci else if (data->eoc_gpiod) 6588c2ecf20Sopenharmony_ci ret = wait_conversion_complete_gpio(data); 6598c2ecf20Sopenharmony_ci else 6608c2ecf20Sopenharmony_ci ret = wait_conversion_complete_polled(data); 6618c2ecf20Sopenharmony_ci if (ret < 0) 6628c2ecf20Sopenharmony_ci return ret; 6638c2ecf20Sopenharmony_ci 6648c2ecf20Sopenharmony_ci /* This will be executed only for non-interrupt based waiting case */ 6658c2ecf20Sopenharmony_ci if (ret & data->def->ctrl_masks[ST1_DRDY]) { 6668c2ecf20Sopenharmony_ci ret = i2c_smbus_read_byte_data(client, 6678c2ecf20Sopenharmony_ci data->def->ctrl_regs[ST2]); 6688c2ecf20Sopenharmony_ci if (ret < 0) { 6698c2ecf20Sopenharmony_ci dev_err(&client->dev, "Error in reading ST2\n"); 6708c2ecf20Sopenharmony_ci return ret; 6718c2ecf20Sopenharmony_ci } 6728c2ecf20Sopenharmony_ci if (ret & (data->def->ctrl_masks[ST2_DERR] | 6738c2ecf20Sopenharmony_ci data->def->ctrl_masks[ST2_HOFL])) { 6748c2ecf20Sopenharmony_ci dev_err(&client->dev, "ST2 status error 0x%x\n", ret); 6758c2ecf20Sopenharmony_ci return -EINVAL; 6768c2ecf20Sopenharmony_ci } 6778c2ecf20Sopenharmony_ci } 6788c2ecf20Sopenharmony_ci 6798c2ecf20Sopenharmony_ci return 0; 6808c2ecf20Sopenharmony_ci} 6818c2ecf20Sopenharmony_ci 6828c2ecf20Sopenharmony_ci/* Retrieve raw flux value for one of the x, y, or z axis. */ 6838c2ecf20Sopenharmony_cistatic int ak8975_read_axis(struct iio_dev *indio_dev, int index, int *val) 6848c2ecf20Sopenharmony_ci{ 6858c2ecf20Sopenharmony_ci struct ak8975_data *data = iio_priv(indio_dev); 6868c2ecf20Sopenharmony_ci const struct i2c_client *client = data->client; 6878c2ecf20Sopenharmony_ci const struct ak_def *def = data->def; 6888c2ecf20Sopenharmony_ci __le16 rval; 6898c2ecf20Sopenharmony_ci u16 buff; 6908c2ecf20Sopenharmony_ci int ret; 6918c2ecf20Sopenharmony_ci 6928c2ecf20Sopenharmony_ci pm_runtime_get_sync(&data->client->dev); 6938c2ecf20Sopenharmony_ci 6948c2ecf20Sopenharmony_ci mutex_lock(&data->lock); 6958c2ecf20Sopenharmony_ci 6968c2ecf20Sopenharmony_ci ret = ak8975_start_read_axis(data, client); 6978c2ecf20Sopenharmony_ci if (ret) 6988c2ecf20Sopenharmony_ci goto exit; 6998c2ecf20Sopenharmony_ci 7008c2ecf20Sopenharmony_ci ret = i2c_smbus_read_i2c_block_data_or_emulated( 7018c2ecf20Sopenharmony_ci client, def->data_regs[index], 7028c2ecf20Sopenharmony_ci sizeof(rval), (u8*)&rval); 7038c2ecf20Sopenharmony_ci if (ret < 0) 7048c2ecf20Sopenharmony_ci goto exit; 7058c2ecf20Sopenharmony_ci 7068c2ecf20Sopenharmony_ci mutex_unlock(&data->lock); 7078c2ecf20Sopenharmony_ci 7088c2ecf20Sopenharmony_ci pm_runtime_mark_last_busy(&data->client->dev); 7098c2ecf20Sopenharmony_ci pm_runtime_put_autosuspend(&data->client->dev); 7108c2ecf20Sopenharmony_ci 7118c2ecf20Sopenharmony_ci /* Swap bytes and convert to valid range. */ 7128c2ecf20Sopenharmony_ci buff = le16_to_cpu(rval); 7138c2ecf20Sopenharmony_ci *val = clamp_t(s16, buff, -def->range, def->range); 7148c2ecf20Sopenharmony_ci return IIO_VAL_INT; 7158c2ecf20Sopenharmony_ci 7168c2ecf20Sopenharmony_ciexit: 7178c2ecf20Sopenharmony_ci mutex_unlock(&data->lock); 7188c2ecf20Sopenharmony_ci dev_err(&client->dev, "Error in reading axis\n"); 7198c2ecf20Sopenharmony_ci return ret; 7208c2ecf20Sopenharmony_ci} 7218c2ecf20Sopenharmony_ci 7228c2ecf20Sopenharmony_cistatic int ak8975_read_raw(struct iio_dev *indio_dev, 7238c2ecf20Sopenharmony_ci struct iio_chan_spec const *chan, 7248c2ecf20Sopenharmony_ci int *val, int *val2, 7258c2ecf20Sopenharmony_ci long mask) 7268c2ecf20Sopenharmony_ci{ 7278c2ecf20Sopenharmony_ci struct ak8975_data *data = iio_priv(indio_dev); 7288c2ecf20Sopenharmony_ci 7298c2ecf20Sopenharmony_ci switch (mask) { 7308c2ecf20Sopenharmony_ci case IIO_CHAN_INFO_RAW: 7318c2ecf20Sopenharmony_ci return ak8975_read_axis(indio_dev, chan->address, val); 7328c2ecf20Sopenharmony_ci case IIO_CHAN_INFO_SCALE: 7338c2ecf20Sopenharmony_ci *val = 0; 7348c2ecf20Sopenharmony_ci *val2 = data->raw_to_gauss[chan->address]; 7358c2ecf20Sopenharmony_ci return IIO_VAL_INT_PLUS_MICRO; 7368c2ecf20Sopenharmony_ci } 7378c2ecf20Sopenharmony_ci return -EINVAL; 7388c2ecf20Sopenharmony_ci} 7398c2ecf20Sopenharmony_ci 7408c2ecf20Sopenharmony_cistatic const struct iio_mount_matrix * 7418c2ecf20Sopenharmony_ciak8975_get_mount_matrix(const struct iio_dev *indio_dev, 7428c2ecf20Sopenharmony_ci const struct iio_chan_spec *chan) 7438c2ecf20Sopenharmony_ci{ 7448c2ecf20Sopenharmony_ci struct ak8975_data *data = iio_priv(indio_dev); 7458c2ecf20Sopenharmony_ci 7468c2ecf20Sopenharmony_ci return &data->orientation; 7478c2ecf20Sopenharmony_ci} 7488c2ecf20Sopenharmony_ci 7498c2ecf20Sopenharmony_cistatic const struct iio_chan_spec_ext_info ak8975_ext_info[] = { 7508c2ecf20Sopenharmony_ci IIO_MOUNT_MATRIX(IIO_SHARED_BY_DIR, ak8975_get_mount_matrix), 7518c2ecf20Sopenharmony_ci { } 7528c2ecf20Sopenharmony_ci}; 7538c2ecf20Sopenharmony_ci 7548c2ecf20Sopenharmony_ci#define AK8975_CHANNEL(axis, index) \ 7558c2ecf20Sopenharmony_ci { \ 7568c2ecf20Sopenharmony_ci .type = IIO_MAGN, \ 7578c2ecf20Sopenharmony_ci .modified = 1, \ 7588c2ecf20Sopenharmony_ci .channel2 = IIO_MOD_##axis, \ 7598c2ecf20Sopenharmony_ci .info_mask_separate = BIT(IIO_CHAN_INFO_RAW) | \ 7608c2ecf20Sopenharmony_ci BIT(IIO_CHAN_INFO_SCALE), \ 7618c2ecf20Sopenharmony_ci .address = index, \ 7628c2ecf20Sopenharmony_ci .scan_index = index, \ 7638c2ecf20Sopenharmony_ci .scan_type = { \ 7648c2ecf20Sopenharmony_ci .sign = 's', \ 7658c2ecf20Sopenharmony_ci .realbits = 16, \ 7668c2ecf20Sopenharmony_ci .storagebits = 16, \ 7678c2ecf20Sopenharmony_ci .endianness = IIO_CPU \ 7688c2ecf20Sopenharmony_ci }, \ 7698c2ecf20Sopenharmony_ci .ext_info = ak8975_ext_info, \ 7708c2ecf20Sopenharmony_ci } 7718c2ecf20Sopenharmony_ci 7728c2ecf20Sopenharmony_cistatic const struct iio_chan_spec ak8975_channels[] = { 7738c2ecf20Sopenharmony_ci AK8975_CHANNEL(X, 0), AK8975_CHANNEL(Y, 1), AK8975_CHANNEL(Z, 2), 7748c2ecf20Sopenharmony_ci IIO_CHAN_SOFT_TIMESTAMP(3), 7758c2ecf20Sopenharmony_ci}; 7768c2ecf20Sopenharmony_ci 7778c2ecf20Sopenharmony_cistatic const unsigned long ak8975_scan_masks[] = { 0x7, 0 }; 7788c2ecf20Sopenharmony_ci 7798c2ecf20Sopenharmony_cistatic const struct iio_info ak8975_info = { 7808c2ecf20Sopenharmony_ci .read_raw = &ak8975_read_raw, 7818c2ecf20Sopenharmony_ci}; 7828c2ecf20Sopenharmony_ci 7838c2ecf20Sopenharmony_cistatic const struct acpi_device_id ak_acpi_match[] = { 7848c2ecf20Sopenharmony_ci {"AK8975", AK8975}, 7858c2ecf20Sopenharmony_ci {"AK8963", AK8963}, 7868c2ecf20Sopenharmony_ci {"INVN6500", AK8963}, 7878c2ecf20Sopenharmony_ci {"AK009911", AK09911}, 7888c2ecf20Sopenharmony_ci {"AK09911", AK09911}, 7898c2ecf20Sopenharmony_ci {"AKM9911", AK09911}, 7908c2ecf20Sopenharmony_ci {"AK09912", AK09912}, 7918c2ecf20Sopenharmony_ci { } 7928c2ecf20Sopenharmony_ci}; 7938c2ecf20Sopenharmony_ciMODULE_DEVICE_TABLE(acpi, ak_acpi_match); 7948c2ecf20Sopenharmony_ci 7958c2ecf20Sopenharmony_cistatic void ak8975_fill_buffer(struct iio_dev *indio_dev) 7968c2ecf20Sopenharmony_ci{ 7978c2ecf20Sopenharmony_ci struct ak8975_data *data = iio_priv(indio_dev); 7988c2ecf20Sopenharmony_ci const struct i2c_client *client = data->client; 7998c2ecf20Sopenharmony_ci const struct ak_def *def = data->def; 8008c2ecf20Sopenharmony_ci int ret; 8018c2ecf20Sopenharmony_ci __le16 fval[3]; 8028c2ecf20Sopenharmony_ci 8038c2ecf20Sopenharmony_ci mutex_lock(&data->lock); 8048c2ecf20Sopenharmony_ci 8058c2ecf20Sopenharmony_ci ret = ak8975_start_read_axis(data, client); 8068c2ecf20Sopenharmony_ci if (ret) 8078c2ecf20Sopenharmony_ci goto unlock; 8088c2ecf20Sopenharmony_ci 8098c2ecf20Sopenharmony_ci /* 8108c2ecf20Sopenharmony_ci * For each axis, read the flux value from the appropriate register 8118c2ecf20Sopenharmony_ci * (the register is specified in the iio device attributes). 8128c2ecf20Sopenharmony_ci */ 8138c2ecf20Sopenharmony_ci ret = i2c_smbus_read_i2c_block_data_or_emulated(client, 8148c2ecf20Sopenharmony_ci def->data_regs[0], 8158c2ecf20Sopenharmony_ci 3 * sizeof(fval[0]), 8168c2ecf20Sopenharmony_ci (u8 *)fval); 8178c2ecf20Sopenharmony_ci if (ret < 0) 8188c2ecf20Sopenharmony_ci goto unlock; 8198c2ecf20Sopenharmony_ci 8208c2ecf20Sopenharmony_ci mutex_unlock(&data->lock); 8218c2ecf20Sopenharmony_ci 8228c2ecf20Sopenharmony_ci /* Clamp to valid range. */ 8238c2ecf20Sopenharmony_ci data->scan.channels[0] = clamp_t(s16, le16_to_cpu(fval[0]), -def->range, def->range); 8248c2ecf20Sopenharmony_ci data->scan.channels[1] = clamp_t(s16, le16_to_cpu(fval[1]), -def->range, def->range); 8258c2ecf20Sopenharmony_ci data->scan.channels[2] = clamp_t(s16, le16_to_cpu(fval[2]), -def->range, def->range); 8268c2ecf20Sopenharmony_ci 8278c2ecf20Sopenharmony_ci iio_push_to_buffers_with_timestamp(indio_dev, &data->scan, 8288c2ecf20Sopenharmony_ci iio_get_time_ns(indio_dev)); 8298c2ecf20Sopenharmony_ci 8308c2ecf20Sopenharmony_ci return; 8318c2ecf20Sopenharmony_ci 8328c2ecf20Sopenharmony_ciunlock: 8338c2ecf20Sopenharmony_ci mutex_unlock(&data->lock); 8348c2ecf20Sopenharmony_ci dev_err(&client->dev, "Error in reading axes block\n"); 8358c2ecf20Sopenharmony_ci} 8368c2ecf20Sopenharmony_ci 8378c2ecf20Sopenharmony_cistatic irqreturn_t ak8975_handle_trigger(int irq, void *p) 8388c2ecf20Sopenharmony_ci{ 8398c2ecf20Sopenharmony_ci const struct iio_poll_func *pf = p; 8408c2ecf20Sopenharmony_ci struct iio_dev *indio_dev = pf->indio_dev; 8418c2ecf20Sopenharmony_ci 8428c2ecf20Sopenharmony_ci ak8975_fill_buffer(indio_dev); 8438c2ecf20Sopenharmony_ci iio_trigger_notify_done(indio_dev->trig); 8448c2ecf20Sopenharmony_ci return IRQ_HANDLED; 8458c2ecf20Sopenharmony_ci} 8468c2ecf20Sopenharmony_ci 8478c2ecf20Sopenharmony_cistatic int ak8975_probe(struct i2c_client *client, 8488c2ecf20Sopenharmony_ci const struct i2c_device_id *id) 8498c2ecf20Sopenharmony_ci{ 8508c2ecf20Sopenharmony_ci struct ak8975_data *data; 8518c2ecf20Sopenharmony_ci struct iio_dev *indio_dev; 8528c2ecf20Sopenharmony_ci struct gpio_desc *eoc_gpiod; 8538c2ecf20Sopenharmony_ci struct gpio_desc *reset_gpiod; 8548c2ecf20Sopenharmony_ci const void *match; 8558c2ecf20Sopenharmony_ci unsigned int i; 8568c2ecf20Sopenharmony_ci int err; 8578c2ecf20Sopenharmony_ci enum asahi_compass_chipset chipset; 8588c2ecf20Sopenharmony_ci const char *name = NULL; 8598c2ecf20Sopenharmony_ci 8608c2ecf20Sopenharmony_ci /* 8618c2ecf20Sopenharmony_ci * Grab and set up the supplied GPIO. 8628c2ecf20Sopenharmony_ci * We may not have a GPIO based IRQ to scan, that is fine, we will 8638c2ecf20Sopenharmony_ci * poll if so. 8648c2ecf20Sopenharmony_ci */ 8658c2ecf20Sopenharmony_ci eoc_gpiod = devm_gpiod_get_optional(&client->dev, NULL, GPIOD_IN); 8668c2ecf20Sopenharmony_ci if (IS_ERR(eoc_gpiod)) 8678c2ecf20Sopenharmony_ci return PTR_ERR(eoc_gpiod); 8688c2ecf20Sopenharmony_ci if (eoc_gpiod) 8698c2ecf20Sopenharmony_ci gpiod_set_consumer_name(eoc_gpiod, "ak_8975"); 8708c2ecf20Sopenharmony_ci 8718c2ecf20Sopenharmony_ci /* 8728c2ecf20Sopenharmony_ci * According to AK09911 datasheet, if reset GPIO is provided then 8738c2ecf20Sopenharmony_ci * deassert reset on ak8975_power_on() and assert reset on 8748c2ecf20Sopenharmony_ci * ak8975_power_off(). 8758c2ecf20Sopenharmony_ci */ 8768c2ecf20Sopenharmony_ci reset_gpiod = devm_gpiod_get_optional(&client->dev, 8778c2ecf20Sopenharmony_ci "reset", GPIOD_OUT_HIGH); 8788c2ecf20Sopenharmony_ci if (IS_ERR(reset_gpiod)) 8798c2ecf20Sopenharmony_ci return PTR_ERR(reset_gpiod); 8808c2ecf20Sopenharmony_ci 8818c2ecf20Sopenharmony_ci /* Register with IIO */ 8828c2ecf20Sopenharmony_ci indio_dev = devm_iio_device_alloc(&client->dev, sizeof(*data)); 8838c2ecf20Sopenharmony_ci if (indio_dev == NULL) 8848c2ecf20Sopenharmony_ci return -ENOMEM; 8858c2ecf20Sopenharmony_ci 8868c2ecf20Sopenharmony_ci data = iio_priv(indio_dev); 8878c2ecf20Sopenharmony_ci i2c_set_clientdata(client, indio_dev); 8888c2ecf20Sopenharmony_ci 8898c2ecf20Sopenharmony_ci data->client = client; 8908c2ecf20Sopenharmony_ci data->eoc_gpiod = eoc_gpiod; 8918c2ecf20Sopenharmony_ci data->reset_gpiod = reset_gpiod; 8928c2ecf20Sopenharmony_ci data->eoc_irq = 0; 8938c2ecf20Sopenharmony_ci 8948c2ecf20Sopenharmony_ci err = iio_read_mount_matrix(&client->dev, "mount-matrix", &data->orientation); 8958c2ecf20Sopenharmony_ci if (err) 8968c2ecf20Sopenharmony_ci return err; 8978c2ecf20Sopenharmony_ci 8988c2ecf20Sopenharmony_ci /* id will be NULL when enumerated via ACPI */ 8998c2ecf20Sopenharmony_ci match = device_get_match_data(&client->dev); 9008c2ecf20Sopenharmony_ci if (match) { 9018c2ecf20Sopenharmony_ci chipset = (enum asahi_compass_chipset)(match); 9028c2ecf20Sopenharmony_ci name = dev_name(&client->dev); 9038c2ecf20Sopenharmony_ci } else if (id) { 9048c2ecf20Sopenharmony_ci chipset = (enum asahi_compass_chipset)(id->driver_data); 9058c2ecf20Sopenharmony_ci name = id->name; 9068c2ecf20Sopenharmony_ci } else 9078c2ecf20Sopenharmony_ci return -ENOSYS; 9088c2ecf20Sopenharmony_ci 9098c2ecf20Sopenharmony_ci for (i = 0; i < ARRAY_SIZE(ak_def_array); i++) 9108c2ecf20Sopenharmony_ci if (ak_def_array[i].type == chipset) 9118c2ecf20Sopenharmony_ci break; 9128c2ecf20Sopenharmony_ci 9138c2ecf20Sopenharmony_ci if (i == ARRAY_SIZE(ak_def_array)) { 9148c2ecf20Sopenharmony_ci dev_err(&client->dev, "AKM device type unsupported: %d\n", 9158c2ecf20Sopenharmony_ci chipset); 9168c2ecf20Sopenharmony_ci return -ENODEV; 9178c2ecf20Sopenharmony_ci } 9188c2ecf20Sopenharmony_ci 9198c2ecf20Sopenharmony_ci data->def = &ak_def_array[i]; 9208c2ecf20Sopenharmony_ci 9218c2ecf20Sopenharmony_ci /* Fetch the regulators */ 9228c2ecf20Sopenharmony_ci data->vdd = devm_regulator_get(&client->dev, "vdd"); 9238c2ecf20Sopenharmony_ci if (IS_ERR(data->vdd)) 9248c2ecf20Sopenharmony_ci return PTR_ERR(data->vdd); 9258c2ecf20Sopenharmony_ci data->vid = devm_regulator_get(&client->dev, "vid"); 9268c2ecf20Sopenharmony_ci if (IS_ERR(data->vid)) 9278c2ecf20Sopenharmony_ci return PTR_ERR(data->vid); 9288c2ecf20Sopenharmony_ci 9298c2ecf20Sopenharmony_ci err = ak8975_power_on(data); 9308c2ecf20Sopenharmony_ci if (err) 9318c2ecf20Sopenharmony_ci return err; 9328c2ecf20Sopenharmony_ci 9338c2ecf20Sopenharmony_ci err = ak8975_who_i_am(client, data->def->type); 9348c2ecf20Sopenharmony_ci if (err < 0) { 9358c2ecf20Sopenharmony_ci dev_err(&client->dev, "Unexpected device\n"); 9368c2ecf20Sopenharmony_ci goto power_off; 9378c2ecf20Sopenharmony_ci } 9388c2ecf20Sopenharmony_ci dev_dbg(&client->dev, "Asahi compass chip %s\n", name); 9398c2ecf20Sopenharmony_ci 9408c2ecf20Sopenharmony_ci /* Perform some basic start-of-day setup of the device. */ 9418c2ecf20Sopenharmony_ci err = ak8975_setup(client); 9428c2ecf20Sopenharmony_ci if (err < 0) { 9438c2ecf20Sopenharmony_ci dev_err(&client->dev, "%s initialization fails\n", name); 9448c2ecf20Sopenharmony_ci goto power_off; 9458c2ecf20Sopenharmony_ci } 9468c2ecf20Sopenharmony_ci 9478c2ecf20Sopenharmony_ci mutex_init(&data->lock); 9488c2ecf20Sopenharmony_ci indio_dev->channels = ak8975_channels; 9498c2ecf20Sopenharmony_ci indio_dev->num_channels = ARRAY_SIZE(ak8975_channels); 9508c2ecf20Sopenharmony_ci indio_dev->info = &ak8975_info; 9518c2ecf20Sopenharmony_ci indio_dev->available_scan_masks = ak8975_scan_masks; 9528c2ecf20Sopenharmony_ci indio_dev->modes = INDIO_DIRECT_MODE; 9538c2ecf20Sopenharmony_ci indio_dev->name = name; 9548c2ecf20Sopenharmony_ci 9558c2ecf20Sopenharmony_ci err = iio_triggered_buffer_setup(indio_dev, NULL, ak8975_handle_trigger, 9568c2ecf20Sopenharmony_ci NULL); 9578c2ecf20Sopenharmony_ci if (err) { 9588c2ecf20Sopenharmony_ci dev_err(&client->dev, "triggered buffer setup failed\n"); 9598c2ecf20Sopenharmony_ci goto power_off; 9608c2ecf20Sopenharmony_ci } 9618c2ecf20Sopenharmony_ci 9628c2ecf20Sopenharmony_ci err = iio_device_register(indio_dev); 9638c2ecf20Sopenharmony_ci if (err) { 9648c2ecf20Sopenharmony_ci dev_err(&client->dev, "device register failed\n"); 9658c2ecf20Sopenharmony_ci goto cleanup_buffer; 9668c2ecf20Sopenharmony_ci } 9678c2ecf20Sopenharmony_ci 9688c2ecf20Sopenharmony_ci /* Enable runtime PM */ 9698c2ecf20Sopenharmony_ci pm_runtime_get_noresume(&client->dev); 9708c2ecf20Sopenharmony_ci pm_runtime_set_active(&client->dev); 9718c2ecf20Sopenharmony_ci pm_runtime_enable(&client->dev); 9728c2ecf20Sopenharmony_ci /* 9738c2ecf20Sopenharmony_ci * The device comes online in 500us, so add two orders of magnitude 9748c2ecf20Sopenharmony_ci * of delay before autosuspending: 50 ms. 9758c2ecf20Sopenharmony_ci */ 9768c2ecf20Sopenharmony_ci pm_runtime_set_autosuspend_delay(&client->dev, 50); 9778c2ecf20Sopenharmony_ci pm_runtime_use_autosuspend(&client->dev); 9788c2ecf20Sopenharmony_ci pm_runtime_put(&client->dev); 9798c2ecf20Sopenharmony_ci 9808c2ecf20Sopenharmony_ci return 0; 9818c2ecf20Sopenharmony_ci 9828c2ecf20Sopenharmony_cicleanup_buffer: 9838c2ecf20Sopenharmony_ci iio_triggered_buffer_cleanup(indio_dev); 9848c2ecf20Sopenharmony_cipower_off: 9858c2ecf20Sopenharmony_ci ak8975_power_off(data); 9868c2ecf20Sopenharmony_ci return err; 9878c2ecf20Sopenharmony_ci} 9888c2ecf20Sopenharmony_ci 9898c2ecf20Sopenharmony_cistatic int ak8975_remove(struct i2c_client *client) 9908c2ecf20Sopenharmony_ci{ 9918c2ecf20Sopenharmony_ci struct iio_dev *indio_dev = i2c_get_clientdata(client); 9928c2ecf20Sopenharmony_ci struct ak8975_data *data = iio_priv(indio_dev); 9938c2ecf20Sopenharmony_ci 9948c2ecf20Sopenharmony_ci pm_runtime_get_sync(&client->dev); 9958c2ecf20Sopenharmony_ci pm_runtime_put_noidle(&client->dev); 9968c2ecf20Sopenharmony_ci pm_runtime_disable(&client->dev); 9978c2ecf20Sopenharmony_ci iio_device_unregister(indio_dev); 9988c2ecf20Sopenharmony_ci iio_triggered_buffer_cleanup(indio_dev); 9998c2ecf20Sopenharmony_ci ak8975_set_mode(data, POWER_DOWN); 10008c2ecf20Sopenharmony_ci ak8975_power_off(data); 10018c2ecf20Sopenharmony_ci 10028c2ecf20Sopenharmony_ci return 0; 10038c2ecf20Sopenharmony_ci} 10048c2ecf20Sopenharmony_ci 10058c2ecf20Sopenharmony_ci#ifdef CONFIG_PM 10068c2ecf20Sopenharmony_cistatic int ak8975_runtime_suspend(struct device *dev) 10078c2ecf20Sopenharmony_ci{ 10088c2ecf20Sopenharmony_ci struct i2c_client *client = to_i2c_client(dev); 10098c2ecf20Sopenharmony_ci struct iio_dev *indio_dev = i2c_get_clientdata(client); 10108c2ecf20Sopenharmony_ci struct ak8975_data *data = iio_priv(indio_dev); 10118c2ecf20Sopenharmony_ci int ret; 10128c2ecf20Sopenharmony_ci 10138c2ecf20Sopenharmony_ci /* Set the device in power down if it wasn't already */ 10148c2ecf20Sopenharmony_ci ret = ak8975_set_mode(data, POWER_DOWN); 10158c2ecf20Sopenharmony_ci if (ret < 0) { 10168c2ecf20Sopenharmony_ci dev_err(&client->dev, "Error in setting power-down mode\n"); 10178c2ecf20Sopenharmony_ci return ret; 10188c2ecf20Sopenharmony_ci } 10198c2ecf20Sopenharmony_ci /* Next cut the regulators */ 10208c2ecf20Sopenharmony_ci ak8975_power_off(data); 10218c2ecf20Sopenharmony_ci 10228c2ecf20Sopenharmony_ci return 0; 10238c2ecf20Sopenharmony_ci} 10248c2ecf20Sopenharmony_ci 10258c2ecf20Sopenharmony_cistatic int ak8975_runtime_resume(struct device *dev) 10268c2ecf20Sopenharmony_ci{ 10278c2ecf20Sopenharmony_ci struct i2c_client *client = to_i2c_client(dev); 10288c2ecf20Sopenharmony_ci struct iio_dev *indio_dev = i2c_get_clientdata(client); 10298c2ecf20Sopenharmony_ci struct ak8975_data *data = iio_priv(indio_dev); 10308c2ecf20Sopenharmony_ci int ret; 10318c2ecf20Sopenharmony_ci 10328c2ecf20Sopenharmony_ci /* Take up the regulators */ 10338c2ecf20Sopenharmony_ci ak8975_power_on(data); 10348c2ecf20Sopenharmony_ci /* 10358c2ecf20Sopenharmony_ci * We come up in powered down mode, the reading routines will 10368c2ecf20Sopenharmony_ci * put us in the mode to read values later. 10378c2ecf20Sopenharmony_ci */ 10388c2ecf20Sopenharmony_ci ret = ak8975_set_mode(data, POWER_DOWN); 10398c2ecf20Sopenharmony_ci if (ret < 0) { 10408c2ecf20Sopenharmony_ci dev_err(&client->dev, "Error in setting power-down mode\n"); 10418c2ecf20Sopenharmony_ci return ret; 10428c2ecf20Sopenharmony_ci } 10438c2ecf20Sopenharmony_ci 10448c2ecf20Sopenharmony_ci return 0; 10458c2ecf20Sopenharmony_ci} 10468c2ecf20Sopenharmony_ci#endif /* CONFIG_PM */ 10478c2ecf20Sopenharmony_ci 10488c2ecf20Sopenharmony_cistatic const struct dev_pm_ops ak8975_dev_pm_ops = { 10498c2ecf20Sopenharmony_ci SET_SYSTEM_SLEEP_PM_OPS(pm_runtime_force_suspend, 10508c2ecf20Sopenharmony_ci pm_runtime_force_resume) 10518c2ecf20Sopenharmony_ci SET_RUNTIME_PM_OPS(ak8975_runtime_suspend, 10528c2ecf20Sopenharmony_ci ak8975_runtime_resume, NULL) 10538c2ecf20Sopenharmony_ci}; 10548c2ecf20Sopenharmony_ci 10558c2ecf20Sopenharmony_cistatic const struct i2c_device_id ak8975_id[] = { 10568c2ecf20Sopenharmony_ci {"ak8975", AK8975}, 10578c2ecf20Sopenharmony_ci {"ak8963", AK8963}, 10588c2ecf20Sopenharmony_ci {"AK8963", AK8963}, 10598c2ecf20Sopenharmony_ci {"ak09911", AK09911}, 10608c2ecf20Sopenharmony_ci {"ak09912", AK09912}, 10618c2ecf20Sopenharmony_ci {} 10628c2ecf20Sopenharmony_ci}; 10638c2ecf20Sopenharmony_ci 10648c2ecf20Sopenharmony_ciMODULE_DEVICE_TABLE(i2c, ak8975_id); 10658c2ecf20Sopenharmony_ci 10668c2ecf20Sopenharmony_cistatic const struct of_device_id ak8975_of_match[] = { 10678c2ecf20Sopenharmony_ci { .compatible = "asahi-kasei,ak8975", }, 10688c2ecf20Sopenharmony_ci { .compatible = "ak8975", }, 10698c2ecf20Sopenharmony_ci { .compatible = "asahi-kasei,ak8963", }, 10708c2ecf20Sopenharmony_ci { .compatible = "ak8963", }, 10718c2ecf20Sopenharmony_ci { .compatible = "asahi-kasei,ak09911", }, 10728c2ecf20Sopenharmony_ci { .compatible = "ak09911", }, 10738c2ecf20Sopenharmony_ci { .compatible = "asahi-kasei,ak09912", }, 10748c2ecf20Sopenharmony_ci { .compatible = "ak09912", }, 10758c2ecf20Sopenharmony_ci {} 10768c2ecf20Sopenharmony_ci}; 10778c2ecf20Sopenharmony_ciMODULE_DEVICE_TABLE(of, ak8975_of_match); 10788c2ecf20Sopenharmony_ci 10798c2ecf20Sopenharmony_cistatic struct i2c_driver ak8975_driver = { 10808c2ecf20Sopenharmony_ci .driver = { 10818c2ecf20Sopenharmony_ci .name = "ak8975", 10828c2ecf20Sopenharmony_ci .pm = &ak8975_dev_pm_ops, 10838c2ecf20Sopenharmony_ci .of_match_table = ak8975_of_match, 10848c2ecf20Sopenharmony_ci .acpi_match_table = ak_acpi_match, 10858c2ecf20Sopenharmony_ci }, 10868c2ecf20Sopenharmony_ci .probe = ak8975_probe, 10878c2ecf20Sopenharmony_ci .remove = ak8975_remove, 10888c2ecf20Sopenharmony_ci .id_table = ak8975_id, 10898c2ecf20Sopenharmony_ci}; 10908c2ecf20Sopenharmony_cimodule_i2c_driver(ak8975_driver); 10918c2ecf20Sopenharmony_ci 10928c2ecf20Sopenharmony_ciMODULE_AUTHOR("Laxman Dewangan <ldewangan@nvidia.com>"); 10938c2ecf20Sopenharmony_ciMODULE_DESCRIPTION("AK8975 magnetometer driver"); 10948c2ecf20Sopenharmony_ciMODULE_LICENSE("GPL"); 1095