162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-only 262306a36Sopenharmony_ci/* 362306a36Sopenharmony_ci * KMX61 - Kionix 6-axis Accelerometer/Magnetometer 462306a36Sopenharmony_ci * 562306a36Sopenharmony_ci * Copyright (c) 2014, Intel Corporation. 662306a36Sopenharmony_ci * 762306a36Sopenharmony_ci * IIO driver for KMX61 (7-bit I2C slave address 0x0E or 0x0F). 862306a36Sopenharmony_ci */ 962306a36Sopenharmony_ci 1062306a36Sopenharmony_ci#include <linux/module.h> 1162306a36Sopenharmony_ci#include <linux/i2c.h> 1262306a36Sopenharmony_ci#include <linux/acpi.h> 1362306a36Sopenharmony_ci#include <linux/interrupt.h> 1462306a36Sopenharmony_ci#include <linux/pm.h> 1562306a36Sopenharmony_ci#include <linux/pm_runtime.h> 1662306a36Sopenharmony_ci#include <linux/iio/iio.h> 1762306a36Sopenharmony_ci#include <linux/iio/sysfs.h> 1862306a36Sopenharmony_ci#include <linux/iio/events.h> 1962306a36Sopenharmony_ci#include <linux/iio/trigger.h> 2062306a36Sopenharmony_ci#include <linux/iio/buffer.h> 2162306a36Sopenharmony_ci#include <linux/iio/triggered_buffer.h> 2262306a36Sopenharmony_ci#include <linux/iio/trigger_consumer.h> 2362306a36Sopenharmony_ci 2462306a36Sopenharmony_ci#define KMX61_DRV_NAME "kmx61" 2562306a36Sopenharmony_ci#define KMX61_IRQ_NAME "kmx61_event" 2662306a36Sopenharmony_ci 2762306a36Sopenharmony_ci#define KMX61_REG_WHO_AM_I 0x00 2862306a36Sopenharmony_ci#define KMX61_REG_INS1 0x01 2962306a36Sopenharmony_ci#define KMX61_REG_INS2 0x02 3062306a36Sopenharmony_ci 3162306a36Sopenharmony_ci/* 3262306a36Sopenharmony_ci * three 16-bit accelerometer output registers for X/Y/Z axis 3362306a36Sopenharmony_ci * we use only XOUT_L as a base register, all other addresses 3462306a36Sopenharmony_ci * can be obtained by applying an offset and are provided here 3562306a36Sopenharmony_ci * only for clarity. 3662306a36Sopenharmony_ci */ 3762306a36Sopenharmony_ci#define KMX61_ACC_XOUT_L 0x0A 3862306a36Sopenharmony_ci#define KMX61_ACC_XOUT_H 0x0B 3962306a36Sopenharmony_ci#define KMX61_ACC_YOUT_L 0x0C 4062306a36Sopenharmony_ci#define KMX61_ACC_YOUT_H 0x0D 4162306a36Sopenharmony_ci#define KMX61_ACC_ZOUT_L 0x0E 4262306a36Sopenharmony_ci#define KMX61_ACC_ZOUT_H 0x0F 4362306a36Sopenharmony_ci 4462306a36Sopenharmony_ci/* 4562306a36Sopenharmony_ci * one 16-bit temperature output register 4662306a36Sopenharmony_ci */ 4762306a36Sopenharmony_ci#define KMX61_TEMP_L 0x10 4862306a36Sopenharmony_ci#define KMX61_TEMP_H 0x11 4962306a36Sopenharmony_ci 5062306a36Sopenharmony_ci/* 5162306a36Sopenharmony_ci * three 16-bit magnetometer output registers for X/Y/Z axis 5262306a36Sopenharmony_ci */ 5362306a36Sopenharmony_ci#define KMX61_MAG_XOUT_L 0x12 5462306a36Sopenharmony_ci#define KMX61_MAG_XOUT_H 0x13 5562306a36Sopenharmony_ci#define KMX61_MAG_YOUT_L 0x14 5662306a36Sopenharmony_ci#define KMX61_MAG_YOUT_H 0x15 5762306a36Sopenharmony_ci#define KMX61_MAG_ZOUT_L 0x16 5862306a36Sopenharmony_ci#define KMX61_MAG_ZOUT_H 0x17 5962306a36Sopenharmony_ci 6062306a36Sopenharmony_ci#define KMX61_REG_INL 0x28 6162306a36Sopenharmony_ci#define KMX61_REG_STBY 0x29 6262306a36Sopenharmony_ci#define KMX61_REG_CTRL1 0x2A 6362306a36Sopenharmony_ci#define KMX61_REG_CTRL2 0x2B 6462306a36Sopenharmony_ci#define KMX61_REG_ODCNTL 0x2C 6562306a36Sopenharmony_ci#define KMX61_REG_INC1 0x2D 6662306a36Sopenharmony_ci 6762306a36Sopenharmony_ci#define KMX61_REG_WUF_THRESH 0x3D 6862306a36Sopenharmony_ci#define KMX61_REG_WUF_TIMER 0x3E 6962306a36Sopenharmony_ci 7062306a36Sopenharmony_ci#define KMX61_ACC_STBY_BIT BIT(0) 7162306a36Sopenharmony_ci#define KMX61_MAG_STBY_BIT BIT(1) 7262306a36Sopenharmony_ci#define KMX61_ACT_STBY_BIT BIT(7) 7362306a36Sopenharmony_ci 7462306a36Sopenharmony_ci#define KMX61_ALL_STBY (KMX61_ACC_STBY_BIT | KMX61_MAG_STBY_BIT) 7562306a36Sopenharmony_ci 7662306a36Sopenharmony_ci#define KMX61_REG_INS1_BIT_WUFS BIT(1) 7762306a36Sopenharmony_ci 7862306a36Sopenharmony_ci#define KMX61_REG_INS2_BIT_ZP BIT(0) 7962306a36Sopenharmony_ci#define KMX61_REG_INS2_BIT_ZN BIT(1) 8062306a36Sopenharmony_ci#define KMX61_REG_INS2_BIT_YP BIT(2) 8162306a36Sopenharmony_ci#define KMX61_REG_INS2_BIT_YN BIT(3) 8262306a36Sopenharmony_ci#define KMX61_REG_INS2_BIT_XP BIT(4) 8362306a36Sopenharmony_ci#define KMX61_REG_INS2_BIT_XN BIT(5) 8462306a36Sopenharmony_ci 8562306a36Sopenharmony_ci#define KMX61_REG_CTRL1_GSEL_MASK 0x03 8662306a36Sopenharmony_ci 8762306a36Sopenharmony_ci#define KMX61_REG_CTRL1_BIT_RES BIT(4) 8862306a36Sopenharmony_ci#define KMX61_REG_CTRL1_BIT_DRDYE BIT(5) 8962306a36Sopenharmony_ci#define KMX61_REG_CTRL1_BIT_WUFE BIT(6) 9062306a36Sopenharmony_ci#define KMX61_REG_CTRL1_BIT_BTSE BIT(7) 9162306a36Sopenharmony_ci 9262306a36Sopenharmony_ci#define KMX61_REG_INC1_BIT_WUFS BIT(0) 9362306a36Sopenharmony_ci#define KMX61_REG_INC1_BIT_DRDYM BIT(1) 9462306a36Sopenharmony_ci#define KMX61_REG_INC1_BIT_DRDYA BIT(2) 9562306a36Sopenharmony_ci#define KMX61_REG_INC1_BIT_IEN BIT(5) 9662306a36Sopenharmony_ci 9762306a36Sopenharmony_ci#define KMX61_ACC_ODR_SHIFT 0 9862306a36Sopenharmony_ci#define KMX61_MAG_ODR_SHIFT 4 9962306a36Sopenharmony_ci#define KMX61_ACC_ODR_MASK 0x0F 10062306a36Sopenharmony_ci#define KMX61_MAG_ODR_MASK 0xF0 10162306a36Sopenharmony_ci 10262306a36Sopenharmony_ci#define KMX61_OWUF_MASK 0x7 10362306a36Sopenharmony_ci 10462306a36Sopenharmony_ci#define KMX61_DEFAULT_WAKE_THRESH 1 10562306a36Sopenharmony_ci#define KMX61_DEFAULT_WAKE_DURATION 1 10662306a36Sopenharmony_ci 10762306a36Sopenharmony_ci#define KMX61_SLEEP_DELAY_MS 2000 10862306a36Sopenharmony_ci 10962306a36Sopenharmony_ci#define KMX61_CHIP_ID 0x12 11062306a36Sopenharmony_ci 11162306a36Sopenharmony_ci/* KMX61 devices */ 11262306a36Sopenharmony_ci#define KMX61_ACC 0x01 11362306a36Sopenharmony_ci#define KMX61_MAG 0x02 11462306a36Sopenharmony_ci 11562306a36Sopenharmony_cistruct kmx61_data { 11662306a36Sopenharmony_ci struct i2c_client *client; 11762306a36Sopenharmony_ci 11862306a36Sopenharmony_ci /* serialize access to non-atomic ops, e.g set_mode */ 11962306a36Sopenharmony_ci struct mutex lock; 12062306a36Sopenharmony_ci 12162306a36Sopenharmony_ci /* standby state */ 12262306a36Sopenharmony_ci bool acc_stby; 12362306a36Sopenharmony_ci bool mag_stby; 12462306a36Sopenharmony_ci 12562306a36Sopenharmony_ci /* power state */ 12662306a36Sopenharmony_ci bool acc_ps; 12762306a36Sopenharmony_ci bool mag_ps; 12862306a36Sopenharmony_ci 12962306a36Sopenharmony_ci /* config bits */ 13062306a36Sopenharmony_ci u8 range; 13162306a36Sopenharmony_ci u8 odr_bits; 13262306a36Sopenharmony_ci u8 wake_thresh; 13362306a36Sopenharmony_ci u8 wake_duration; 13462306a36Sopenharmony_ci 13562306a36Sopenharmony_ci /* accelerometer specific data */ 13662306a36Sopenharmony_ci struct iio_dev *acc_indio_dev; 13762306a36Sopenharmony_ci struct iio_trigger *acc_dready_trig; 13862306a36Sopenharmony_ci struct iio_trigger *motion_trig; 13962306a36Sopenharmony_ci bool acc_dready_trig_on; 14062306a36Sopenharmony_ci bool motion_trig_on; 14162306a36Sopenharmony_ci bool ev_enable_state; 14262306a36Sopenharmony_ci 14362306a36Sopenharmony_ci /* magnetometer specific data */ 14462306a36Sopenharmony_ci struct iio_dev *mag_indio_dev; 14562306a36Sopenharmony_ci struct iio_trigger *mag_dready_trig; 14662306a36Sopenharmony_ci bool mag_dready_trig_on; 14762306a36Sopenharmony_ci}; 14862306a36Sopenharmony_ci 14962306a36Sopenharmony_cienum kmx61_range { 15062306a36Sopenharmony_ci KMX61_RANGE_2G, 15162306a36Sopenharmony_ci KMX61_RANGE_4G, 15262306a36Sopenharmony_ci KMX61_RANGE_8G, 15362306a36Sopenharmony_ci}; 15462306a36Sopenharmony_ci 15562306a36Sopenharmony_cienum kmx61_axis { 15662306a36Sopenharmony_ci KMX61_AXIS_X, 15762306a36Sopenharmony_ci KMX61_AXIS_Y, 15862306a36Sopenharmony_ci KMX61_AXIS_Z, 15962306a36Sopenharmony_ci}; 16062306a36Sopenharmony_ci 16162306a36Sopenharmony_cistatic const u16 kmx61_uscale_table[] = {9582, 19163, 38326}; 16262306a36Sopenharmony_ci 16362306a36Sopenharmony_cistatic const struct { 16462306a36Sopenharmony_ci int val; 16562306a36Sopenharmony_ci int val2; 16662306a36Sopenharmony_ci} kmx61_samp_freq_table[] = { {12, 500000}, 16762306a36Sopenharmony_ci {25, 0}, 16862306a36Sopenharmony_ci {50, 0}, 16962306a36Sopenharmony_ci {100, 0}, 17062306a36Sopenharmony_ci {200, 0}, 17162306a36Sopenharmony_ci {400, 0}, 17262306a36Sopenharmony_ci {800, 0}, 17362306a36Sopenharmony_ci {1600, 0}, 17462306a36Sopenharmony_ci {0, 781000}, 17562306a36Sopenharmony_ci {1, 563000}, 17662306a36Sopenharmony_ci {3, 125000}, 17762306a36Sopenharmony_ci {6, 250000} }; 17862306a36Sopenharmony_ci 17962306a36Sopenharmony_cistatic const struct { 18062306a36Sopenharmony_ci int val; 18162306a36Sopenharmony_ci int val2; 18262306a36Sopenharmony_ci int odr_bits; 18362306a36Sopenharmony_ci} kmx61_wake_up_odr_table[] = { {0, 781000, 0x00}, 18462306a36Sopenharmony_ci {1, 563000, 0x01}, 18562306a36Sopenharmony_ci {3, 125000, 0x02}, 18662306a36Sopenharmony_ci {6, 250000, 0x03}, 18762306a36Sopenharmony_ci {12, 500000, 0x04}, 18862306a36Sopenharmony_ci {25, 0, 0x05}, 18962306a36Sopenharmony_ci {50, 0, 0x06}, 19062306a36Sopenharmony_ci {100, 0, 0x06}, 19162306a36Sopenharmony_ci {200, 0, 0x06}, 19262306a36Sopenharmony_ci {400, 0, 0x06}, 19362306a36Sopenharmony_ci {800, 0, 0x06}, 19462306a36Sopenharmony_ci {1600, 0, 0x06} }; 19562306a36Sopenharmony_ci 19662306a36Sopenharmony_cistatic IIO_CONST_ATTR(accel_scale_available, "0.009582 0.019163 0.038326"); 19762306a36Sopenharmony_cistatic IIO_CONST_ATTR(magn_scale_available, "0.001465"); 19862306a36Sopenharmony_cistatic IIO_CONST_ATTR_SAMP_FREQ_AVAIL( 19962306a36Sopenharmony_ci "0.781000 1.563000 3.125000 6.250000 12.500000 25 50 100 200 400 800"); 20062306a36Sopenharmony_ci 20162306a36Sopenharmony_cistatic struct attribute *kmx61_acc_attributes[] = { 20262306a36Sopenharmony_ci &iio_const_attr_accel_scale_available.dev_attr.attr, 20362306a36Sopenharmony_ci &iio_const_attr_sampling_frequency_available.dev_attr.attr, 20462306a36Sopenharmony_ci NULL, 20562306a36Sopenharmony_ci}; 20662306a36Sopenharmony_ci 20762306a36Sopenharmony_cistatic struct attribute *kmx61_mag_attributes[] = { 20862306a36Sopenharmony_ci &iio_const_attr_magn_scale_available.dev_attr.attr, 20962306a36Sopenharmony_ci &iio_const_attr_sampling_frequency_available.dev_attr.attr, 21062306a36Sopenharmony_ci NULL, 21162306a36Sopenharmony_ci}; 21262306a36Sopenharmony_ci 21362306a36Sopenharmony_cistatic const struct attribute_group kmx61_acc_attribute_group = { 21462306a36Sopenharmony_ci .attrs = kmx61_acc_attributes, 21562306a36Sopenharmony_ci}; 21662306a36Sopenharmony_ci 21762306a36Sopenharmony_cistatic const struct attribute_group kmx61_mag_attribute_group = { 21862306a36Sopenharmony_ci .attrs = kmx61_mag_attributes, 21962306a36Sopenharmony_ci}; 22062306a36Sopenharmony_ci 22162306a36Sopenharmony_cistatic const struct iio_event_spec kmx61_event = { 22262306a36Sopenharmony_ci .type = IIO_EV_TYPE_THRESH, 22362306a36Sopenharmony_ci .dir = IIO_EV_DIR_EITHER, 22462306a36Sopenharmony_ci .mask_separate = BIT(IIO_EV_INFO_VALUE) | 22562306a36Sopenharmony_ci BIT(IIO_EV_INFO_ENABLE) | 22662306a36Sopenharmony_ci BIT(IIO_EV_INFO_PERIOD), 22762306a36Sopenharmony_ci}; 22862306a36Sopenharmony_ci 22962306a36Sopenharmony_ci#define KMX61_ACC_CHAN(_axis) { \ 23062306a36Sopenharmony_ci .type = IIO_ACCEL, \ 23162306a36Sopenharmony_ci .modified = 1, \ 23262306a36Sopenharmony_ci .channel2 = IIO_MOD_ ## _axis, \ 23362306a36Sopenharmony_ci .info_mask_separate = BIT(IIO_CHAN_INFO_RAW), \ 23462306a36Sopenharmony_ci .info_mask_shared_by_type = BIT(IIO_CHAN_INFO_SCALE) | \ 23562306a36Sopenharmony_ci BIT(IIO_CHAN_INFO_SAMP_FREQ), \ 23662306a36Sopenharmony_ci .address = KMX61_ACC, \ 23762306a36Sopenharmony_ci .scan_index = KMX61_AXIS_ ## _axis, \ 23862306a36Sopenharmony_ci .scan_type = { \ 23962306a36Sopenharmony_ci .sign = 's', \ 24062306a36Sopenharmony_ci .realbits = 12, \ 24162306a36Sopenharmony_ci .storagebits = 16, \ 24262306a36Sopenharmony_ci .shift = 4, \ 24362306a36Sopenharmony_ci .endianness = IIO_LE, \ 24462306a36Sopenharmony_ci }, \ 24562306a36Sopenharmony_ci .event_spec = &kmx61_event, \ 24662306a36Sopenharmony_ci .num_event_specs = 1 \ 24762306a36Sopenharmony_ci} 24862306a36Sopenharmony_ci 24962306a36Sopenharmony_ci#define KMX61_MAG_CHAN(_axis) { \ 25062306a36Sopenharmony_ci .type = IIO_MAGN, \ 25162306a36Sopenharmony_ci .modified = 1, \ 25262306a36Sopenharmony_ci .channel2 = IIO_MOD_ ## _axis, \ 25362306a36Sopenharmony_ci .address = KMX61_MAG, \ 25462306a36Sopenharmony_ci .info_mask_separate = BIT(IIO_CHAN_INFO_RAW), \ 25562306a36Sopenharmony_ci .info_mask_shared_by_type = BIT(IIO_CHAN_INFO_SCALE) | \ 25662306a36Sopenharmony_ci BIT(IIO_CHAN_INFO_SAMP_FREQ), \ 25762306a36Sopenharmony_ci .scan_index = KMX61_AXIS_ ## _axis, \ 25862306a36Sopenharmony_ci .scan_type = { \ 25962306a36Sopenharmony_ci .sign = 's', \ 26062306a36Sopenharmony_ci .realbits = 14, \ 26162306a36Sopenharmony_ci .storagebits = 16, \ 26262306a36Sopenharmony_ci .shift = 2, \ 26362306a36Sopenharmony_ci .endianness = IIO_LE, \ 26462306a36Sopenharmony_ci }, \ 26562306a36Sopenharmony_ci} 26662306a36Sopenharmony_ci 26762306a36Sopenharmony_cistatic const struct iio_chan_spec kmx61_acc_channels[] = { 26862306a36Sopenharmony_ci KMX61_ACC_CHAN(X), 26962306a36Sopenharmony_ci KMX61_ACC_CHAN(Y), 27062306a36Sopenharmony_ci KMX61_ACC_CHAN(Z), 27162306a36Sopenharmony_ci}; 27262306a36Sopenharmony_ci 27362306a36Sopenharmony_cistatic const struct iio_chan_spec kmx61_mag_channels[] = { 27462306a36Sopenharmony_ci KMX61_MAG_CHAN(X), 27562306a36Sopenharmony_ci KMX61_MAG_CHAN(Y), 27662306a36Sopenharmony_ci KMX61_MAG_CHAN(Z), 27762306a36Sopenharmony_ci}; 27862306a36Sopenharmony_ci 27962306a36Sopenharmony_cistatic void kmx61_set_data(struct iio_dev *indio_dev, struct kmx61_data *data) 28062306a36Sopenharmony_ci{ 28162306a36Sopenharmony_ci struct kmx61_data **priv = iio_priv(indio_dev); 28262306a36Sopenharmony_ci 28362306a36Sopenharmony_ci *priv = data; 28462306a36Sopenharmony_ci} 28562306a36Sopenharmony_ci 28662306a36Sopenharmony_cistatic struct kmx61_data *kmx61_get_data(struct iio_dev *indio_dev) 28762306a36Sopenharmony_ci{ 28862306a36Sopenharmony_ci return *(struct kmx61_data **)iio_priv(indio_dev); 28962306a36Sopenharmony_ci} 29062306a36Sopenharmony_ci 29162306a36Sopenharmony_cistatic int kmx61_convert_freq_to_bit(int val, int val2) 29262306a36Sopenharmony_ci{ 29362306a36Sopenharmony_ci int i; 29462306a36Sopenharmony_ci 29562306a36Sopenharmony_ci for (i = 0; i < ARRAY_SIZE(kmx61_samp_freq_table); i++) 29662306a36Sopenharmony_ci if (val == kmx61_samp_freq_table[i].val && 29762306a36Sopenharmony_ci val2 == kmx61_samp_freq_table[i].val2) 29862306a36Sopenharmony_ci return i; 29962306a36Sopenharmony_ci return -EINVAL; 30062306a36Sopenharmony_ci} 30162306a36Sopenharmony_ci 30262306a36Sopenharmony_cistatic int kmx61_convert_wake_up_odr_to_bit(int val, int val2) 30362306a36Sopenharmony_ci{ 30462306a36Sopenharmony_ci int i; 30562306a36Sopenharmony_ci 30662306a36Sopenharmony_ci for (i = 0; i < ARRAY_SIZE(kmx61_wake_up_odr_table); ++i) 30762306a36Sopenharmony_ci if (kmx61_wake_up_odr_table[i].val == val && 30862306a36Sopenharmony_ci kmx61_wake_up_odr_table[i].val2 == val2) 30962306a36Sopenharmony_ci return kmx61_wake_up_odr_table[i].odr_bits; 31062306a36Sopenharmony_ci return -EINVAL; 31162306a36Sopenharmony_ci} 31262306a36Sopenharmony_ci 31362306a36Sopenharmony_ci/** 31462306a36Sopenharmony_ci * kmx61_set_mode() - set KMX61 device operating mode 31562306a36Sopenharmony_ci * @data: kmx61 device private data pointer 31662306a36Sopenharmony_ci * @mode: bitmask, indicating operating mode for @device 31762306a36Sopenharmony_ci * @device: bitmask, indicating device for which @mode needs to be set 31862306a36Sopenharmony_ci * @update: update stby bits stored in device's private @data 31962306a36Sopenharmony_ci * 32062306a36Sopenharmony_ci * For each sensor (accelerometer/magnetometer) there are two operating modes 32162306a36Sopenharmony_ci * STANDBY and OPERATION. Neither accel nor magn can be disabled independently 32262306a36Sopenharmony_ci * if they are both enabled. Internal sensors state is saved in acc_stby and 32362306a36Sopenharmony_ci * mag_stby members of driver's private @data. 32462306a36Sopenharmony_ci */ 32562306a36Sopenharmony_cistatic int kmx61_set_mode(struct kmx61_data *data, u8 mode, u8 device, 32662306a36Sopenharmony_ci bool update) 32762306a36Sopenharmony_ci{ 32862306a36Sopenharmony_ci int ret; 32962306a36Sopenharmony_ci int acc_stby = -1, mag_stby = -1; 33062306a36Sopenharmony_ci 33162306a36Sopenharmony_ci ret = i2c_smbus_read_byte_data(data->client, KMX61_REG_STBY); 33262306a36Sopenharmony_ci if (ret < 0) { 33362306a36Sopenharmony_ci dev_err(&data->client->dev, "Error reading reg_stby\n"); 33462306a36Sopenharmony_ci return ret; 33562306a36Sopenharmony_ci } 33662306a36Sopenharmony_ci if (device & KMX61_ACC) { 33762306a36Sopenharmony_ci if (mode & KMX61_ACC_STBY_BIT) { 33862306a36Sopenharmony_ci ret |= KMX61_ACC_STBY_BIT; 33962306a36Sopenharmony_ci acc_stby = 1; 34062306a36Sopenharmony_ci } else { 34162306a36Sopenharmony_ci ret &= ~KMX61_ACC_STBY_BIT; 34262306a36Sopenharmony_ci acc_stby = 0; 34362306a36Sopenharmony_ci } 34462306a36Sopenharmony_ci } 34562306a36Sopenharmony_ci 34662306a36Sopenharmony_ci if (device & KMX61_MAG) { 34762306a36Sopenharmony_ci if (mode & KMX61_MAG_STBY_BIT) { 34862306a36Sopenharmony_ci ret |= KMX61_MAG_STBY_BIT; 34962306a36Sopenharmony_ci mag_stby = 1; 35062306a36Sopenharmony_ci } else { 35162306a36Sopenharmony_ci ret &= ~KMX61_MAG_STBY_BIT; 35262306a36Sopenharmony_ci mag_stby = 0; 35362306a36Sopenharmony_ci } 35462306a36Sopenharmony_ci } 35562306a36Sopenharmony_ci 35662306a36Sopenharmony_ci if (mode & KMX61_ACT_STBY_BIT) 35762306a36Sopenharmony_ci ret |= KMX61_ACT_STBY_BIT; 35862306a36Sopenharmony_ci 35962306a36Sopenharmony_ci ret = i2c_smbus_write_byte_data(data->client, KMX61_REG_STBY, ret); 36062306a36Sopenharmony_ci if (ret < 0) { 36162306a36Sopenharmony_ci dev_err(&data->client->dev, "Error writing reg_stby\n"); 36262306a36Sopenharmony_ci return ret; 36362306a36Sopenharmony_ci } 36462306a36Sopenharmony_ci 36562306a36Sopenharmony_ci if (acc_stby != -1 && update) 36662306a36Sopenharmony_ci data->acc_stby = acc_stby; 36762306a36Sopenharmony_ci if (mag_stby != -1 && update) 36862306a36Sopenharmony_ci data->mag_stby = mag_stby; 36962306a36Sopenharmony_ci 37062306a36Sopenharmony_ci return 0; 37162306a36Sopenharmony_ci} 37262306a36Sopenharmony_ci 37362306a36Sopenharmony_cistatic int kmx61_get_mode(struct kmx61_data *data, u8 *mode, u8 device) 37462306a36Sopenharmony_ci{ 37562306a36Sopenharmony_ci int ret; 37662306a36Sopenharmony_ci 37762306a36Sopenharmony_ci ret = i2c_smbus_read_byte_data(data->client, KMX61_REG_STBY); 37862306a36Sopenharmony_ci if (ret < 0) { 37962306a36Sopenharmony_ci dev_err(&data->client->dev, "Error reading reg_stby\n"); 38062306a36Sopenharmony_ci return ret; 38162306a36Sopenharmony_ci } 38262306a36Sopenharmony_ci *mode = 0; 38362306a36Sopenharmony_ci 38462306a36Sopenharmony_ci if (device & KMX61_ACC) { 38562306a36Sopenharmony_ci if (ret & KMX61_ACC_STBY_BIT) 38662306a36Sopenharmony_ci *mode |= KMX61_ACC_STBY_BIT; 38762306a36Sopenharmony_ci else 38862306a36Sopenharmony_ci *mode &= ~KMX61_ACC_STBY_BIT; 38962306a36Sopenharmony_ci } 39062306a36Sopenharmony_ci 39162306a36Sopenharmony_ci if (device & KMX61_MAG) { 39262306a36Sopenharmony_ci if (ret & KMX61_MAG_STBY_BIT) 39362306a36Sopenharmony_ci *mode |= KMX61_MAG_STBY_BIT; 39462306a36Sopenharmony_ci else 39562306a36Sopenharmony_ci *mode &= ~KMX61_MAG_STBY_BIT; 39662306a36Sopenharmony_ci } 39762306a36Sopenharmony_ci 39862306a36Sopenharmony_ci return 0; 39962306a36Sopenharmony_ci} 40062306a36Sopenharmony_ci 40162306a36Sopenharmony_cistatic int kmx61_set_wake_up_odr(struct kmx61_data *data, int val, int val2) 40262306a36Sopenharmony_ci{ 40362306a36Sopenharmony_ci int ret, odr_bits; 40462306a36Sopenharmony_ci 40562306a36Sopenharmony_ci odr_bits = kmx61_convert_wake_up_odr_to_bit(val, val2); 40662306a36Sopenharmony_ci if (odr_bits < 0) 40762306a36Sopenharmony_ci return odr_bits; 40862306a36Sopenharmony_ci 40962306a36Sopenharmony_ci ret = i2c_smbus_write_byte_data(data->client, KMX61_REG_CTRL2, 41062306a36Sopenharmony_ci odr_bits); 41162306a36Sopenharmony_ci if (ret < 0) 41262306a36Sopenharmony_ci dev_err(&data->client->dev, "Error writing reg_ctrl2\n"); 41362306a36Sopenharmony_ci return ret; 41462306a36Sopenharmony_ci} 41562306a36Sopenharmony_ci 41662306a36Sopenharmony_cistatic int kmx61_set_odr(struct kmx61_data *data, int val, int val2, u8 device) 41762306a36Sopenharmony_ci{ 41862306a36Sopenharmony_ci int ret; 41962306a36Sopenharmony_ci u8 mode; 42062306a36Sopenharmony_ci int lodr_bits, odr_bits; 42162306a36Sopenharmony_ci 42262306a36Sopenharmony_ci ret = kmx61_get_mode(data, &mode, KMX61_ACC | KMX61_MAG); 42362306a36Sopenharmony_ci if (ret < 0) 42462306a36Sopenharmony_ci return ret; 42562306a36Sopenharmony_ci 42662306a36Sopenharmony_ci lodr_bits = kmx61_convert_freq_to_bit(val, val2); 42762306a36Sopenharmony_ci if (lodr_bits < 0) 42862306a36Sopenharmony_ci return lodr_bits; 42962306a36Sopenharmony_ci 43062306a36Sopenharmony_ci /* To change ODR, accel and magn must be in STDBY */ 43162306a36Sopenharmony_ci ret = kmx61_set_mode(data, KMX61_ALL_STBY, KMX61_ACC | KMX61_MAG, 43262306a36Sopenharmony_ci true); 43362306a36Sopenharmony_ci if (ret < 0) 43462306a36Sopenharmony_ci return ret; 43562306a36Sopenharmony_ci 43662306a36Sopenharmony_ci odr_bits = 0; 43762306a36Sopenharmony_ci if (device & KMX61_ACC) 43862306a36Sopenharmony_ci odr_bits |= lodr_bits << KMX61_ACC_ODR_SHIFT; 43962306a36Sopenharmony_ci if (device & KMX61_MAG) 44062306a36Sopenharmony_ci odr_bits |= lodr_bits << KMX61_MAG_ODR_SHIFT; 44162306a36Sopenharmony_ci 44262306a36Sopenharmony_ci ret = i2c_smbus_write_byte_data(data->client, KMX61_REG_ODCNTL, 44362306a36Sopenharmony_ci odr_bits); 44462306a36Sopenharmony_ci if (ret < 0) 44562306a36Sopenharmony_ci return ret; 44662306a36Sopenharmony_ci 44762306a36Sopenharmony_ci data->odr_bits = odr_bits; 44862306a36Sopenharmony_ci 44962306a36Sopenharmony_ci if (device & KMX61_ACC) { 45062306a36Sopenharmony_ci ret = kmx61_set_wake_up_odr(data, val, val2); 45162306a36Sopenharmony_ci if (ret) 45262306a36Sopenharmony_ci return ret; 45362306a36Sopenharmony_ci } 45462306a36Sopenharmony_ci 45562306a36Sopenharmony_ci return kmx61_set_mode(data, mode, KMX61_ACC | KMX61_MAG, true); 45662306a36Sopenharmony_ci} 45762306a36Sopenharmony_ci 45862306a36Sopenharmony_cistatic int kmx61_get_odr(struct kmx61_data *data, int *val, int *val2, 45962306a36Sopenharmony_ci u8 device) 46062306a36Sopenharmony_ci{ 46162306a36Sopenharmony_ci u8 lodr_bits; 46262306a36Sopenharmony_ci 46362306a36Sopenharmony_ci if (device & KMX61_ACC) 46462306a36Sopenharmony_ci lodr_bits = (data->odr_bits >> KMX61_ACC_ODR_SHIFT) & 46562306a36Sopenharmony_ci KMX61_ACC_ODR_MASK; 46662306a36Sopenharmony_ci else if (device & KMX61_MAG) 46762306a36Sopenharmony_ci lodr_bits = (data->odr_bits >> KMX61_MAG_ODR_SHIFT) & 46862306a36Sopenharmony_ci KMX61_MAG_ODR_MASK; 46962306a36Sopenharmony_ci else 47062306a36Sopenharmony_ci return -EINVAL; 47162306a36Sopenharmony_ci 47262306a36Sopenharmony_ci if (lodr_bits >= ARRAY_SIZE(kmx61_samp_freq_table)) 47362306a36Sopenharmony_ci return -EINVAL; 47462306a36Sopenharmony_ci 47562306a36Sopenharmony_ci *val = kmx61_samp_freq_table[lodr_bits].val; 47662306a36Sopenharmony_ci *val2 = kmx61_samp_freq_table[lodr_bits].val2; 47762306a36Sopenharmony_ci 47862306a36Sopenharmony_ci return 0; 47962306a36Sopenharmony_ci} 48062306a36Sopenharmony_ci 48162306a36Sopenharmony_cistatic int kmx61_set_range(struct kmx61_data *data, u8 range) 48262306a36Sopenharmony_ci{ 48362306a36Sopenharmony_ci int ret; 48462306a36Sopenharmony_ci 48562306a36Sopenharmony_ci ret = i2c_smbus_read_byte_data(data->client, KMX61_REG_CTRL1); 48662306a36Sopenharmony_ci if (ret < 0) { 48762306a36Sopenharmony_ci dev_err(&data->client->dev, "Error reading reg_ctrl1\n"); 48862306a36Sopenharmony_ci return ret; 48962306a36Sopenharmony_ci } 49062306a36Sopenharmony_ci 49162306a36Sopenharmony_ci ret &= ~KMX61_REG_CTRL1_GSEL_MASK; 49262306a36Sopenharmony_ci ret |= range & KMX61_REG_CTRL1_GSEL_MASK; 49362306a36Sopenharmony_ci 49462306a36Sopenharmony_ci ret = i2c_smbus_write_byte_data(data->client, KMX61_REG_CTRL1, ret); 49562306a36Sopenharmony_ci if (ret < 0) { 49662306a36Sopenharmony_ci dev_err(&data->client->dev, "Error writing reg_ctrl1\n"); 49762306a36Sopenharmony_ci return ret; 49862306a36Sopenharmony_ci } 49962306a36Sopenharmony_ci 50062306a36Sopenharmony_ci data->range = range; 50162306a36Sopenharmony_ci 50262306a36Sopenharmony_ci return 0; 50362306a36Sopenharmony_ci} 50462306a36Sopenharmony_ci 50562306a36Sopenharmony_cistatic int kmx61_set_scale(struct kmx61_data *data, u16 uscale) 50662306a36Sopenharmony_ci{ 50762306a36Sopenharmony_ci int ret, i; 50862306a36Sopenharmony_ci u8 mode; 50962306a36Sopenharmony_ci 51062306a36Sopenharmony_ci for (i = 0; i < ARRAY_SIZE(kmx61_uscale_table); i++) { 51162306a36Sopenharmony_ci if (kmx61_uscale_table[i] == uscale) { 51262306a36Sopenharmony_ci ret = kmx61_get_mode(data, &mode, 51362306a36Sopenharmony_ci KMX61_ACC | KMX61_MAG); 51462306a36Sopenharmony_ci if (ret < 0) 51562306a36Sopenharmony_ci return ret; 51662306a36Sopenharmony_ci 51762306a36Sopenharmony_ci ret = kmx61_set_mode(data, KMX61_ALL_STBY, 51862306a36Sopenharmony_ci KMX61_ACC | KMX61_MAG, true); 51962306a36Sopenharmony_ci if (ret < 0) 52062306a36Sopenharmony_ci return ret; 52162306a36Sopenharmony_ci 52262306a36Sopenharmony_ci ret = kmx61_set_range(data, i); 52362306a36Sopenharmony_ci if (ret < 0) 52462306a36Sopenharmony_ci return ret; 52562306a36Sopenharmony_ci 52662306a36Sopenharmony_ci return kmx61_set_mode(data, mode, 52762306a36Sopenharmony_ci KMX61_ACC | KMX61_MAG, true); 52862306a36Sopenharmony_ci } 52962306a36Sopenharmony_ci } 53062306a36Sopenharmony_ci return -EINVAL; 53162306a36Sopenharmony_ci} 53262306a36Sopenharmony_ci 53362306a36Sopenharmony_cistatic int kmx61_chip_init(struct kmx61_data *data) 53462306a36Sopenharmony_ci{ 53562306a36Sopenharmony_ci int ret, val, val2; 53662306a36Sopenharmony_ci 53762306a36Sopenharmony_ci ret = i2c_smbus_read_byte_data(data->client, KMX61_REG_WHO_AM_I); 53862306a36Sopenharmony_ci if (ret < 0) { 53962306a36Sopenharmony_ci dev_err(&data->client->dev, "Error reading who_am_i\n"); 54062306a36Sopenharmony_ci return ret; 54162306a36Sopenharmony_ci } 54262306a36Sopenharmony_ci 54362306a36Sopenharmony_ci if (ret != KMX61_CHIP_ID) { 54462306a36Sopenharmony_ci dev_err(&data->client->dev, 54562306a36Sopenharmony_ci "Wrong chip id, got %x expected %x\n", 54662306a36Sopenharmony_ci ret, KMX61_CHIP_ID); 54762306a36Sopenharmony_ci return -EINVAL; 54862306a36Sopenharmony_ci } 54962306a36Sopenharmony_ci 55062306a36Sopenharmony_ci /* set accel 12bit, 4g range */ 55162306a36Sopenharmony_ci ret = kmx61_set_range(data, KMX61_RANGE_4G); 55262306a36Sopenharmony_ci if (ret < 0) 55362306a36Sopenharmony_ci return ret; 55462306a36Sopenharmony_ci 55562306a36Sopenharmony_ci ret = i2c_smbus_read_byte_data(data->client, KMX61_REG_ODCNTL); 55662306a36Sopenharmony_ci if (ret < 0) { 55762306a36Sopenharmony_ci dev_err(&data->client->dev, "Error reading reg_odcntl\n"); 55862306a36Sopenharmony_ci return ret; 55962306a36Sopenharmony_ci } 56062306a36Sopenharmony_ci data->odr_bits = ret; 56162306a36Sopenharmony_ci 56262306a36Sopenharmony_ci /* 56362306a36Sopenharmony_ci * set output data rate for wake up (motion detection) function 56462306a36Sopenharmony_ci * to match data rate for accelerometer sampling 56562306a36Sopenharmony_ci */ 56662306a36Sopenharmony_ci ret = kmx61_get_odr(data, &val, &val2, KMX61_ACC); 56762306a36Sopenharmony_ci if (ret < 0) 56862306a36Sopenharmony_ci return ret; 56962306a36Sopenharmony_ci 57062306a36Sopenharmony_ci ret = kmx61_set_wake_up_odr(data, val, val2); 57162306a36Sopenharmony_ci if (ret < 0) 57262306a36Sopenharmony_ci return ret; 57362306a36Sopenharmony_ci 57462306a36Sopenharmony_ci /* set acc/magn to OPERATION mode */ 57562306a36Sopenharmony_ci ret = kmx61_set_mode(data, 0, KMX61_ACC | KMX61_MAG, true); 57662306a36Sopenharmony_ci if (ret < 0) 57762306a36Sopenharmony_ci return ret; 57862306a36Sopenharmony_ci 57962306a36Sopenharmony_ci data->wake_thresh = KMX61_DEFAULT_WAKE_THRESH; 58062306a36Sopenharmony_ci data->wake_duration = KMX61_DEFAULT_WAKE_DURATION; 58162306a36Sopenharmony_ci 58262306a36Sopenharmony_ci return 0; 58362306a36Sopenharmony_ci} 58462306a36Sopenharmony_ci 58562306a36Sopenharmony_cistatic int kmx61_setup_new_data_interrupt(struct kmx61_data *data, 58662306a36Sopenharmony_ci bool status, u8 device) 58762306a36Sopenharmony_ci{ 58862306a36Sopenharmony_ci u8 mode; 58962306a36Sopenharmony_ci int ret; 59062306a36Sopenharmony_ci 59162306a36Sopenharmony_ci ret = kmx61_get_mode(data, &mode, KMX61_ACC | KMX61_MAG); 59262306a36Sopenharmony_ci if (ret < 0) 59362306a36Sopenharmony_ci return ret; 59462306a36Sopenharmony_ci 59562306a36Sopenharmony_ci ret = kmx61_set_mode(data, KMX61_ALL_STBY, KMX61_ACC | KMX61_MAG, true); 59662306a36Sopenharmony_ci if (ret < 0) 59762306a36Sopenharmony_ci return ret; 59862306a36Sopenharmony_ci 59962306a36Sopenharmony_ci ret = i2c_smbus_read_byte_data(data->client, KMX61_REG_INC1); 60062306a36Sopenharmony_ci if (ret < 0) { 60162306a36Sopenharmony_ci dev_err(&data->client->dev, "Error reading reg_ctrl1\n"); 60262306a36Sopenharmony_ci return ret; 60362306a36Sopenharmony_ci } 60462306a36Sopenharmony_ci 60562306a36Sopenharmony_ci if (status) { 60662306a36Sopenharmony_ci ret |= KMX61_REG_INC1_BIT_IEN; 60762306a36Sopenharmony_ci if (device & KMX61_ACC) 60862306a36Sopenharmony_ci ret |= KMX61_REG_INC1_BIT_DRDYA; 60962306a36Sopenharmony_ci if (device & KMX61_MAG) 61062306a36Sopenharmony_ci ret |= KMX61_REG_INC1_BIT_DRDYM; 61162306a36Sopenharmony_ci } else { 61262306a36Sopenharmony_ci ret &= ~KMX61_REG_INC1_BIT_IEN; 61362306a36Sopenharmony_ci if (device & KMX61_ACC) 61462306a36Sopenharmony_ci ret &= ~KMX61_REG_INC1_BIT_DRDYA; 61562306a36Sopenharmony_ci if (device & KMX61_MAG) 61662306a36Sopenharmony_ci ret &= ~KMX61_REG_INC1_BIT_DRDYM; 61762306a36Sopenharmony_ci } 61862306a36Sopenharmony_ci ret = i2c_smbus_write_byte_data(data->client, KMX61_REG_INC1, ret); 61962306a36Sopenharmony_ci if (ret < 0) { 62062306a36Sopenharmony_ci dev_err(&data->client->dev, "Error writing reg_int_ctrl1\n"); 62162306a36Sopenharmony_ci return ret; 62262306a36Sopenharmony_ci } 62362306a36Sopenharmony_ci 62462306a36Sopenharmony_ci ret = i2c_smbus_read_byte_data(data->client, KMX61_REG_CTRL1); 62562306a36Sopenharmony_ci if (ret < 0) { 62662306a36Sopenharmony_ci dev_err(&data->client->dev, "Error reading reg_ctrl1\n"); 62762306a36Sopenharmony_ci return ret; 62862306a36Sopenharmony_ci } 62962306a36Sopenharmony_ci 63062306a36Sopenharmony_ci if (status) 63162306a36Sopenharmony_ci ret |= KMX61_REG_CTRL1_BIT_DRDYE; 63262306a36Sopenharmony_ci else 63362306a36Sopenharmony_ci ret &= ~KMX61_REG_CTRL1_BIT_DRDYE; 63462306a36Sopenharmony_ci 63562306a36Sopenharmony_ci ret = i2c_smbus_write_byte_data(data->client, KMX61_REG_CTRL1, ret); 63662306a36Sopenharmony_ci if (ret < 0) { 63762306a36Sopenharmony_ci dev_err(&data->client->dev, "Error writing reg_ctrl1\n"); 63862306a36Sopenharmony_ci return ret; 63962306a36Sopenharmony_ci } 64062306a36Sopenharmony_ci 64162306a36Sopenharmony_ci return kmx61_set_mode(data, mode, KMX61_ACC | KMX61_MAG, true); 64262306a36Sopenharmony_ci} 64362306a36Sopenharmony_ci 64462306a36Sopenharmony_cistatic int kmx61_chip_update_thresholds(struct kmx61_data *data) 64562306a36Sopenharmony_ci{ 64662306a36Sopenharmony_ci int ret; 64762306a36Sopenharmony_ci 64862306a36Sopenharmony_ci ret = i2c_smbus_write_byte_data(data->client, 64962306a36Sopenharmony_ci KMX61_REG_WUF_TIMER, 65062306a36Sopenharmony_ci data->wake_duration); 65162306a36Sopenharmony_ci if (ret < 0) { 65262306a36Sopenharmony_ci dev_err(&data->client->dev, "Error writing reg_wuf_timer\n"); 65362306a36Sopenharmony_ci return ret; 65462306a36Sopenharmony_ci } 65562306a36Sopenharmony_ci 65662306a36Sopenharmony_ci ret = i2c_smbus_write_byte_data(data->client, 65762306a36Sopenharmony_ci KMX61_REG_WUF_THRESH, 65862306a36Sopenharmony_ci data->wake_thresh); 65962306a36Sopenharmony_ci if (ret < 0) 66062306a36Sopenharmony_ci dev_err(&data->client->dev, "Error writing reg_wuf_thresh\n"); 66162306a36Sopenharmony_ci 66262306a36Sopenharmony_ci return ret; 66362306a36Sopenharmony_ci} 66462306a36Sopenharmony_ci 66562306a36Sopenharmony_cistatic int kmx61_setup_any_motion_interrupt(struct kmx61_data *data, 66662306a36Sopenharmony_ci bool status) 66762306a36Sopenharmony_ci{ 66862306a36Sopenharmony_ci u8 mode; 66962306a36Sopenharmony_ci int ret; 67062306a36Sopenharmony_ci 67162306a36Sopenharmony_ci ret = kmx61_get_mode(data, &mode, KMX61_ACC | KMX61_MAG); 67262306a36Sopenharmony_ci if (ret < 0) 67362306a36Sopenharmony_ci return ret; 67462306a36Sopenharmony_ci 67562306a36Sopenharmony_ci ret = kmx61_set_mode(data, KMX61_ALL_STBY, KMX61_ACC | KMX61_MAG, true); 67662306a36Sopenharmony_ci if (ret < 0) 67762306a36Sopenharmony_ci return ret; 67862306a36Sopenharmony_ci 67962306a36Sopenharmony_ci ret = kmx61_chip_update_thresholds(data); 68062306a36Sopenharmony_ci if (ret < 0) 68162306a36Sopenharmony_ci return ret; 68262306a36Sopenharmony_ci 68362306a36Sopenharmony_ci ret = i2c_smbus_read_byte_data(data->client, KMX61_REG_INC1); 68462306a36Sopenharmony_ci if (ret < 0) { 68562306a36Sopenharmony_ci dev_err(&data->client->dev, "Error reading reg_inc1\n"); 68662306a36Sopenharmony_ci return ret; 68762306a36Sopenharmony_ci } 68862306a36Sopenharmony_ci if (status) 68962306a36Sopenharmony_ci ret |= (KMX61_REG_INC1_BIT_IEN | KMX61_REG_INC1_BIT_WUFS); 69062306a36Sopenharmony_ci else 69162306a36Sopenharmony_ci ret &= ~(KMX61_REG_INC1_BIT_IEN | KMX61_REG_INC1_BIT_WUFS); 69262306a36Sopenharmony_ci 69362306a36Sopenharmony_ci ret = i2c_smbus_write_byte_data(data->client, KMX61_REG_INC1, ret); 69462306a36Sopenharmony_ci if (ret < 0) { 69562306a36Sopenharmony_ci dev_err(&data->client->dev, "Error writing reg_inc1\n"); 69662306a36Sopenharmony_ci return ret; 69762306a36Sopenharmony_ci } 69862306a36Sopenharmony_ci 69962306a36Sopenharmony_ci ret = i2c_smbus_read_byte_data(data->client, KMX61_REG_CTRL1); 70062306a36Sopenharmony_ci if (ret < 0) { 70162306a36Sopenharmony_ci dev_err(&data->client->dev, "Error reading reg_ctrl1\n"); 70262306a36Sopenharmony_ci return ret; 70362306a36Sopenharmony_ci } 70462306a36Sopenharmony_ci 70562306a36Sopenharmony_ci if (status) 70662306a36Sopenharmony_ci ret |= KMX61_REG_CTRL1_BIT_WUFE | KMX61_REG_CTRL1_BIT_BTSE; 70762306a36Sopenharmony_ci else 70862306a36Sopenharmony_ci ret &= ~(KMX61_REG_CTRL1_BIT_WUFE | KMX61_REG_CTRL1_BIT_BTSE); 70962306a36Sopenharmony_ci 71062306a36Sopenharmony_ci ret = i2c_smbus_write_byte_data(data->client, KMX61_REG_CTRL1, ret); 71162306a36Sopenharmony_ci if (ret < 0) { 71262306a36Sopenharmony_ci dev_err(&data->client->dev, "Error writing reg_ctrl1\n"); 71362306a36Sopenharmony_ci return ret; 71462306a36Sopenharmony_ci } 71562306a36Sopenharmony_ci mode |= KMX61_ACT_STBY_BIT; 71662306a36Sopenharmony_ci return kmx61_set_mode(data, mode, KMX61_ACC | KMX61_MAG, true); 71762306a36Sopenharmony_ci} 71862306a36Sopenharmony_ci 71962306a36Sopenharmony_ci/** 72062306a36Sopenharmony_ci * kmx61_set_power_state() - set power state for kmx61 @device 72162306a36Sopenharmony_ci * @data: kmx61 device private pointer 72262306a36Sopenharmony_ci * @on: power state to be set for @device 72362306a36Sopenharmony_ci * @device: bitmask indicating device for which @on state needs to be set 72462306a36Sopenharmony_ci * 72562306a36Sopenharmony_ci * Notice that when ACC power state needs to be set to ON and MAG is in 72662306a36Sopenharmony_ci * OPERATION then we know that kmx61_runtime_resume was already called 72762306a36Sopenharmony_ci * so we must set ACC OPERATION mode here. The same happens when MAG power 72862306a36Sopenharmony_ci * state needs to be set to ON and ACC is in OPERATION. 72962306a36Sopenharmony_ci */ 73062306a36Sopenharmony_cistatic int kmx61_set_power_state(struct kmx61_data *data, bool on, u8 device) 73162306a36Sopenharmony_ci{ 73262306a36Sopenharmony_ci#ifdef CONFIG_PM 73362306a36Sopenharmony_ci int ret; 73462306a36Sopenharmony_ci 73562306a36Sopenharmony_ci if (device & KMX61_ACC) { 73662306a36Sopenharmony_ci if (on && !data->acc_ps && !data->mag_stby) { 73762306a36Sopenharmony_ci ret = kmx61_set_mode(data, 0, KMX61_ACC, true); 73862306a36Sopenharmony_ci if (ret < 0) 73962306a36Sopenharmony_ci return ret; 74062306a36Sopenharmony_ci } 74162306a36Sopenharmony_ci data->acc_ps = on; 74262306a36Sopenharmony_ci } 74362306a36Sopenharmony_ci if (device & KMX61_MAG) { 74462306a36Sopenharmony_ci if (on && !data->mag_ps && !data->acc_stby) { 74562306a36Sopenharmony_ci ret = kmx61_set_mode(data, 0, KMX61_MAG, true); 74662306a36Sopenharmony_ci if (ret < 0) 74762306a36Sopenharmony_ci return ret; 74862306a36Sopenharmony_ci } 74962306a36Sopenharmony_ci data->mag_ps = on; 75062306a36Sopenharmony_ci } 75162306a36Sopenharmony_ci 75262306a36Sopenharmony_ci if (on) { 75362306a36Sopenharmony_ci ret = pm_runtime_resume_and_get(&data->client->dev); 75462306a36Sopenharmony_ci } else { 75562306a36Sopenharmony_ci pm_runtime_mark_last_busy(&data->client->dev); 75662306a36Sopenharmony_ci ret = pm_runtime_put_autosuspend(&data->client->dev); 75762306a36Sopenharmony_ci } 75862306a36Sopenharmony_ci if (ret < 0) { 75962306a36Sopenharmony_ci dev_err(&data->client->dev, 76062306a36Sopenharmony_ci "Failed: kmx61_set_power_state for %d, ret %d\n", 76162306a36Sopenharmony_ci on, ret); 76262306a36Sopenharmony_ci 76362306a36Sopenharmony_ci return ret; 76462306a36Sopenharmony_ci } 76562306a36Sopenharmony_ci#endif 76662306a36Sopenharmony_ci return 0; 76762306a36Sopenharmony_ci} 76862306a36Sopenharmony_ci 76962306a36Sopenharmony_cistatic int kmx61_read_measurement(struct kmx61_data *data, u8 base, u8 offset) 77062306a36Sopenharmony_ci{ 77162306a36Sopenharmony_ci int ret; 77262306a36Sopenharmony_ci u8 reg = base + offset * 2; 77362306a36Sopenharmony_ci 77462306a36Sopenharmony_ci ret = i2c_smbus_read_word_data(data->client, reg); 77562306a36Sopenharmony_ci if (ret < 0) 77662306a36Sopenharmony_ci dev_err(&data->client->dev, "failed to read reg at %x\n", reg); 77762306a36Sopenharmony_ci 77862306a36Sopenharmony_ci return ret; 77962306a36Sopenharmony_ci} 78062306a36Sopenharmony_ci 78162306a36Sopenharmony_cistatic int kmx61_read_raw(struct iio_dev *indio_dev, 78262306a36Sopenharmony_ci struct iio_chan_spec const *chan, int *val, 78362306a36Sopenharmony_ci int *val2, long mask) 78462306a36Sopenharmony_ci{ 78562306a36Sopenharmony_ci int ret; 78662306a36Sopenharmony_ci u8 base_reg; 78762306a36Sopenharmony_ci struct kmx61_data *data = kmx61_get_data(indio_dev); 78862306a36Sopenharmony_ci 78962306a36Sopenharmony_ci switch (mask) { 79062306a36Sopenharmony_ci case IIO_CHAN_INFO_RAW: 79162306a36Sopenharmony_ci switch (chan->type) { 79262306a36Sopenharmony_ci case IIO_ACCEL: 79362306a36Sopenharmony_ci base_reg = KMX61_ACC_XOUT_L; 79462306a36Sopenharmony_ci break; 79562306a36Sopenharmony_ci case IIO_MAGN: 79662306a36Sopenharmony_ci base_reg = KMX61_MAG_XOUT_L; 79762306a36Sopenharmony_ci break; 79862306a36Sopenharmony_ci default: 79962306a36Sopenharmony_ci return -EINVAL; 80062306a36Sopenharmony_ci } 80162306a36Sopenharmony_ci mutex_lock(&data->lock); 80262306a36Sopenharmony_ci 80362306a36Sopenharmony_ci ret = kmx61_set_power_state(data, true, chan->address); 80462306a36Sopenharmony_ci if (ret) { 80562306a36Sopenharmony_ci mutex_unlock(&data->lock); 80662306a36Sopenharmony_ci return ret; 80762306a36Sopenharmony_ci } 80862306a36Sopenharmony_ci 80962306a36Sopenharmony_ci ret = kmx61_read_measurement(data, base_reg, chan->scan_index); 81062306a36Sopenharmony_ci if (ret < 0) { 81162306a36Sopenharmony_ci kmx61_set_power_state(data, false, chan->address); 81262306a36Sopenharmony_ci mutex_unlock(&data->lock); 81362306a36Sopenharmony_ci return ret; 81462306a36Sopenharmony_ci } 81562306a36Sopenharmony_ci *val = sign_extend32(ret >> chan->scan_type.shift, 81662306a36Sopenharmony_ci chan->scan_type.realbits - 1); 81762306a36Sopenharmony_ci ret = kmx61_set_power_state(data, false, chan->address); 81862306a36Sopenharmony_ci 81962306a36Sopenharmony_ci mutex_unlock(&data->lock); 82062306a36Sopenharmony_ci if (ret) 82162306a36Sopenharmony_ci return ret; 82262306a36Sopenharmony_ci return IIO_VAL_INT; 82362306a36Sopenharmony_ci case IIO_CHAN_INFO_SCALE: 82462306a36Sopenharmony_ci switch (chan->type) { 82562306a36Sopenharmony_ci case IIO_ACCEL: 82662306a36Sopenharmony_ci *val = 0; 82762306a36Sopenharmony_ci *val2 = kmx61_uscale_table[data->range]; 82862306a36Sopenharmony_ci return IIO_VAL_INT_PLUS_MICRO; 82962306a36Sopenharmony_ci case IIO_MAGN: 83062306a36Sopenharmony_ci /* 14 bits res, 1465 microGauss per magn count */ 83162306a36Sopenharmony_ci *val = 0; 83262306a36Sopenharmony_ci *val2 = 1465; 83362306a36Sopenharmony_ci return IIO_VAL_INT_PLUS_MICRO; 83462306a36Sopenharmony_ci default: 83562306a36Sopenharmony_ci return -EINVAL; 83662306a36Sopenharmony_ci } 83762306a36Sopenharmony_ci case IIO_CHAN_INFO_SAMP_FREQ: 83862306a36Sopenharmony_ci if (chan->type != IIO_ACCEL && chan->type != IIO_MAGN) 83962306a36Sopenharmony_ci return -EINVAL; 84062306a36Sopenharmony_ci 84162306a36Sopenharmony_ci mutex_lock(&data->lock); 84262306a36Sopenharmony_ci ret = kmx61_get_odr(data, val, val2, chan->address); 84362306a36Sopenharmony_ci mutex_unlock(&data->lock); 84462306a36Sopenharmony_ci if (ret) 84562306a36Sopenharmony_ci return -EINVAL; 84662306a36Sopenharmony_ci return IIO_VAL_INT_PLUS_MICRO; 84762306a36Sopenharmony_ci } 84862306a36Sopenharmony_ci return -EINVAL; 84962306a36Sopenharmony_ci} 85062306a36Sopenharmony_ci 85162306a36Sopenharmony_cistatic int kmx61_write_raw(struct iio_dev *indio_dev, 85262306a36Sopenharmony_ci struct iio_chan_spec const *chan, int val, 85362306a36Sopenharmony_ci int val2, long mask) 85462306a36Sopenharmony_ci{ 85562306a36Sopenharmony_ci int ret; 85662306a36Sopenharmony_ci struct kmx61_data *data = kmx61_get_data(indio_dev); 85762306a36Sopenharmony_ci 85862306a36Sopenharmony_ci switch (mask) { 85962306a36Sopenharmony_ci case IIO_CHAN_INFO_SAMP_FREQ: 86062306a36Sopenharmony_ci if (chan->type != IIO_ACCEL && chan->type != IIO_MAGN) 86162306a36Sopenharmony_ci return -EINVAL; 86262306a36Sopenharmony_ci 86362306a36Sopenharmony_ci mutex_lock(&data->lock); 86462306a36Sopenharmony_ci ret = kmx61_set_odr(data, val, val2, chan->address); 86562306a36Sopenharmony_ci mutex_unlock(&data->lock); 86662306a36Sopenharmony_ci return ret; 86762306a36Sopenharmony_ci case IIO_CHAN_INFO_SCALE: 86862306a36Sopenharmony_ci switch (chan->type) { 86962306a36Sopenharmony_ci case IIO_ACCEL: 87062306a36Sopenharmony_ci if (val != 0) 87162306a36Sopenharmony_ci return -EINVAL; 87262306a36Sopenharmony_ci mutex_lock(&data->lock); 87362306a36Sopenharmony_ci ret = kmx61_set_scale(data, val2); 87462306a36Sopenharmony_ci mutex_unlock(&data->lock); 87562306a36Sopenharmony_ci return ret; 87662306a36Sopenharmony_ci default: 87762306a36Sopenharmony_ci return -EINVAL; 87862306a36Sopenharmony_ci } 87962306a36Sopenharmony_ci default: 88062306a36Sopenharmony_ci return -EINVAL; 88162306a36Sopenharmony_ci } 88262306a36Sopenharmony_ci} 88362306a36Sopenharmony_ci 88462306a36Sopenharmony_cistatic int kmx61_read_event(struct iio_dev *indio_dev, 88562306a36Sopenharmony_ci const struct iio_chan_spec *chan, 88662306a36Sopenharmony_ci enum iio_event_type type, 88762306a36Sopenharmony_ci enum iio_event_direction dir, 88862306a36Sopenharmony_ci enum iio_event_info info, 88962306a36Sopenharmony_ci int *val, int *val2) 89062306a36Sopenharmony_ci{ 89162306a36Sopenharmony_ci struct kmx61_data *data = kmx61_get_data(indio_dev); 89262306a36Sopenharmony_ci 89362306a36Sopenharmony_ci *val2 = 0; 89462306a36Sopenharmony_ci switch (info) { 89562306a36Sopenharmony_ci case IIO_EV_INFO_VALUE: 89662306a36Sopenharmony_ci *val = data->wake_thresh; 89762306a36Sopenharmony_ci return IIO_VAL_INT; 89862306a36Sopenharmony_ci case IIO_EV_INFO_PERIOD: 89962306a36Sopenharmony_ci *val = data->wake_duration; 90062306a36Sopenharmony_ci return IIO_VAL_INT; 90162306a36Sopenharmony_ci default: 90262306a36Sopenharmony_ci return -EINVAL; 90362306a36Sopenharmony_ci } 90462306a36Sopenharmony_ci} 90562306a36Sopenharmony_ci 90662306a36Sopenharmony_cistatic int kmx61_write_event(struct iio_dev *indio_dev, 90762306a36Sopenharmony_ci const struct iio_chan_spec *chan, 90862306a36Sopenharmony_ci enum iio_event_type type, 90962306a36Sopenharmony_ci enum iio_event_direction dir, 91062306a36Sopenharmony_ci enum iio_event_info info, 91162306a36Sopenharmony_ci int val, int val2) 91262306a36Sopenharmony_ci{ 91362306a36Sopenharmony_ci struct kmx61_data *data = kmx61_get_data(indio_dev); 91462306a36Sopenharmony_ci 91562306a36Sopenharmony_ci if (data->ev_enable_state) 91662306a36Sopenharmony_ci return -EBUSY; 91762306a36Sopenharmony_ci 91862306a36Sopenharmony_ci switch (info) { 91962306a36Sopenharmony_ci case IIO_EV_INFO_VALUE: 92062306a36Sopenharmony_ci data->wake_thresh = val; 92162306a36Sopenharmony_ci return IIO_VAL_INT; 92262306a36Sopenharmony_ci case IIO_EV_INFO_PERIOD: 92362306a36Sopenharmony_ci data->wake_duration = val; 92462306a36Sopenharmony_ci return IIO_VAL_INT; 92562306a36Sopenharmony_ci default: 92662306a36Sopenharmony_ci return -EINVAL; 92762306a36Sopenharmony_ci } 92862306a36Sopenharmony_ci} 92962306a36Sopenharmony_ci 93062306a36Sopenharmony_cistatic int kmx61_read_event_config(struct iio_dev *indio_dev, 93162306a36Sopenharmony_ci const struct iio_chan_spec *chan, 93262306a36Sopenharmony_ci enum iio_event_type type, 93362306a36Sopenharmony_ci enum iio_event_direction dir) 93462306a36Sopenharmony_ci{ 93562306a36Sopenharmony_ci struct kmx61_data *data = kmx61_get_data(indio_dev); 93662306a36Sopenharmony_ci 93762306a36Sopenharmony_ci return data->ev_enable_state; 93862306a36Sopenharmony_ci} 93962306a36Sopenharmony_ci 94062306a36Sopenharmony_cistatic int kmx61_write_event_config(struct iio_dev *indio_dev, 94162306a36Sopenharmony_ci const struct iio_chan_spec *chan, 94262306a36Sopenharmony_ci enum iio_event_type type, 94362306a36Sopenharmony_ci enum iio_event_direction dir, 94462306a36Sopenharmony_ci int state) 94562306a36Sopenharmony_ci{ 94662306a36Sopenharmony_ci struct kmx61_data *data = kmx61_get_data(indio_dev); 94762306a36Sopenharmony_ci int ret = 0; 94862306a36Sopenharmony_ci 94962306a36Sopenharmony_ci if (state && data->ev_enable_state) 95062306a36Sopenharmony_ci return 0; 95162306a36Sopenharmony_ci 95262306a36Sopenharmony_ci mutex_lock(&data->lock); 95362306a36Sopenharmony_ci 95462306a36Sopenharmony_ci if (!state && data->motion_trig_on) { 95562306a36Sopenharmony_ci data->ev_enable_state = false; 95662306a36Sopenharmony_ci goto err_unlock; 95762306a36Sopenharmony_ci } 95862306a36Sopenharmony_ci 95962306a36Sopenharmony_ci ret = kmx61_set_power_state(data, state, KMX61_ACC); 96062306a36Sopenharmony_ci if (ret < 0) 96162306a36Sopenharmony_ci goto err_unlock; 96262306a36Sopenharmony_ci 96362306a36Sopenharmony_ci ret = kmx61_setup_any_motion_interrupt(data, state); 96462306a36Sopenharmony_ci if (ret < 0) { 96562306a36Sopenharmony_ci kmx61_set_power_state(data, false, KMX61_ACC); 96662306a36Sopenharmony_ci goto err_unlock; 96762306a36Sopenharmony_ci } 96862306a36Sopenharmony_ci 96962306a36Sopenharmony_ci data->ev_enable_state = state; 97062306a36Sopenharmony_ci 97162306a36Sopenharmony_cierr_unlock: 97262306a36Sopenharmony_ci mutex_unlock(&data->lock); 97362306a36Sopenharmony_ci 97462306a36Sopenharmony_ci return ret; 97562306a36Sopenharmony_ci} 97662306a36Sopenharmony_ci 97762306a36Sopenharmony_cistatic int kmx61_acc_validate_trigger(struct iio_dev *indio_dev, 97862306a36Sopenharmony_ci struct iio_trigger *trig) 97962306a36Sopenharmony_ci{ 98062306a36Sopenharmony_ci struct kmx61_data *data = kmx61_get_data(indio_dev); 98162306a36Sopenharmony_ci 98262306a36Sopenharmony_ci if (data->acc_dready_trig != trig && data->motion_trig != trig) 98362306a36Sopenharmony_ci return -EINVAL; 98462306a36Sopenharmony_ci 98562306a36Sopenharmony_ci return 0; 98662306a36Sopenharmony_ci} 98762306a36Sopenharmony_ci 98862306a36Sopenharmony_cistatic int kmx61_mag_validate_trigger(struct iio_dev *indio_dev, 98962306a36Sopenharmony_ci struct iio_trigger *trig) 99062306a36Sopenharmony_ci{ 99162306a36Sopenharmony_ci struct kmx61_data *data = kmx61_get_data(indio_dev); 99262306a36Sopenharmony_ci 99362306a36Sopenharmony_ci if (data->mag_dready_trig != trig) 99462306a36Sopenharmony_ci return -EINVAL; 99562306a36Sopenharmony_ci 99662306a36Sopenharmony_ci return 0; 99762306a36Sopenharmony_ci} 99862306a36Sopenharmony_ci 99962306a36Sopenharmony_cistatic const struct iio_info kmx61_acc_info = { 100062306a36Sopenharmony_ci .read_raw = kmx61_read_raw, 100162306a36Sopenharmony_ci .write_raw = kmx61_write_raw, 100262306a36Sopenharmony_ci .attrs = &kmx61_acc_attribute_group, 100362306a36Sopenharmony_ci .read_event_value = kmx61_read_event, 100462306a36Sopenharmony_ci .write_event_value = kmx61_write_event, 100562306a36Sopenharmony_ci .read_event_config = kmx61_read_event_config, 100662306a36Sopenharmony_ci .write_event_config = kmx61_write_event_config, 100762306a36Sopenharmony_ci .validate_trigger = kmx61_acc_validate_trigger, 100862306a36Sopenharmony_ci}; 100962306a36Sopenharmony_ci 101062306a36Sopenharmony_cistatic const struct iio_info kmx61_mag_info = { 101162306a36Sopenharmony_ci .read_raw = kmx61_read_raw, 101262306a36Sopenharmony_ci .write_raw = kmx61_write_raw, 101362306a36Sopenharmony_ci .attrs = &kmx61_mag_attribute_group, 101462306a36Sopenharmony_ci .validate_trigger = kmx61_mag_validate_trigger, 101562306a36Sopenharmony_ci}; 101662306a36Sopenharmony_ci 101762306a36Sopenharmony_ci 101862306a36Sopenharmony_cistatic int kmx61_data_rdy_trigger_set_state(struct iio_trigger *trig, 101962306a36Sopenharmony_ci bool state) 102062306a36Sopenharmony_ci{ 102162306a36Sopenharmony_ci int ret = 0; 102262306a36Sopenharmony_ci u8 device; 102362306a36Sopenharmony_ci 102462306a36Sopenharmony_ci struct iio_dev *indio_dev = iio_trigger_get_drvdata(trig); 102562306a36Sopenharmony_ci struct kmx61_data *data = kmx61_get_data(indio_dev); 102662306a36Sopenharmony_ci 102762306a36Sopenharmony_ci mutex_lock(&data->lock); 102862306a36Sopenharmony_ci 102962306a36Sopenharmony_ci if (!state && data->ev_enable_state && data->motion_trig_on) { 103062306a36Sopenharmony_ci data->motion_trig_on = false; 103162306a36Sopenharmony_ci goto err_unlock; 103262306a36Sopenharmony_ci } 103362306a36Sopenharmony_ci 103462306a36Sopenharmony_ci if (data->acc_dready_trig == trig || data->motion_trig == trig) 103562306a36Sopenharmony_ci device = KMX61_ACC; 103662306a36Sopenharmony_ci else 103762306a36Sopenharmony_ci device = KMX61_MAG; 103862306a36Sopenharmony_ci 103962306a36Sopenharmony_ci ret = kmx61_set_power_state(data, state, device); 104062306a36Sopenharmony_ci if (ret < 0) 104162306a36Sopenharmony_ci goto err_unlock; 104262306a36Sopenharmony_ci 104362306a36Sopenharmony_ci if (data->acc_dready_trig == trig || data->mag_dready_trig == trig) 104462306a36Sopenharmony_ci ret = kmx61_setup_new_data_interrupt(data, state, device); 104562306a36Sopenharmony_ci else 104662306a36Sopenharmony_ci ret = kmx61_setup_any_motion_interrupt(data, state); 104762306a36Sopenharmony_ci if (ret < 0) { 104862306a36Sopenharmony_ci kmx61_set_power_state(data, false, device); 104962306a36Sopenharmony_ci goto err_unlock; 105062306a36Sopenharmony_ci } 105162306a36Sopenharmony_ci 105262306a36Sopenharmony_ci if (data->acc_dready_trig == trig) 105362306a36Sopenharmony_ci data->acc_dready_trig_on = state; 105462306a36Sopenharmony_ci else if (data->mag_dready_trig == trig) 105562306a36Sopenharmony_ci data->mag_dready_trig_on = state; 105662306a36Sopenharmony_ci else 105762306a36Sopenharmony_ci data->motion_trig_on = state; 105862306a36Sopenharmony_cierr_unlock: 105962306a36Sopenharmony_ci mutex_unlock(&data->lock); 106062306a36Sopenharmony_ci 106162306a36Sopenharmony_ci return ret; 106262306a36Sopenharmony_ci} 106362306a36Sopenharmony_ci 106462306a36Sopenharmony_cistatic void kmx61_trig_reenable(struct iio_trigger *trig) 106562306a36Sopenharmony_ci{ 106662306a36Sopenharmony_ci struct iio_dev *indio_dev = iio_trigger_get_drvdata(trig); 106762306a36Sopenharmony_ci struct kmx61_data *data = kmx61_get_data(indio_dev); 106862306a36Sopenharmony_ci int ret; 106962306a36Sopenharmony_ci 107062306a36Sopenharmony_ci ret = i2c_smbus_read_byte_data(data->client, KMX61_REG_INL); 107162306a36Sopenharmony_ci if (ret < 0) 107262306a36Sopenharmony_ci dev_err(&data->client->dev, "Error reading reg_inl\n"); 107362306a36Sopenharmony_ci} 107462306a36Sopenharmony_ci 107562306a36Sopenharmony_cistatic const struct iio_trigger_ops kmx61_trigger_ops = { 107662306a36Sopenharmony_ci .set_trigger_state = kmx61_data_rdy_trigger_set_state, 107762306a36Sopenharmony_ci .reenable = kmx61_trig_reenable, 107862306a36Sopenharmony_ci}; 107962306a36Sopenharmony_ci 108062306a36Sopenharmony_cistatic irqreturn_t kmx61_event_handler(int irq, void *private) 108162306a36Sopenharmony_ci{ 108262306a36Sopenharmony_ci struct kmx61_data *data = private; 108362306a36Sopenharmony_ci struct iio_dev *indio_dev = data->acc_indio_dev; 108462306a36Sopenharmony_ci int ret; 108562306a36Sopenharmony_ci 108662306a36Sopenharmony_ci ret = i2c_smbus_read_byte_data(data->client, KMX61_REG_INS1); 108762306a36Sopenharmony_ci if (ret < 0) { 108862306a36Sopenharmony_ci dev_err(&data->client->dev, "Error reading reg_ins1\n"); 108962306a36Sopenharmony_ci goto ack_intr; 109062306a36Sopenharmony_ci } 109162306a36Sopenharmony_ci 109262306a36Sopenharmony_ci if (ret & KMX61_REG_INS1_BIT_WUFS) { 109362306a36Sopenharmony_ci ret = i2c_smbus_read_byte_data(data->client, KMX61_REG_INS2); 109462306a36Sopenharmony_ci if (ret < 0) { 109562306a36Sopenharmony_ci dev_err(&data->client->dev, "Error reading reg_ins2\n"); 109662306a36Sopenharmony_ci goto ack_intr; 109762306a36Sopenharmony_ci } 109862306a36Sopenharmony_ci 109962306a36Sopenharmony_ci if (ret & KMX61_REG_INS2_BIT_XN) 110062306a36Sopenharmony_ci iio_push_event(indio_dev, 110162306a36Sopenharmony_ci IIO_MOD_EVENT_CODE(IIO_ACCEL, 110262306a36Sopenharmony_ci 0, 110362306a36Sopenharmony_ci IIO_MOD_X, 110462306a36Sopenharmony_ci IIO_EV_TYPE_THRESH, 110562306a36Sopenharmony_ci IIO_EV_DIR_FALLING), 110662306a36Sopenharmony_ci 0); 110762306a36Sopenharmony_ci 110862306a36Sopenharmony_ci if (ret & KMX61_REG_INS2_BIT_XP) 110962306a36Sopenharmony_ci iio_push_event(indio_dev, 111062306a36Sopenharmony_ci IIO_MOD_EVENT_CODE(IIO_ACCEL, 111162306a36Sopenharmony_ci 0, 111262306a36Sopenharmony_ci IIO_MOD_X, 111362306a36Sopenharmony_ci IIO_EV_TYPE_THRESH, 111462306a36Sopenharmony_ci IIO_EV_DIR_RISING), 111562306a36Sopenharmony_ci 0); 111662306a36Sopenharmony_ci 111762306a36Sopenharmony_ci if (ret & KMX61_REG_INS2_BIT_YN) 111862306a36Sopenharmony_ci iio_push_event(indio_dev, 111962306a36Sopenharmony_ci IIO_MOD_EVENT_CODE(IIO_ACCEL, 112062306a36Sopenharmony_ci 0, 112162306a36Sopenharmony_ci IIO_MOD_Y, 112262306a36Sopenharmony_ci IIO_EV_TYPE_THRESH, 112362306a36Sopenharmony_ci IIO_EV_DIR_FALLING), 112462306a36Sopenharmony_ci 0); 112562306a36Sopenharmony_ci 112662306a36Sopenharmony_ci if (ret & KMX61_REG_INS2_BIT_YP) 112762306a36Sopenharmony_ci iio_push_event(indio_dev, 112862306a36Sopenharmony_ci IIO_MOD_EVENT_CODE(IIO_ACCEL, 112962306a36Sopenharmony_ci 0, 113062306a36Sopenharmony_ci IIO_MOD_Y, 113162306a36Sopenharmony_ci IIO_EV_TYPE_THRESH, 113262306a36Sopenharmony_ci IIO_EV_DIR_RISING), 113362306a36Sopenharmony_ci 0); 113462306a36Sopenharmony_ci 113562306a36Sopenharmony_ci if (ret & KMX61_REG_INS2_BIT_ZN) 113662306a36Sopenharmony_ci iio_push_event(indio_dev, 113762306a36Sopenharmony_ci IIO_MOD_EVENT_CODE(IIO_ACCEL, 113862306a36Sopenharmony_ci 0, 113962306a36Sopenharmony_ci IIO_MOD_Z, 114062306a36Sopenharmony_ci IIO_EV_TYPE_THRESH, 114162306a36Sopenharmony_ci IIO_EV_DIR_FALLING), 114262306a36Sopenharmony_ci 0); 114362306a36Sopenharmony_ci 114462306a36Sopenharmony_ci if (ret & KMX61_REG_INS2_BIT_ZP) 114562306a36Sopenharmony_ci iio_push_event(indio_dev, 114662306a36Sopenharmony_ci IIO_MOD_EVENT_CODE(IIO_ACCEL, 114762306a36Sopenharmony_ci 0, 114862306a36Sopenharmony_ci IIO_MOD_Z, 114962306a36Sopenharmony_ci IIO_EV_TYPE_THRESH, 115062306a36Sopenharmony_ci IIO_EV_DIR_RISING), 115162306a36Sopenharmony_ci 0); 115262306a36Sopenharmony_ci } 115362306a36Sopenharmony_ci 115462306a36Sopenharmony_ciack_intr: 115562306a36Sopenharmony_ci ret = i2c_smbus_read_byte_data(data->client, KMX61_REG_CTRL1); 115662306a36Sopenharmony_ci if (ret < 0) 115762306a36Sopenharmony_ci dev_err(&data->client->dev, "Error reading reg_ctrl1\n"); 115862306a36Sopenharmony_ci 115962306a36Sopenharmony_ci ret |= KMX61_REG_CTRL1_BIT_RES; 116062306a36Sopenharmony_ci ret = i2c_smbus_write_byte_data(data->client, KMX61_REG_CTRL1, ret); 116162306a36Sopenharmony_ci if (ret < 0) 116262306a36Sopenharmony_ci dev_err(&data->client->dev, "Error writing reg_ctrl1\n"); 116362306a36Sopenharmony_ci 116462306a36Sopenharmony_ci ret = i2c_smbus_read_byte_data(data->client, KMX61_REG_INL); 116562306a36Sopenharmony_ci if (ret < 0) 116662306a36Sopenharmony_ci dev_err(&data->client->dev, "Error reading reg_inl\n"); 116762306a36Sopenharmony_ci 116862306a36Sopenharmony_ci return IRQ_HANDLED; 116962306a36Sopenharmony_ci} 117062306a36Sopenharmony_ci 117162306a36Sopenharmony_cistatic irqreturn_t kmx61_data_rdy_trig_poll(int irq, void *private) 117262306a36Sopenharmony_ci{ 117362306a36Sopenharmony_ci struct kmx61_data *data = private; 117462306a36Sopenharmony_ci 117562306a36Sopenharmony_ci if (data->acc_dready_trig_on) 117662306a36Sopenharmony_ci iio_trigger_poll(data->acc_dready_trig); 117762306a36Sopenharmony_ci if (data->mag_dready_trig_on) 117862306a36Sopenharmony_ci iio_trigger_poll(data->mag_dready_trig); 117962306a36Sopenharmony_ci 118062306a36Sopenharmony_ci if (data->motion_trig_on) 118162306a36Sopenharmony_ci iio_trigger_poll(data->motion_trig); 118262306a36Sopenharmony_ci 118362306a36Sopenharmony_ci if (data->ev_enable_state) 118462306a36Sopenharmony_ci return IRQ_WAKE_THREAD; 118562306a36Sopenharmony_ci return IRQ_HANDLED; 118662306a36Sopenharmony_ci} 118762306a36Sopenharmony_ci 118862306a36Sopenharmony_cistatic irqreturn_t kmx61_trigger_handler(int irq, void *p) 118962306a36Sopenharmony_ci{ 119062306a36Sopenharmony_ci struct iio_poll_func *pf = p; 119162306a36Sopenharmony_ci struct iio_dev *indio_dev = pf->indio_dev; 119262306a36Sopenharmony_ci struct kmx61_data *data = kmx61_get_data(indio_dev); 119362306a36Sopenharmony_ci int bit, ret, i = 0; 119462306a36Sopenharmony_ci u8 base; 119562306a36Sopenharmony_ci s16 buffer[8]; 119662306a36Sopenharmony_ci 119762306a36Sopenharmony_ci if (indio_dev == data->acc_indio_dev) 119862306a36Sopenharmony_ci base = KMX61_ACC_XOUT_L; 119962306a36Sopenharmony_ci else 120062306a36Sopenharmony_ci base = KMX61_MAG_XOUT_L; 120162306a36Sopenharmony_ci 120262306a36Sopenharmony_ci mutex_lock(&data->lock); 120362306a36Sopenharmony_ci for_each_set_bit(bit, indio_dev->active_scan_mask, 120462306a36Sopenharmony_ci indio_dev->masklength) { 120562306a36Sopenharmony_ci ret = kmx61_read_measurement(data, base, bit); 120662306a36Sopenharmony_ci if (ret < 0) { 120762306a36Sopenharmony_ci mutex_unlock(&data->lock); 120862306a36Sopenharmony_ci goto err; 120962306a36Sopenharmony_ci } 121062306a36Sopenharmony_ci buffer[i++] = ret; 121162306a36Sopenharmony_ci } 121262306a36Sopenharmony_ci mutex_unlock(&data->lock); 121362306a36Sopenharmony_ci 121462306a36Sopenharmony_ci iio_push_to_buffers(indio_dev, buffer); 121562306a36Sopenharmony_cierr: 121662306a36Sopenharmony_ci iio_trigger_notify_done(indio_dev->trig); 121762306a36Sopenharmony_ci 121862306a36Sopenharmony_ci return IRQ_HANDLED; 121962306a36Sopenharmony_ci} 122062306a36Sopenharmony_ci 122162306a36Sopenharmony_cistatic const char *kmx61_match_acpi_device(struct device *dev) 122262306a36Sopenharmony_ci{ 122362306a36Sopenharmony_ci const struct acpi_device_id *id; 122462306a36Sopenharmony_ci 122562306a36Sopenharmony_ci id = acpi_match_device(dev->driver->acpi_match_table, dev); 122662306a36Sopenharmony_ci if (!id) 122762306a36Sopenharmony_ci return NULL; 122862306a36Sopenharmony_ci return dev_name(dev); 122962306a36Sopenharmony_ci} 123062306a36Sopenharmony_ci 123162306a36Sopenharmony_cistatic struct iio_dev *kmx61_indiodev_setup(struct kmx61_data *data, 123262306a36Sopenharmony_ci const struct iio_info *info, 123362306a36Sopenharmony_ci const struct iio_chan_spec *chan, 123462306a36Sopenharmony_ci int num_channels, 123562306a36Sopenharmony_ci const char *name) 123662306a36Sopenharmony_ci{ 123762306a36Sopenharmony_ci struct iio_dev *indio_dev; 123862306a36Sopenharmony_ci 123962306a36Sopenharmony_ci indio_dev = devm_iio_device_alloc(&data->client->dev, sizeof(data)); 124062306a36Sopenharmony_ci if (!indio_dev) 124162306a36Sopenharmony_ci return ERR_PTR(-ENOMEM); 124262306a36Sopenharmony_ci 124362306a36Sopenharmony_ci kmx61_set_data(indio_dev, data); 124462306a36Sopenharmony_ci 124562306a36Sopenharmony_ci indio_dev->channels = chan; 124662306a36Sopenharmony_ci indio_dev->num_channels = num_channels; 124762306a36Sopenharmony_ci indio_dev->name = name; 124862306a36Sopenharmony_ci indio_dev->modes = INDIO_DIRECT_MODE; 124962306a36Sopenharmony_ci indio_dev->info = info; 125062306a36Sopenharmony_ci 125162306a36Sopenharmony_ci return indio_dev; 125262306a36Sopenharmony_ci} 125362306a36Sopenharmony_ci 125462306a36Sopenharmony_cistatic struct iio_trigger *kmx61_trigger_setup(struct kmx61_data *data, 125562306a36Sopenharmony_ci struct iio_dev *indio_dev, 125662306a36Sopenharmony_ci const char *tag) 125762306a36Sopenharmony_ci{ 125862306a36Sopenharmony_ci struct iio_trigger *trig; 125962306a36Sopenharmony_ci int ret; 126062306a36Sopenharmony_ci 126162306a36Sopenharmony_ci trig = devm_iio_trigger_alloc(&data->client->dev, 126262306a36Sopenharmony_ci "%s-%s-dev%d", 126362306a36Sopenharmony_ci indio_dev->name, 126462306a36Sopenharmony_ci tag, 126562306a36Sopenharmony_ci iio_device_id(indio_dev)); 126662306a36Sopenharmony_ci if (!trig) 126762306a36Sopenharmony_ci return ERR_PTR(-ENOMEM); 126862306a36Sopenharmony_ci 126962306a36Sopenharmony_ci trig->ops = &kmx61_trigger_ops; 127062306a36Sopenharmony_ci iio_trigger_set_drvdata(trig, indio_dev); 127162306a36Sopenharmony_ci 127262306a36Sopenharmony_ci ret = iio_trigger_register(trig); 127362306a36Sopenharmony_ci if (ret) 127462306a36Sopenharmony_ci return ERR_PTR(ret); 127562306a36Sopenharmony_ci 127662306a36Sopenharmony_ci return trig; 127762306a36Sopenharmony_ci} 127862306a36Sopenharmony_ci 127962306a36Sopenharmony_cistatic int kmx61_probe(struct i2c_client *client) 128062306a36Sopenharmony_ci{ 128162306a36Sopenharmony_ci const struct i2c_device_id *id = i2c_client_get_device_id(client); 128262306a36Sopenharmony_ci int ret; 128362306a36Sopenharmony_ci struct kmx61_data *data; 128462306a36Sopenharmony_ci const char *name = NULL; 128562306a36Sopenharmony_ci 128662306a36Sopenharmony_ci data = devm_kzalloc(&client->dev, sizeof(*data), GFP_KERNEL); 128762306a36Sopenharmony_ci if (!data) 128862306a36Sopenharmony_ci return -ENOMEM; 128962306a36Sopenharmony_ci 129062306a36Sopenharmony_ci i2c_set_clientdata(client, data); 129162306a36Sopenharmony_ci data->client = client; 129262306a36Sopenharmony_ci 129362306a36Sopenharmony_ci mutex_init(&data->lock); 129462306a36Sopenharmony_ci 129562306a36Sopenharmony_ci if (id) 129662306a36Sopenharmony_ci name = id->name; 129762306a36Sopenharmony_ci else if (ACPI_HANDLE(&client->dev)) 129862306a36Sopenharmony_ci name = kmx61_match_acpi_device(&client->dev); 129962306a36Sopenharmony_ci else 130062306a36Sopenharmony_ci return -ENODEV; 130162306a36Sopenharmony_ci 130262306a36Sopenharmony_ci data->acc_indio_dev = 130362306a36Sopenharmony_ci kmx61_indiodev_setup(data, &kmx61_acc_info, 130462306a36Sopenharmony_ci kmx61_acc_channels, 130562306a36Sopenharmony_ci ARRAY_SIZE(kmx61_acc_channels), 130662306a36Sopenharmony_ci name); 130762306a36Sopenharmony_ci if (IS_ERR(data->acc_indio_dev)) 130862306a36Sopenharmony_ci return PTR_ERR(data->acc_indio_dev); 130962306a36Sopenharmony_ci 131062306a36Sopenharmony_ci data->mag_indio_dev = 131162306a36Sopenharmony_ci kmx61_indiodev_setup(data, &kmx61_mag_info, 131262306a36Sopenharmony_ci kmx61_mag_channels, 131362306a36Sopenharmony_ci ARRAY_SIZE(kmx61_mag_channels), 131462306a36Sopenharmony_ci name); 131562306a36Sopenharmony_ci if (IS_ERR(data->mag_indio_dev)) 131662306a36Sopenharmony_ci return PTR_ERR(data->mag_indio_dev); 131762306a36Sopenharmony_ci 131862306a36Sopenharmony_ci ret = kmx61_chip_init(data); 131962306a36Sopenharmony_ci if (ret < 0) 132062306a36Sopenharmony_ci return ret; 132162306a36Sopenharmony_ci 132262306a36Sopenharmony_ci if (client->irq > 0) { 132362306a36Sopenharmony_ci ret = devm_request_threaded_irq(&client->dev, client->irq, 132462306a36Sopenharmony_ci kmx61_data_rdy_trig_poll, 132562306a36Sopenharmony_ci kmx61_event_handler, 132662306a36Sopenharmony_ci IRQF_TRIGGER_RISING, 132762306a36Sopenharmony_ci KMX61_IRQ_NAME, 132862306a36Sopenharmony_ci data); 132962306a36Sopenharmony_ci if (ret) 133062306a36Sopenharmony_ci goto err_chip_uninit; 133162306a36Sopenharmony_ci 133262306a36Sopenharmony_ci data->acc_dready_trig = 133362306a36Sopenharmony_ci kmx61_trigger_setup(data, data->acc_indio_dev, 133462306a36Sopenharmony_ci "dready"); 133562306a36Sopenharmony_ci if (IS_ERR(data->acc_dready_trig)) { 133662306a36Sopenharmony_ci ret = PTR_ERR(data->acc_dready_trig); 133762306a36Sopenharmony_ci goto err_chip_uninit; 133862306a36Sopenharmony_ci } 133962306a36Sopenharmony_ci 134062306a36Sopenharmony_ci data->mag_dready_trig = 134162306a36Sopenharmony_ci kmx61_trigger_setup(data, data->mag_indio_dev, 134262306a36Sopenharmony_ci "dready"); 134362306a36Sopenharmony_ci if (IS_ERR(data->mag_dready_trig)) { 134462306a36Sopenharmony_ci ret = PTR_ERR(data->mag_dready_trig); 134562306a36Sopenharmony_ci goto err_trigger_unregister_acc_dready; 134662306a36Sopenharmony_ci } 134762306a36Sopenharmony_ci 134862306a36Sopenharmony_ci data->motion_trig = 134962306a36Sopenharmony_ci kmx61_trigger_setup(data, data->acc_indio_dev, 135062306a36Sopenharmony_ci "any-motion"); 135162306a36Sopenharmony_ci if (IS_ERR(data->motion_trig)) { 135262306a36Sopenharmony_ci ret = PTR_ERR(data->motion_trig); 135362306a36Sopenharmony_ci goto err_trigger_unregister_mag_dready; 135462306a36Sopenharmony_ci } 135562306a36Sopenharmony_ci 135662306a36Sopenharmony_ci ret = iio_triggered_buffer_setup(data->acc_indio_dev, 135762306a36Sopenharmony_ci &iio_pollfunc_store_time, 135862306a36Sopenharmony_ci kmx61_trigger_handler, 135962306a36Sopenharmony_ci NULL); 136062306a36Sopenharmony_ci if (ret < 0) { 136162306a36Sopenharmony_ci dev_err(&data->client->dev, 136262306a36Sopenharmony_ci "Failed to setup acc triggered buffer\n"); 136362306a36Sopenharmony_ci goto err_trigger_unregister_motion; 136462306a36Sopenharmony_ci } 136562306a36Sopenharmony_ci 136662306a36Sopenharmony_ci ret = iio_triggered_buffer_setup(data->mag_indio_dev, 136762306a36Sopenharmony_ci &iio_pollfunc_store_time, 136862306a36Sopenharmony_ci kmx61_trigger_handler, 136962306a36Sopenharmony_ci NULL); 137062306a36Sopenharmony_ci if (ret < 0) { 137162306a36Sopenharmony_ci dev_err(&data->client->dev, 137262306a36Sopenharmony_ci "Failed to setup mag triggered buffer\n"); 137362306a36Sopenharmony_ci goto err_buffer_cleanup_acc; 137462306a36Sopenharmony_ci } 137562306a36Sopenharmony_ci } 137662306a36Sopenharmony_ci 137762306a36Sopenharmony_ci ret = pm_runtime_set_active(&client->dev); 137862306a36Sopenharmony_ci if (ret < 0) 137962306a36Sopenharmony_ci goto err_buffer_cleanup_mag; 138062306a36Sopenharmony_ci 138162306a36Sopenharmony_ci pm_runtime_enable(&client->dev); 138262306a36Sopenharmony_ci pm_runtime_set_autosuspend_delay(&client->dev, KMX61_SLEEP_DELAY_MS); 138362306a36Sopenharmony_ci pm_runtime_use_autosuspend(&client->dev); 138462306a36Sopenharmony_ci 138562306a36Sopenharmony_ci ret = iio_device_register(data->acc_indio_dev); 138662306a36Sopenharmony_ci if (ret < 0) { 138762306a36Sopenharmony_ci dev_err(&client->dev, "Failed to register acc iio device\n"); 138862306a36Sopenharmony_ci goto err_pm_cleanup; 138962306a36Sopenharmony_ci } 139062306a36Sopenharmony_ci 139162306a36Sopenharmony_ci ret = iio_device_register(data->mag_indio_dev); 139262306a36Sopenharmony_ci if (ret < 0) { 139362306a36Sopenharmony_ci dev_err(&client->dev, "Failed to register mag iio device\n"); 139462306a36Sopenharmony_ci goto err_iio_unregister_acc; 139562306a36Sopenharmony_ci } 139662306a36Sopenharmony_ci 139762306a36Sopenharmony_ci return 0; 139862306a36Sopenharmony_ci 139962306a36Sopenharmony_cierr_iio_unregister_acc: 140062306a36Sopenharmony_ci iio_device_unregister(data->acc_indio_dev); 140162306a36Sopenharmony_cierr_pm_cleanup: 140262306a36Sopenharmony_ci pm_runtime_dont_use_autosuspend(&client->dev); 140362306a36Sopenharmony_ci pm_runtime_disable(&client->dev); 140462306a36Sopenharmony_cierr_buffer_cleanup_mag: 140562306a36Sopenharmony_ci if (client->irq > 0) 140662306a36Sopenharmony_ci iio_triggered_buffer_cleanup(data->mag_indio_dev); 140762306a36Sopenharmony_cierr_buffer_cleanup_acc: 140862306a36Sopenharmony_ci if (client->irq > 0) 140962306a36Sopenharmony_ci iio_triggered_buffer_cleanup(data->acc_indio_dev); 141062306a36Sopenharmony_cierr_trigger_unregister_motion: 141162306a36Sopenharmony_ci iio_trigger_unregister(data->motion_trig); 141262306a36Sopenharmony_cierr_trigger_unregister_mag_dready: 141362306a36Sopenharmony_ci iio_trigger_unregister(data->mag_dready_trig); 141462306a36Sopenharmony_cierr_trigger_unregister_acc_dready: 141562306a36Sopenharmony_ci iio_trigger_unregister(data->acc_dready_trig); 141662306a36Sopenharmony_cierr_chip_uninit: 141762306a36Sopenharmony_ci kmx61_set_mode(data, KMX61_ALL_STBY, KMX61_ACC | KMX61_MAG, true); 141862306a36Sopenharmony_ci return ret; 141962306a36Sopenharmony_ci} 142062306a36Sopenharmony_ci 142162306a36Sopenharmony_cistatic void kmx61_remove(struct i2c_client *client) 142262306a36Sopenharmony_ci{ 142362306a36Sopenharmony_ci struct kmx61_data *data = i2c_get_clientdata(client); 142462306a36Sopenharmony_ci 142562306a36Sopenharmony_ci iio_device_unregister(data->acc_indio_dev); 142662306a36Sopenharmony_ci iio_device_unregister(data->mag_indio_dev); 142762306a36Sopenharmony_ci 142862306a36Sopenharmony_ci pm_runtime_disable(&client->dev); 142962306a36Sopenharmony_ci pm_runtime_set_suspended(&client->dev); 143062306a36Sopenharmony_ci 143162306a36Sopenharmony_ci if (client->irq > 0) { 143262306a36Sopenharmony_ci iio_triggered_buffer_cleanup(data->acc_indio_dev); 143362306a36Sopenharmony_ci iio_triggered_buffer_cleanup(data->mag_indio_dev); 143462306a36Sopenharmony_ci iio_trigger_unregister(data->acc_dready_trig); 143562306a36Sopenharmony_ci iio_trigger_unregister(data->mag_dready_trig); 143662306a36Sopenharmony_ci iio_trigger_unregister(data->motion_trig); 143762306a36Sopenharmony_ci } 143862306a36Sopenharmony_ci 143962306a36Sopenharmony_ci mutex_lock(&data->lock); 144062306a36Sopenharmony_ci kmx61_set_mode(data, KMX61_ALL_STBY, KMX61_ACC | KMX61_MAG, true); 144162306a36Sopenharmony_ci mutex_unlock(&data->lock); 144262306a36Sopenharmony_ci} 144362306a36Sopenharmony_ci 144462306a36Sopenharmony_cistatic int kmx61_suspend(struct device *dev) 144562306a36Sopenharmony_ci{ 144662306a36Sopenharmony_ci int ret; 144762306a36Sopenharmony_ci struct kmx61_data *data = i2c_get_clientdata(to_i2c_client(dev)); 144862306a36Sopenharmony_ci 144962306a36Sopenharmony_ci mutex_lock(&data->lock); 145062306a36Sopenharmony_ci ret = kmx61_set_mode(data, KMX61_ALL_STBY, KMX61_ACC | KMX61_MAG, 145162306a36Sopenharmony_ci false); 145262306a36Sopenharmony_ci mutex_unlock(&data->lock); 145362306a36Sopenharmony_ci 145462306a36Sopenharmony_ci return ret; 145562306a36Sopenharmony_ci} 145662306a36Sopenharmony_ci 145762306a36Sopenharmony_cistatic int kmx61_resume(struct device *dev) 145862306a36Sopenharmony_ci{ 145962306a36Sopenharmony_ci u8 stby = 0; 146062306a36Sopenharmony_ci struct kmx61_data *data = i2c_get_clientdata(to_i2c_client(dev)); 146162306a36Sopenharmony_ci 146262306a36Sopenharmony_ci if (data->acc_stby) 146362306a36Sopenharmony_ci stby |= KMX61_ACC_STBY_BIT; 146462306a36Sopenharmony_ci if (data->mag_stby) 146562306a36Sopenharmony_ci stby |= KMX61_MAG_STBY_BIT; 146662306a36Sopenharmony_ci 146762306a36Sopenharmony_ci return kmx61_set_mode(data, stby, KMX61_ACC | KMX61_MAG, true); 146862306a36Sopenharmony_ci} 146962306a36Sopenharmony_ci 147062306a36Sopenharmony_cistatic int kmx61_runtime_suspend(struct device *dev) 147162306a36Sopenharmony_ci{ 147262306a36Sopenharmony_ci struct kmx61_data *data = i2c_get_clientdata(to_i2c_client(dev)); 147362306a36Sopenharmony_ci int ret; 147462306a36Sopenharmony_ci 147562306a36Sopenharmony_ci mutex_lock(&data->lock); 147662306a36Sopenharmony_ci ret = kmx61_set_mode(data, KMX61_ALL_STBY, KMX61_ACC | KMX61_MAG, true); 147762306a36Sopenharmony_ci mutex_unlock(&data->lock); 147862306a36Sopenharmony_ci 147962306a36Sopenharmony_ci return ret; 148062306a36Sopenharmony_ci} 148162306a36Sopenharmony_ci 148262306a36Sopenharmony_cistatic int kmx61_runtime_resume(struct device *dev) 148362306a36Sopenharmony_ci{ 148462306a36Sopenharmony_ci struct kmx61_data *data = i2c_get_clientdata(to_i2c_client(dev)); 148562306a36Sopenharmony_ci u8 stby = 0; 148662306a36Sopenharmony_ci 148762306a36Sopenharmony_ci if (!data->acc_ps) 148862306a36Sopenharmony_ci stby |= KMX61_ACC_STBY_BIT; 148962306a36Sopenharmony_ci if (!data->mag_ps) 149062306a36Sopenharmony_ci stby |= KMX61_MAG_STBY_BIT; 149162306a36Sopenharmony_ci 149262306a36Sopenharmony_ci return kmx61_set_mode(data, stby, KMX61_ACC | KMX61_MAG, true); 149362306a36Sopenharmony_ci} 149462306a36Sopenharmony_ci 149562306a36Sopenharmony_cistatic const struct dev_pm_ops kmx61_pm_ops = { 149662306a36Sopenharmony_ci SYSTEM_SLEEP_PM_OPS(kmx61_suspend, kmx61_resume) 149762306a36Sopenharmony_ci RUNTIME_PM_OPS(kmx61_runtime_suspend, kmx61_runtime_resume, NULL) 149862306a36Sopenharmony_ci}; 149962306a36Sopenharmony_ci 150062306a36Sopenharmony_cistatic const struct acpi_device_id kmx61_acpi_match[] = { 150162306a36Sopenharmony_ci {"KMX61021", 0}, 150262306a36Sopenharmony_ci {} 150362306a36Sopenharmony_ci}; 150462306a36Sopenharmony_ci 150562306a36Sopenharmony_ciMODULE_DEVICE_TABLE(acpi, kmx61_acpi_match); 150662306a36Sopenharmony_ci 150762306a36Sopenharmony_cistatic const struct i2c_device_id kmx61_id[] = { 150862306a36Sopenharmony_ci {"kmx611021", 0}, 150962306a36Sopenharmony_ci {} 151062306a36Sopenharmony_ci}; 151162306a36Sopenharmony_ci 151262306a36Sopenharmony_ciMODULE_DEVICE_TABLE(i2c, kmx61_id); 151362306a36Sopenharmony_ci 151462306a36Sopenharmony_cistatic struct i2c_driver kmx61_driver = { 151562306a36Sopenharmony_ci .driver = { 151662306a36Sopenharmony_ci .name = KMX61_DRV_NAME, 151762306a36Sopenharmony_ci .acpi_match_table = ACPI_PTR(kmx61_acpi_match), 151862306a36Sopenharmony_ci .pm = pm_ptr(&kmx61_pm_ops), 151962306a36Sopenharmony_ci }, 152062306a36Sopenharmony_ci .probe = kmx61_probe, 152162306a36Sopenharmony_ci .remove = kmx61_remove, 152262306a36Sopenharmony_ci .id_table = kmx61_id, 152362306a36Sopenharmony_ci}; 152462306a36Sopenharmony_ci 152562306a36Sopenharmony_cimodule_i2c_driver(kmx61_driver); 152662306a36Sopenharmony_ci 152762306a36Sopenharmony_ciMODULE_AUTHOR("Daniel Baluta <daniel.baluta@intel.com>"); 152862306a36Sopenharmony_ciMODULE_DESCRIPTION("KMX61 accelerometer/magnetometer driver"); 152962306a36Sopenharmony_ciMODULE_LICENSE("GPL v2"); 1530