kxcjk-1013.c revision 124e1b1d0924ca51ded8bb6f52844b2bc9e485f7
11a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada/* 21a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada * KXCJK-1013 3-axis accelerometer driver 31a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada * Copyright (c) 2014, Intel Corporation. 41a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada * 51a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada * This program is free software; you can redistribute it and/or modify it 61a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada * under the terms and conditions of the GNU General Public License, 71a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada * version 2, as published by the Free Software Foundation. 81a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada * 91a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada * This program is distributed in the hope it will be useful, but WITHOUT 101a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or 111a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for 121a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada * more details. 131a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada */ 141a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 151a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada#include <linux/module.h> 161a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada#include <linux/i2c.h> 171a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada#include <linux/interrupt.h> 181a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada#include <linux/delay.h> 191a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada#include <linux/bitops.h> 201a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada#include <linux/slab.h> 211a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada#include <linux/string.h> 221a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada#include <linux/acpi.h> 231a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada#include <linux/gpio/consumer.h> 24124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada#include <linux/pm.h> 25124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada#include <linux/pm_runtime.h> 261a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada#include <linux/iio/iio.h> 271a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada#include <linux/iio/sysfs.h> 281a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada#include <linux/iio/buffer.h> 291a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada#include <linux/iio/trigger.h> 301a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada#include <linux/iio/trigger_consumer.h> 311a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada#include <linux/iio/triggered_buffer.h> 321a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada#include <linux/iio/accel/kxcjk_1013.h> 331a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 341a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada#define KXCJK1013_DRV_NAME "kxcjk1013" 351a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada#define KXCJK1013_IRQ_NAME "kxcjk1013_event" 361a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 371a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada#define KXCJK1013_REG_XOUT_L 0x06 381a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada/* 391a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada * From low byte X axis register, all the other addresses of Y and Z can be 401a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada * obtained by just applying axis offset. The following axis defines are just 411a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada * provide clarity, but not used. 421a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada */ 431a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada#define KXCJK1013_REG_XOUT_H 0x07 441a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada#define KXCJK1013_REG_YOUT_L 0x08 451a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada#define KXCJK1013_REG_YOUT_H 0x09 461a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada#define KXCJK1013_REG_ZOUT_L 0x0A 471a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada#define KXCJK1013_REG_ZOUT_H 0x0B 481a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 491a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada#define KXCJK1013_REG_DCST_RESP 0x0C 501a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada#define KXCJK1013_REG_WHO_AM_I 0x0F 511a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada#define KXCJK1013_REG_INT_SRC1 0x16 521a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada#define KXCJK1013_REG_INT_SRC2 0x17 531a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada#define KXCJK1013_REG_STATUS_REG 0x18 541a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada#define KXCJK1013_REG_INT_REL 0x1A 551a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada#define KXCJK1013_REG_CTRL1 0x1B 561a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada#define KXCJK1013_REG_CTRL2 0x1D 571a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada#define KXCJK1013_REG_INT_CTRL1 0x1E 581a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada#define KXCJK1013_REG_INT_CTRL2 0x1F 591a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada#define KXCJK1013_REG_DATA_CTRL 0x21 601a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada#define KXCJK1013_REG_WAKE_TIMER 0x29 611a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada#define KXCJK1013_REG_SELF_TEST 0x3A 621a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada#define KXCJK1013_REG_WAKE_THRES 0x6A 631a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 641a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada#define KXCJK1013_REG_CTRL1_BIT_PC1 BIT(7) 651a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada#define KXCJK1013_REG_CTRL1_BIT_RES BIT(6) 661a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada#define KXCJK1013_REG_CTRL1_BIT_DRDY BIT(5) 671a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada#define KXCJK1013_REG_CTRL1_BIT_GSEL1 BIT(4) 681a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada#define KXCJK1013_REG_CTRL1_BIT_GSEL0 BIT(3) 691a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada#define KXCJK1013_REG_CTRL1_BIT_WUFE BIT(1) 701a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada#define KXCJK1013_REG_INT_REG1_BIT_IEA BIT(4) 711a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada#define KXCJK1013_REG_INT_REG1_BIT_IEN BIT(5) 721a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 731a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada#define KXCJK1013_DATA_MASK_12_BIT 0x0FFF 741a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada#define KXCJK1013_MAX_STARTUP_TIME_US 100000 751a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 76124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada#define KXCJK1013_SLEEP_DELAY_MS 2000 77124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada 781a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvadastruct kxcjk1013_data { 791a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada struct i2c_client *client; 801a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada struct iio_trigger *trig; 811a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada bool trig_mode; 821a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada struct mutex mutex; 831a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada s16 buffer[8]; 841a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada u8 odr_bits; 851a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada bool active_high_intr; 86124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada bool trigger_on; 871a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada}; 881a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 891a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvadaenum kxcjk1013_axis { 901a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada AXIS_X, 911a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada AXIS_Y, 921a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada AXIS_Z, 931a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada}; 941a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 951a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvadaenum kxcjk1013_mode { 961a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada STANDBY, 971a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada OPERATION, 981a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada}; 991a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 1001a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvadastatic const struct { 1011a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada int val; 1021a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada int val2; 1031a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada int odr_bits; 1041a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada} samp_freq_table[] = { {0, 781000, 0x08}, {1, 563000, 0x09}, 105f0ca974920686d53cf2330ef8abcc6e4489201d6Srinivas Pandruvada {3, 125000, 0x0A}, {6, 250000, 0x0B}, {12, 500000, 0}, 1061a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada {25, 0, 0x01}, {50, 0, 0x02}, {100, 0, 0x03}, 1071a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada {200, 0, 0x04}, {400, 0, 0x05}, {800, 0, 0x06}, 1081a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada {1600, 0, 0x07} }; 1091a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 1101a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada/* Refer to section 4 of the specification */ 1111a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvadastatic const struct { 1121a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada int odr_bits; 1131a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada int usec; 1141a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada} odr_start_up_times[] = { {0x08, 100000}, {0x09, 100000}, {0x0A, 100000}, 1151a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada {0x0B, 100000}, { 0, 80000}, {0x01, 41000}, 1161a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada {0x02, 21000}, {0x03, 11000}, {0x04, 6400}, 1171a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada {0x05, 3900}, {0x06, 2700}, {0x07, 2100} }; 1181a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 1191a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvadastatic int kxcjk1013_set_mode(struct kxcjk1013_data *data, 1201a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada enum kxcjk1013_mode mode) 1211a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada{ 1221a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada int ret; 1231a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 1241a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada ret = i2c_smbus_read_byte_data(data->client, KXCJK1013_REG_CTRL1); 1251a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada if (ret < 0) { 1261a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada dev_err(&data->client->dev, "Error reading reg_ctrl1\n"); 1271a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada return ret; 1281a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada } 1291a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 1301a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada if (mode == STANDBY) 1311a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada ret &= ~KXCJK1013_REG_CTRL1_BIT_PC1; 1321a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada else 1331a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada ret |= KXCJK1013_REG_CTRL1_BIT_PC1; 1341a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 1351a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada ret = i2c_smbus_write_byte_data(data->client, 1361a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada KXCJK1013_REG_CTRL1, ret); 1371a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada if (ret < 0) { 1381a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada dev_err(&data->client->dev, "Error writing reg_ctrl1\n"); 1391a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada return ret; 1401a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada } 1411a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 1421a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada return 0; 1431a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada} 1441a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 145124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvadastatic int kxcjk1013_get_mode(struct kxcjk1013_data *data, 146124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada enum kxcjk1013_mode *mode) 147124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada{ 148124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada int ret; 149124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada 150124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada ret = i2c_smbus_read_byte_data(data->client, KXCJK1013_REG_CTRL1); 151124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada if (ret < 0) { 152124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada dev_err(&data->client->dev, "Error reading reg_ctrl1\n"); 153124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada return ret; 154124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada } 155124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada 156124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada if (ret & KXCJK1013_REG_CTRL1_BIT_PC1) 157124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada *mode = OPERATION; 158124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada else 159124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada *mode = STANDBY; 160124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada 161124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada return 0; 162124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada} 163124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada 1641a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvadastatic int kxcjk1013_chip_init(struct kxcjk1013_data *data) 1651a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada{ 1661a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada int ret; 1671a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 1681a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada ret = i2c_smbus_read_byte_data(data->client, KXCJK1013_REG_WHO_AM_I); 1691a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada if (ret < 0) { 1701a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada dev_err(&data->client->dev, "Error reading who_am_i\n"); 1711a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada return ret; 1721a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada } 1731a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 1741a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada dev_dbg(&data->client->dev, "KXCJK1013 Chip Id %x\n", ret); 1751a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 1761a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada ret = kxcjk1013_set_mode(data, STANDBY); 1771a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada if (ret < 0) 1781a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada return ret; 1791a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 1801a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada ret = i2c_smbus_read_byte_data(data->client, KXCJK1013_REG_CTRL1); 1811a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada if (ret < 0) { 1821a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada dev_err(&data->client->dev, "Error reading reg_ctrl1\n"); 1831a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada return ret; 1841a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada } 1851a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 1861a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada /* Setting range to 4G */ 1871a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada ret |= KXCJK1013_REG_CTRL1_BIT_GSEL0; 1881a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada ret &= ~KXCJK1013_REG_CTRL1_BIT_GSEL1; 1891a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 1901a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada /* Set 12 bit mode */ 1911a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada ret |= KXCJK1013_REG_CTRL1_BIT_RES; 1921a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 1931a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada ret = i2c_smbus_write_byte_data(data->client, KXCJK1013_REG_CTRL1, 1941a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada ret); 1951a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada if (ret < 0) { 1961a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada dev_err(&data->client->dev, "Error reading reg_ctrl\n"); 1971a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada return ret; 1981a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada } 1991a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 2001a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada ret = i2c_smbus_read_byte_data(data->client, KXCJK1013_REG_DATA_CTRL); 2011a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada if (ret < 0) { 2021a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada dev_err(&data->client->dev, "Error reading reg_data_ctrl\n"); 2031a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada return ret; 2041a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada } 2051a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 2061a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada data->odr_bits = ret; 2071a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 2081a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada /* Set up INT polarity */ 2091a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada ret = i2c_smbus_read_byte_data(data->client, KXCJK1013_REG_INT_CTRL1); 2101a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada if (ret < 0) { 2111a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada dev_err(&data->client->dev, "Error reading reg_int_ctrl1\n"); 2121a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada return ret; 2131a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada } 2141a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 2151a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada if (data->active_high_intr) 2161a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada ret |= KXCJK1013_REG_INT_REG1_BIT_IEA; 2171a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada else 2181a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada ret &= ~KXCJK1013_REG_INT_REG1_BIT_IEA; 2191a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 2201a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada ret = i2c_smbus_write_byte_data(data->client, KXCJK1013_REG_INT_CTRL1, 2211a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada ret); 2221a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada if (ret < 0) { 2231a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada dev_err(&data->client->dev, "Error writing reg_int_ctrl1\n"); 2241a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada return ret; 2251a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada } 2261a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 227124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada ret = kxcjk1013_set_mode(data, OPERATION); 228124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada if (ret < 0) 229124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada return ret; 230124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada 231124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada return 0; 232124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada} 233124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada 234124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvadastatic int kxcjk1013_get_startup_times(struct kxcjk1013_data *data) 235124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada{ 236124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada int i; 237124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada 238124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada for (i = 0; i < ARRAY_SIZE(odr_start_up_times); ++i) { 239124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada if (odr_start_up_times[i].odr_bits == data->odr_bits) 240124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada return odr_start_up_times[i].usec; 241124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada } 242124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada 243124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada return KXCJK1013_MAX_STARTUP_TIME_US; 244124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada} 245124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada 246124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvadastatic int kxcjk1013_set_power_state(struct kxcjk1013_data *data, bool on) 247124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada{ 248124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada int ret; 249124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada 250124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada if (on) 251124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada ret = pm_runtime_get_sync(&data->client->dev); 252124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada else { 253124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada pm_runtime_mark_last_busy(&data->client->dev); 254124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada ret = pm_runtime_put_autosuspend(&data->client->dev); 255124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada } 256124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada if (ret < 0) { 257124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada dev_err(&data->client->dev, 258124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada "Failed: kxcjk1013_set_power_state for %d\n", on); 259124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada return ret; 260124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada } 261124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada 2621a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada return 0; 2631a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada} 2641a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 2651a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvadastatic int kxcjk1013_chip_setup_interrupt(struct kxcjk1013_data *data, 2661a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada bool status) 2671a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada{ 2681a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada int ret; 269124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada enum kxcjk1013_mode store_mode; 270124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada 271124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada ret = kxcjk1013_get_mode(data, &store_mode); 272124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada if (ret < 0) 273124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada return ret; 2741a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 2751a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada /* This is requirement by spec to change state to STANDBY */ 2761a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada ret = kxcjk1013_set_mode(data, STANDBY); 2771a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada if (ret < 0) 2781a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada return ret; 2791a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 2801a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada ret = i2c_smbus_read_byte_data(data->client, KXCJK1013_REG_INT_CTRL1); 2811a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada if (ret < 0) { 2821a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada dev_err(&data->client->dev, "Error reading reg_int_ctrl1\n"); 2831a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada return ret; 2841a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada } 2851a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 2861a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada if (status) 2871a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada ret |= KXCJK1013_REG_INT_REG1_BIT_IEN; 2881a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada else 2891a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada ret &= ~KXCJK1013_REG_INT_REG1_BIT_IEN; 2901a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 2911a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada ret = i2c_smbus_write_byte_data(data->client, KXCJK1013_REG_INT_CTRL1, 2921a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada ret); 2931a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada if (ret < 0) { 2941a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada dev_err(&data->client->dev, "Error writing reg_int_ctrl1\n"); 2951a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada return ret; 2961a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada } 2971a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 2981a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada ret = i2c_smbus_read_byte_data(data->client, KXCJK1013_REG_CTRL1); 2991a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada if (ret < 0) { 3001a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada dev_err(&data->client->dev, "Error reading reg_ctrl1\n"); 3011a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada return ret; 3021a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada } 3031a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 3041a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada if (status) 3051a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada ret |= KXCJK1013_REG_CTRL1_BIT_DRDY; 3061a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada else 3071a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada ret &= ~KXCJK1013_REG_CTRL1_BIT_DRDY; 3081a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 3091a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada ret = i2c_smbus_write_byte_data(data->client, 3101a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada KXCJK1013_REG_CTRL1, ret); 3111a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada if (ret < 0) { 3121a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada dev_err(&data->client->dev, "Error writing reg_ctrl1\n"); 3131a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada return ret; 3141a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada } 3151a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 316124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada if (store_mode == OPERATION) { 317124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada ret = kxcjk1013_set_mode(data, OPERATION); 318124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada if (ret < 0) 319124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada return ret; 320124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada } 321124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada 322124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada return 0; 3231a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada} 3241a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 3251a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvadastatic int kxcjk1013_convert_freq_to_bit(int val, int val2) 3261a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada{ 3271a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada int i; 3281a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 3291a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada for (i = 0; i < ARRAY_SIZE(samp_freq_table); ++i) { 3301a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada if (samp_freq_table[i].val == val && 3311a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada samp_freq_table[i].val2 == val2) { 3321a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada return samp_freq_table[i].odr_bits; 3331a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada } 3341a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada } 3351a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 3361a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada return -EINVAL; 3371a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada} 3381a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 3391a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvadastatic int kxcjk1013_set_odr(struct kxcjk1013_data *data, int val, int val2) 3401a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada{ 3411a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada int ret; 3421a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada int odr_bits; 343124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada enum kxcjk1013_mode store_mode; 344124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada 345124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada ret = kxcjk1013_get_mode(data, &store_mode); 346124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada if (ret < 0) 347124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada return ret; 3481a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 3491a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada odr_bits = kxcjk1013_convert_freq_to_bit(val, val2); 3501a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada if (odr_bits < 0) 3511a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada return odr_bits; 3521a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 3531a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada /* To change ODR, the chip must be set to STANDBY as per spec */ 3541a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada ret = kxcjk1013_set_mode(data, STANDBY); 3551a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada if (ret < 0) 3561a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada return ret; 3571a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 3581a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada ret = i2c_smbus_write_byte_data(data->client, KXCJK1013_REG_DATA_CTRL, 3591a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada odr_bits); 3601a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada if (ret < 0) { 3611a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada dev_err(&data->client->dev, "Error writing data_ctrl\n"); 3621a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada return ret; 3631a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada } 3641a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 3651a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada data->odr_bits = odr_bits; 3661a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 367124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada if (store_mode == OPERATION) { 3681a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada ret = kxcjk1013_set_mode(data, OPERATION); 3691a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada if (ret < 0) 3701a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada return ret; 3711a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada } 3721a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 3731a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada return 0; 3741a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada} 3751a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 3761a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvadastatic int kxcjk1013_get_odr(struct kxcjk1013_data *data, int *val, int *val2) 3771a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada{ 3781a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada int i; 3791a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 3801a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada for (i = 0; i < ARRAY_SIZE(samp_freq_table); ++i) { 3811a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada if (samp_freq_table[i].odr_bits == data->odr_bits) { 3821a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada *val = samp_freq_table[i].val; 3831a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada *val2 = samp_freq_table[i].val2; 3841a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada return IIO_VAL_INT_PLUS_MICRO; 3851a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada } 3861a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada } 3871a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 3881a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada return -EINVAL; 3891a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada} 3901a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 3911a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvadastatic int kxcjk1013_get_acc_reg(struct kxcjk1013_data *data, int axis) 3921a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada{ 3931a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada u8 reg = KXCJK1013_REG_XOUT_L + axis * 2; 3941a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada int ret; 3951a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 3961a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada ret = i2c_smbus_read_word_data(data->client, reg); 3971a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada if (ret < 0) { 3981a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada dev_err(&data->client->dev, 3991a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada "failed to read accel_%c registers\n", 'x' + axis); 4001a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada return ret; 4011a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada } 4021a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 4031a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada return ret; 4041a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada} 4051a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 4061a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvadastatic int kxcjk1013_read_raw(struct iio_dev *indio_dev, 4071a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada struct iio_chan_spec const *chan, int *val, 4081a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada int *val2, long mask) 4091a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada{ 4101a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada struct kxcjk1013_data *data = iio_priv(indio_dev); 4111a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada int ret; 4121a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 4131a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada switch (mask) { 4141a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada case IIO_CHAN_INFO_RAW: 4151a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada mutex_lock(&data->mutex); 4161a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada if (iio_buffer_enabled(indio_dev)) 4171a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada ret = -EBUSY; 4181a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada else { 419124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada ret = kxcjk1013_set_power_state(data, true); 42088f6da779a37a3579e580296776ba86d6c6bd980Srinivas Pandruvada if (ret < 0) { 42188f6da779a37a3579e580296776ba86d6c6bd980Srinivas Pandruvada mutex_unlock(&data->mutex); 4221a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada return ret; 42388f6da779a37a3579e580296776ba86d6c6bd980Srinivas Pandruvada } 4241a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada ret = kxcjk1013_get_acc_reg(data, chan->scan_index); 425124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada if (ret < 0) { 426124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada kxcjk1013_set_power_state(data, false); 427124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada mutex_unlock(&data->mutex); 428124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada return ret; 429124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada } 430124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada *val = sign_extend32(ret >> 4, 11); 431124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada ret = kxcjk1013_set_power_state(data, false); 4321a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada } 4331a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada mutex_unlock(&data->mutex); 4341a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 4351a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada if (ret < 0) 4361a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada return ret; 4371a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 4381a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada return IIO_VAL_INT; 4391a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 4401a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada case IIO_CHAN_INFO_SCALE: 4411a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada *val = 0; 4421a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada *val2 = 19163; /* range +-4g (4/2047*9.806650) */ 4431a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada return IIO_VAL_INT_PLUS_MICRO; 4441a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 4451a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada case IIO_CHAN_INFO_SAMP_FREQ: 4461a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada mutex_lock(&data->mutex); 4471a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada ret = kxcjk1013_get_odr(data, val, val2); 4481a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada mutex_unlock(&data->mutex); 4491a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada return ret; 4501a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 4511a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada default: 4521a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada return -EINVAL; 4531a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada } 4541a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada} 4551a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 4561a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvadastatic int kxcjk1013_write_raw(struct iio_dev *indio_dev, 4571a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada struct iio_chan_spec const *chan, int val, 4581a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada int val2, long mask) 4591a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada{ 4601a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada struct kxcjk1013_data *data = iio_priv(indio_dev); 4611a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada int ret; 4621a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 4631a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada switch (mask) { 4641a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada case IIO_CHAN_INFO_SAMP_FREQ: 4651a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada mutex_lock(&data->mutex); 4661a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada ret = kxcjk1013_set_odr(data, val, val2); 4671a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada mutex_unlock(&data->mutex); 4681a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada break; 4691a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada default: 4701a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada ret = -EINVAL; 4711a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada } 4721a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 4731a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada return ret; 4741a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada} 4751a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 4761a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvadastatic int kxcjk1013_validate_trigger(struct iio_dev *indio_dev, 4771a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada struct iio_trigger *trig) 4781a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada{ 4791a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada struct kxcjk1013_data *data = iio_priv(indio_dev); 4801a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 4811a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada if (data->trig != trig) 4821a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada return -EINVAL; 4831a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 4841a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada return 0; 4851a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada} 4861a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 4871a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvadastatic IIO_CONST_ATTR_SAMP_FREQ_AVAIL( 4881a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada "0.781000 1.563000 3.125000 6.250000 12.500000 25 50 100 200 400 800 1600"); 4891a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 4901a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvadastatic struct attribute *kxcjk1013_attributes[] = { 4911a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada &iio_const_attr_sampling_frequency_available.dev_attr.attr, 4921a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada NULL, 4931a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada}; 4941a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 4951a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvadastatic const struct attribute_group kxcjk1013_attrs_group = { 4961a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada .attrs = kxcjk1013_attributes, 4971a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada}; 4981a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 4991a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada#define KXCJK1013_CHANNEL(_axis) { \ 5001a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada .type = IIO_ACCEL, \ 5011a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada .modified = 1, \ 5021a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada .channel2 = IIO_MOD_##_axis, \ 5031a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada .info_mask_separate = BIT(IIO_CHAN_INFO_RAW), \ 5041a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada .info_mask_shared_by_type = BIT(IIO_CHAN_INFO_SCALE) | \ 5051a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada BIT(IIO_CHAN_INFO_SAMP_FREQ), \ 5061a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada .scan_index = AXIS_##_axis, \ 5071a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada .scan_type = { \ 5081a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada .sign = 's', \ 5091a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada .realbits = 12, \ 5101a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada .storagebits = 16, \ 5111a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada .shift = 4, \ 512f4e2f94d8c1057154728eff974c8ce8688e1ea2dPeter Meerwald .endianness = IIO_CPU, \ 5131a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada }, \ 5141a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada} 5151a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 5161a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvadastatic const struct iio_chan_spec kxcjk1013_channels[] = { 5171a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada KXCJK1013_CHANNEL(X), 5181a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada KXCJK1013_CHANNEL(Y), 5191a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada KXCJK1013_CHANNEL(Z), 5201a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada IIO_CHAN_SOFT_TIMESTAMP(3), 5211a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada}; 5221a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 5231a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvadastatic const struct iio_info kxcjk1013_info = { 5241a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada .attrs = &kxcjk1013_attrs_group, 5251a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada .read_raw = kxcjk1013_read_raw, 5261a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada .write_raw = kxcjk1013_write_raw, 5271a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada .validate_trigger = kxcjk1013_validate_trigger, 5281a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada .driver_module = THIS_MODULE, 5291a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada}; 5301a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 5311a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvadastatic irqreturn_t kxcjk1013_trigger_handler(int irq, void *p) 5321a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada{ 5331a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada struct iio_poll_func *pf = p; 5341a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada struct iio_dev *indio_dev = pf->indio_dev; 5351a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada struct kxcjk1013_data *data = iio_priv(indio_dev); 5361a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada int bit, ret, i = 0; 5371a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 5381a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada mutex_lock(&data->mutex); 5391a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 5401a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada for_each_set_bit(bit, indio_dev->buffer->scan_mask, 5411a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada indio_dev->masklength) { 5421a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada ret = kxcjk1013_get_acc_reg(data, bit); 5431a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada if (ret < 0) { 5441a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada mutex_unlock(&data->mutex); 5451a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada goto err; 5461a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada } 5471a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada data->buffer[i++] = ret; 5481a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada } 5491a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada mutex_unlock(&data->mutex); 5501a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 5511a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada iio_push_to_buffers_with_timestamp(indio_dev, data->buffer, 5521a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada pf->timestamp); 5531a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvadaerr: 5541a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada iio_trigger_notify_done(indio_dev->trig); 5551a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 5561a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada return IRQ_HANDLED; 5571a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada} 5581a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 55959bfeaba3b62089f98952fe689d44a093275b1a0Srinivas Pandruvadastatic int kxcjk1013_trig_try_reen(struct iio_trigger *trig) 56059bfeaba3b62089f98952fe689d44a093275b1a0Srinivas Pandruvada{ 56159bfeaba3b62089f98952fe689d44a093275b1a0Srinivas Pandruvada struct iio_dev *indio_dev = iio_trigger_get_drvdata(trig); 56259bfeaba3b62089f98952fe689d44a093275b1a0Srinivas Pandruvada struct kxcjk1013_data *data = iio_priv(indio_dev); 56359bfeaba3b62089f98952fe689d44a093275b1a0Srinivas Pandruvada int ret; 56459bfeaba3b62089f98952fe689d44a093275b1a0Srinivas Pandruvada 56559bfeaba3b62089f98952fe689d44a093275b1a0Srinivas Pandruvada ret = i2c_smbus_read_byte_data(data->client, KXCJK1013_REG_INT_REL); 56659bfeaba3b62089f98952fe689d44a093275b1a0Srinivas Pandruvada if (ret < 0) { 56759bfeaba3b62089f98952fe689d44a093275b1a0Srinivas Pandruvada dev_err(&data->client->dev, "Error reading reg_int_rel\n"); 56859bfeaba3b62089f98952fe689d44a093275b1a0Srinivas Pandruvada return ret; 56959bfeaba3b62089f98952fe689d44a093275b1a0Srinivas Pandruvada } 57059bfeaba3b62089f98952fe689d44a093275b1a0Srinivas Pandruvada 57159bfeaba3b62089f98952fe689d44a093275b1a0Srinivas Pandruvada return 0; 57259bfeaba3b62089f98952fe689d44a093275b1a0Srinivas Pandruvada} 57359bfeaba3b62089f98952fe689d44a093275b1a0Srinivas Pandruvada 5741a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvadastatic int kxcjk1013_data_rdy_trigger_set_state(struct iio_trigger *trig, 5751a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada bool state) 5761a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada{ 5771a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada struct iio_dev *indio_dev = iio_trigger_get_drvdata(trig); 5781a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada struct kxcjk1013_data *data = iio_priv(indio_dev); 579124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada int ret; 580124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada 581124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada if (state && data->trigger_on) 582124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada return 0; 5831a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 5841a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada mutex_lock(&data->mutex); 585124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada ret = kxcjk1013_chip_setup_interrupt(data, state); 586124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada if (!ret) { 587124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada ret = kxcjk1013_set_power_state(data, state); 588124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada if (ret < 0) { 58988f6da779a37a3579e580296776ba86d6c6bd980Srinivas Pandruvada mutex_unlock(&data->mutex); 590124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada return ret; 59188f6da779a37a3579e580296776ba86d6c6bd980Srinivas Pandruvada } 5921a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada } 593124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada data->trigger_on = state; 5941a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada mutex_unlock(&data->mutex); 5951a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 5961a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada return 0; 5971a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada} 5981a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 5991a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvadastatic const struct iio_trigger_ops kxcjk1013_trigger_ops = { 6001a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada .set_trigger_state = kxcjk1013_data_rdy_trigger_set_state, 60159bfeaba3b62089f98952fe689d44a093275b1a0Srinivas Pandruvada .try_reenable = kxcjk1013_trig_try_reen, 6021a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada .owner = THIS_MODULE, 6031a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada}; 6041a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 6051a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvadastatic int kxcjk1013_acpi_gpio_probe(struct i2c_client *client, 6061a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada struct kxcjk1013_data *data) 6071a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada{ 6081a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada const struct acpi_device_id *id; 6091a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada struct device *dev; 6101a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada struct gpio_desc *gpio; 6111a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada int ret; 6121a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 6131a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada if (!client) 6141a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada return -EINVAL; 6151a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 6161a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada dev = &client->dev; 6171a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada if (!ACPI_HANDLE(dev)) 6181a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada return -ENODEV; 6191a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 6201a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada id = acpi_match_device(dev->driver->acpi_match_table, dev); 6211a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada if (!id) 6221a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada return -ENODEV; 6231a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 6241a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada /* data ready gpio interrupt pin */ 6251a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada gpio = devm_gpiod_get_index(dev, "kxcjk1013_int", 0); 6261a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada if (IS_ERR(gpio)) { 6271a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada dev_err(dev, "acpi gpio get index failed\n"); 6281a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada return PTR_ERR(gpio); 6291a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada } 6301a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 6311a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada ret = gpiod_direction_input(gpio); 6321a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada if (ret) 6331a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada return ret; 6341a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 6351a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada ret = gpiod_to_irq(gpio); 6361a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 6371a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada dev_dbg(dev, "GPIO resource, no:%d irq:%d\n", desc_to_gpio(gpio), ret); 6381a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 6391a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada return ret; 6401a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada} 6411a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 6421a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvadastatic int kxcjk1013_probe(struct i2c_client *client, 6431a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada const struct i2c_device_id *id) 6441a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada{ 6451a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada struct kxcjk1013_data *data; 6461a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada struct iio_dev *indio_dev; 6471a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada struct iio_trigger *trig = NULL; 6481a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada struct kxcjk_1013_platform_data *pdata; 6491a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada int ret; 6501a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 6511a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada indio_dev = devm_iio_device_alloc(&client->dev, sizeof(*data)); 6521a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada if (!indio_dev) 6531a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada return -ENOMEM; 6541a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 6551a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada data = iio_priv(indio_dev); 6561a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada i2c_set_clientdata(client, indio_dev); 6571a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada data->client = client; 6581a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 6591a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada pdata = dev_get_platdata(&client->dev); 6601a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada if (pdata) 6611a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada data->active_high_intr = pdata->active_high_intr; 6621a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada else 6631a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada data->active_high_intr = true; /* default polarity */ 6641a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 6651a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada ret = kxcjk1013_chip_init(data); 6661a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada if (ret < 0) 6671a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada return ret; 6681a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 6691a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada mutex_init(&data->mutex); 6701a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 6711a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada indio_dev->dev.parent = &client->dev; 6721a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada indio_dev->channels = kxcjk1013_channels; 6731a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada indio_dev->num_channels = ARRAY_SIZE(kxcjk1013_channels); 6741a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada indio_dev->name = KXCJK1013_DRV_NAME; 6751a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada indio_dev->modes = INDIO_DIRECT_MODE; 6761a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada indio_dev->info = &kxcjk1013_info; 6771a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 6781a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada if (client->irq < 0) 6791a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada client->irq = kxcjk1013_acpi_gpio_probe(client, data); 6801a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 6811a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada if (client->irq >= 0) { 6821a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada trig = iio_trigger_alloc("%s-dev%d", indio_dev->name, 6831a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada indio_dev->id); 6841a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada if (!trig) 6851a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada return -ENOMEM; 6861a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 6871a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada data->trig_mode = true; 6881a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 6891a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada ret = devm_request_irq(&client->dev, client->irq, 6901a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada iio_trigger_generic_data_rdy_poll, 6911a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada IRQF_TRIGGER_RISING, 6921a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada KXCJK1013_IRQ_NAME, 6931a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada trig); 6941a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada if (ret) { 6951a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada dev_err(&client->dev, "unable to request IRQ\n"); 6961a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada goto err_trigger_free; 6971a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada } 6981a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 6991a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada trig->dev.parent = &client->dev; 7001a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada trig->ops = &kxcjk1013_trigger_ops; 7011a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada iio_trigger_set_drvdata(trig, indio_dev); 7021a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada data->trig = trig; 7031a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada indio_dev->trig = trig; 704c1288b8338815d6d17577b6b6a1267e7be8bc409Srinivas Pandruvada iio_trigger_get(indio_dev->trig); 7051a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 7061a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada ret = iio_trigger_register(trig); 7071a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada if (ret) 7081a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada goto err_trigger_free; 7091a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 7101a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada ret = iio_triggered_buffer_setup(indio_dev, 7111a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada &iio_pollfunc_store_time, 7121a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada kxcjk1013_trigger_handler, 7131a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada NULL); 7141a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada if (ret < 0) { 7151a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada dev_err(&client->dev, 7161a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada "iio triggered buffer setup failed\n"); 7171a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada goto err_trigger_unregister; 7181a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada } 7191a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada } 7201a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 721124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada ret = iio_device_register(indio_dev); 7221a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada if (ret < 0) { 7231a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada dev_err(&client->dev, "unable to register iio device\n"); 7241a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada goto err_buffer_cleanup; 7251a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada } 7261a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 727124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada ret = pm_runtime_set_active(&client->dev); 728124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada if (ret) 729124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada goto err_iio_unregister; 730124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada 731124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada pm_runtime_enable(&client->dev); 732124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada pm_runtime_set_autosuspend_delay(&client->dev, 733124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada KXCJK1013_SLEEP_DELAY_MS); 734124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada pm_runtime_use_autosuspend(&client->dev); 735124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada 7361a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada return 0; 7371a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 738124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvadaerr_iio_unregister: 739124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada iio_device_unregister(indio_dev); 7401a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvadaerr_buffer_cleanup: 7411a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada if (data->trig_mode) 7421a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada iio_triggered_buffer_cleanup(indio_dev); 7431a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvadaerr_trigger_unregister: 7441a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada if (data->trig_mode) 7451a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada iio_trigger_unregister(trig); 7461a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvadaerr_trigger_free: 7471a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada if (data->trig_mode) 7481a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada iio_trigger_free(trig); 7491a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 7501a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada return ret; 7511a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada} 7521a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 7531a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvadastatic int kxcjk1013_remove(struct i2c_client *client) 7541a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada{ 7551a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada struct iio_dev *indio_dev = i2c_get_clientdata(client); 7561a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada struct kxcjk1013_data *data = iio_priv(indio_dev); 7571a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 758124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada pm_runtime_disable(&client->dev); 759124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada pm_runtime_set_suspended(&client->dev); 760124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada pm_runtime_put_noidle(&client->dev); 761124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada 762124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada iio_device_unregister(indio_dev); 763124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada 7641a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada if (data->trig_mode) { 7651a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada iio_triggered_buffer_cleanup(indio_dev); 7661a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada iio_trigger_unregister(data->trig); 7671a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada iio_trigger_free(data->trig); 7681a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada } 7691a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 7701a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada mutex_lock(&data->mutex); 7711a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada kxcjk1013_set_mode(data, STANDBY); 7721a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada mutex_unlock(&data->mutex); 7731a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 7741a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada return 0; 7751a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada} 7761a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 7771a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada#ifdef CONFIG_PM_SLEEP 7781a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvadastatic int kxcjk1013_suspend(struct device *dev) 7791a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada{ 7801a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada struct iio_dev *indio_dev = i2c_get_clientdata(to_i2c_client(dev)); 7811a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada struct kxcjk1013_data *data = iio_priv(indio_dev); 782124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada int ret; 7831a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 7841a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada mutex_lock(&data->mutex); 785124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada ret = kxcjk1013_set_mode(data, STANDBY); 7861a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada mutex_unlock(&data->mutex); 7871a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 788124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada return ret; 7891a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada} 7901a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 7911a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvadastatic int kxcjk1013_resume(struct device *dev) 7921a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada{ 7931a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada struct iio_dev *indio_dev = i2c_get_clientdata(to_i2c_client(dev)); 7941a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada struct kxcjk1013_data *data = iio_priv(indio_dev); 795124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada int ret = 0; 7961a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 7971a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada mutex_lock(&data->mutex); 798124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada /* Check, if the suspend occured while active */ 799124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada if (data->trigger_on) 800124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada ret = kxcjk1013_set_mode(data, OPERATION); 801124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada mutex_unlock(&data->mutex); 8021a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 803124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada return ret; 804124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada} 805124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada#endif 8061a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 807124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada#ifdef CONFIG_PM_RUNTIME 808124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvadastatic int kxcjk1013_runtime_suspend(struct device *dev) 809124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada{ 810124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada struct iio_dev *indio_dev = i2c_get_clientdata(to_i2c_client(dev)); 811124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada struct kxcjk1013_data *data = iio_priv(indio_dev); 8121a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 813124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada return kxcjk1013_set_mode(data, STANDBY); 8141a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada} 8151a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 816124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvadastatic int kxcjk1013_runtime_resume(struct device *dev) 817124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada{ 818124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada struct iio_dev *indio_dev = i2c_get_clientdata(to_i2c_client(dev)); 819124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada struct kxcjk1013_data *data = iio_priv(indio_dev); 820124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada int ret; 821124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada int sleep_val; 822124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada 823124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada ret = kxcjk1013_set_mode(data, OPERATION); 824124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada if (ret < 0) 825124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada return ret; 826124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada 827124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada sleep_val = kxcjk1013_get_startup_times(data); 828124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada if (sleep_val < 20000) 829124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada usleep_range(sleep_val, 20000); 830124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada else 831124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada msleep_interruptible(sleep_val/1000); 832124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada 833124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada return 0; 834124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada} 8351a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada#endif 8361a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 837124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvadastatic const struct dev_pm_ops kxcjk1013_pm_ops = { 838124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada SET_SYSTEM_SLEEP_PM_OPS(kxcjk1013_suspend, kxcjk1013_resume) 839124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada SET_RUNTIME_PM_OPS(kxcjk1013_runtime_suspend, 840124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada kxcjk1013_runtime_resume, NULL) 841124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada}; 842124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada 8431a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvadastatic const struct acpi_device_id kx_acpi_match[] = { 8441a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada {"KXCJ1013", 0}, 8451a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada { }, 8461a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada}; 8471a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas PandruvadaMODULE_DEVICE_TABLE(acpi, kx_acpi_match); 8481a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 8491a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvadastatic const struct i2c_device_id kxcjk1013_id[] = { 8501a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada {"kxcjk1013", 0}, 8511a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada {} 8521a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada}; 8531a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 8541a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas PandruvadaMODULE_DEVICE_TABLE(i2c, kxcjk1013_id); 8551a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 8561a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvadastatic struct i2c_driver kxcjk1013_driver = { 8571a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada .driver = { 8581a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada .name = KXCJK1013_DRV_NAME, 8591a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada .acpi_match_table = ACPI_PTR(kx_acpi_match), 860124e1b1d0924ca51ded8bb6f52844b2bc9e485f7Srinivas Pandruvada .pm = &kxcjk1013_pm_ops, 8611a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada }, 8621a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada .probe = kxcjk1013_probe, 8631a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada .remove = kxcjk1013_remove, 8641a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada .id_table = kxcjk1013_id, 8651a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada}; 8661a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvadamodule_i2c_driver(kxcjk1013_driver); 8671a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas Pandruvada 8681a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas PandruvadaMODULE_AUTHOR("Srinivas Pandruvada <srinivas.pandruvada@linux.intel.com>"); 8691a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas PandruvadaMODULE_LICENSE("GPL v2"); 8701a4fbf6a9286a6e3db497bc7bbae2024f0f1ad90Srinivas PandruvadaMODULE_DESCRIPTION("KXCJK1013 accelerometer driver"); 871