linux-stable/drivers/input/misc/iqs626a.c
Jeff LaBundy 4d3d2694e1 Input: iqs626a - drop unused device node references
Each call to device/fwnode_get_named_child_node() must be matched
with a call to fwnode_handle_put() once the corresponding node is
no longer in use. This ensures a reference count remains balanced
in the case of dynamic device tree support.

Currently, the driver never calls fwnode_handle_put(); this patch
adds the missing calls. Because fwnode_handle_put() does not take
a const *fwnode_handle, the const qualifier is removed across all
corresponding *fwnode_handle instances.

As part of this change, trackpad channel touch thresholds and ATI
base values are now specified under single trackpad channel child
nodes. This enhancement moves both properties to scalar values as
opposed to arrays, making their types consistent across bindings.

Fixes: f1d2809de9 ("Input: Add support for Azoteq IQS626A")
Signed-off-by: Jeff LaBundy <jeff@labundy.com>
Link: https://lore.kernel.org/r/Y9RQVe/V1Hnw1oly@nixie71
Signed-off-by: Dmitry Torokhov <dmitry.torokhov@gmail.com>
2023-02-03 17:21:04 -08:00

1831 lines
47 KiB
C

// SPDX-License-Identifier: GPL-2.0+
/*
* Azoteq IQS626A Capacitive Touch Controller
*
* Copyright (C) 2020 Jeff LaBundy <jeff@labundy.com>
*
* This driver registers up to 2 input devices: one representing capacitive or
* inductive keys as well as Hall-effect switches, and one for a trackpad that
* can express various gestures.
*/
#include <linux/bits.h>
#include <linux/completion.h>
#include <linux/delay.h>
#include <linux/device.h>
#include <linux/err.h>
#include <linux/i2c.h>
#include <linux/input.h>
#include <linux/input/touchscreen.h>
#include <linux/interrupt.h>
#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/of_device.h>
#include <linux/property.h>
#include <linux/regmap.h>
#include <linux/slab.h>
#define IQS626_VER_INFO 0x00
#define IQS626_VER_INFO_PROD_NUM 0x51
#define IQS626_SYS_FLAGS 0x02
#define IQS626_SYS_FLAGS_SHOW_RESET BIT(15)
#define IQS626_SYS_FLAGS_IN_ATI BIT(12)
#define IQS626_SYS_FLAGS_PWR_MODE_MASK GENMASK(9, 8)
#define IQS626_SYS_FLAGS_PWR_MODE_SHIFT 8
#define IQS626_HALL_OUTPUT 0x23
#define IQS626_SYS_SETTINGS 0x80
#define IQS626_SYS_SETTINGS_CLK_DIV BIT(15)
#define IQS626_SYS_SETTINGS_ULP_AUTO BIT(14)
#define IQS626_SYS_SETTINGS_DIS_AUTO BIT(13)
#define IQS626_SYS_SETTINGS_PWR_MODE_MASK GENMASK(12, 11)
#define IQS626_SYS_SETTINGS_PWR_MODE_SHIFT 11
#define IQS626_SYS_SETTINGS_PWR_MODE_MAX 3
#define IQS626_SYS_SETTINGS_ULP_UPDATE_MASK GENMASK(10, 8)
#define IQS626_SYS_SETTINGS_ULP_UPDATE_SHIFT 8
#define IQS626_SYS_SETTINGS_ULP_UPDATE_MAX 7
#define IQS626_SYS_SETTINGS_EVENT_MODE BIT(5)
#define IQS626_SYS_SETTINGS_EVENT_MODE_LP BIT(4)
#define IQS626_SYS_SETTINGS_REDO_ATI BIT(2)
#define IQS626_SYS_SETTINGS_ACK_RESET BIT(0)
#define IQS626_MISC_A_ATI_BAND_DISABLE BIT(7)
#define IQS626_MISC_A_TPx_LTA_UPDATE_MASK GENMASK(6, 4)
#define IQS626_MISC_A_TPx_LTA_UPDATE_SHIFT 4
#define IQS626_MISC_A_TPx_LTA_UPDATE_MAX 7
#define IQS626_MISC_A_ATI_LP_ONLY BIT(3)
#define IQS626_MISC_A_GPIO3_SELECT_MASK GENMASK(2, 0)
#define IQS626_MISC_A_GPIO3_SELECT_MAX 7
#define IQS626_EVENT_MASK_SYS BIT(6)
#define IQS626_EVENT_MASK_GESTURE BIT(3)
#define IQS626_EVENT_MASK_DEEP BIT(2)
#define IQS626_EVENT_MASK_TOUCH BIT(1)
#define IQS626_EVENT_MASK_PROX BIT(0)
#define IQS626_RATE_NP_MS_MAX 255
#define IQS626_RATE_LP_MS_MAX 255
#define IQS626_RATE_ULP_MS_MAX 4080
#define IQS626_TIMEOUT_PWR_MS_MAX 130560
#define IQS626_TIMEOUT_LTA_MS_MAX 130560
#define IQS626_MISC_B_RESEED_UI_SEL_MASK GENMASK(7, 6)
#define IQS626_MISC_B_RESEED_UI_SEL_SHIFT 6
#define IQS626_MISC_B_RESEED_UI_SEL_MAX 3
#define IQS626_MISC_B_THRESH_EXTEND BIT(5)
#define IQS626_MISC_B_TRACKING_UI_ENABLE BIT(4)
#define IQS626_MISC_B_TPx_SWIPE BIT(3)
#define IQS626_MISC_B_RESEED_OFFSET BIT(2)
#define IQS626_MISC_B_FILT_STR_TPx GENMASK(1, 0)
#define IQS626_THRESH_SWIPE_MAX 255
#define IQS626_TIMEOUT_TAP_MS_MAX 4080
#define IQS626_TIMEOUT_SWIPE_MS_MAX 4080
#define IQS626_CHx_ENG_0_MEAS_CAP_SIZE BIT(7)
#define IQS626_CHx_ENG_0_RX_TERM_VSS BIT(5)
#define IQS626_CHx_ENG_0_LINEARIZE BIT(4)
#define IQS626_CHx_ENG_0_DUAL_DIR BIT(3)
#define IQS626_CHx_ENG_0_FILT_DISABLE BIT(2)
#define IQS626_CHx_ENG_0_ATI_MODE_MASK GENMASK(1, 0)
#define IQS626_CHx_ENG_0_ATI_MODE_MAX 3
#define IQS626_CHx_ENG_1_CCT_HIGH_1 BIT(7)
#define IQS626_CHx_ENG_1_CCT_HIGH_0 BIT(6)
#define IQS626_CHx_ENG_1_PROJ_BIAS_MASK GENMASK(5, 4)
#define IQS626_CHx_ENG_1_PROJ_BIAS_SHIFT 4
#define IQS626_CHx_ENG_1_PROJ_BIAS_MAX 3
#define IQS626_CHx_ENG_1_CCT_ENABLE BIT(3)
#define IQS626_CHx_ENG_1_SENSE_FREQ_MASK GENMASK(2, 1)
#define IQS626_CHx_ENG_1_SENSE_FREQ_SHIFT 1
#define IQS626_CHx_ENG_1_SENSE_FREQ_MAX 3
#define IQS626_CHx_ENG_1_ATI_BAND_TIGHTEN BIT(0)
#define IQS626_CHx_ENG_2_LOCAL_CAP_MASK GENMASK(7, 6)
#define IQS626_CHx_ENG_2_LOCAL_CAP_SHIFT 6
#define IQS626_CHx_ENG_2_LOCAL_CAP_MAX 3
#define IQS626_CHx_ENG_2_LOCAL_CAP_ENABLE BIT(5)
#define IQS626_CHx_ENG_2_SENSE_MODE_MASK GENMASK(3, 0)
#define IQS626_CHx_ENG_2_SENSE_MODE_MAX 15
#define IQS626_CHx_ENG_3_TX_FREQ_MASK GENMASK(5, 4)
#define IQS626_CHx_ENG_3_TX_FREQ_SHIFT 4
#define IQS626_CHx_ENG_3_TX_FREQ_MAX 3
#define IQS626_CHx_ENG_3_INV_LOGIC BIT(0)
#define IQS626_CHx_ENG_4_RX_TERM_VREG BIT(6)
#define IQS626_CHx_ENG_4_CCT_LOW_1 BIT(5)
#define IQS626_CHx_ENG_4_CCT_LOW_0 BIT(4)
#define IQS626_CHx_ENG_4_COMP_DISABLE BIT(1)
#define IQS626_CHx_ENG_4_STATIC_ENABLE BIT(0)
#define IQS626_TPx_ATI_BASE_MIN 45
#define IQS626_TPx_ATI_BASE_MAX 300
#define IQS626_CHx_ATI_BASE_MASK GENMASK(7, 6)
#define IQS626_CHx_ATI_BASE_75 0x00
#define IQS626_CHx_ATI_BASE_100 0x40
#define IQS626_CHx_ATI_BASE_150 0x80
#define IQS626_CHx_ATI_BASE_200 0xC0
#define IQS626_CHx_ATI_TARGET_MASK GENMASK(5, 0)
#define IQS626_CHx_ATI_TARGET_MAX 2016
#define IQS626_CHx_THRESH_MAX 255
#define IQS626_CHx_HYST_DEEP_MASK GENMASK(7, 4)
#define IQS626_CHx_HYST_DEEP_SHIFT 4
#define IQS626_CHx_HYST_TOUCH_MASK GENMASK(3, 0)
#define IQS626_CHx_HYST_MAX 15
#define IQS626_FILT_STR_NP_TPx_MASK GENMASK(7, 6)
#define IQS626_FILT_STR_NP_TPx_SHIFT 6
#define IQS626_FILT_STR_LP_TPx_MASK GENMASK(5, 4)
#define IQS626_FILT_STR_LP_TPx_SHIFT 4
#define IQS626_FILT_STR_NP_CNT_MASK GENMASK(7, 6)
#define IQS626_FILT_STR_NP_CNT_SHIFT 6
#define IQS626_FILT_STR_LP_CNT_MASK GENMASK(5, 4)
#define IQS626_FILT_STR_LP_CNT_SHIFT 4
#define IQS626_FILT_STR_NP_LTA_MASK GENMASK(3, 2)
#define IQS626_FILT_STR_NP_LTA_SHIFT 2
#define IQS626_FILT_STR_LP_LTA_MASK GENMASK(1, 0)
#define IQS626_FILT_STR_MAX 3
#define IQS626_ULP_PROJ_ENABLE BIT(4)
#define IQS626_GEN_WEIGHT_MAX 255
#define IQS626_MAX_REG 0xFF
#define IQS626_NUM_CH_TP_3 9
#define IQS626_NUM_CH_TP_2 6
#define IQS626_NUM_CH_GEN 3
#define IQS626_NUM_CRx_TX 8
#define IQS626_PWR_MODE_POLL_SLEEP_US 50000
#define IQS626_PWR_MODE_POLL_TIMEOUT_US 500000
#define iqs626_irq_wait() usleep_range(350, 400)
enum iqs626_ch_id {
IQS626_CH_ULP_0,
IQS626_CH_TP_2,
IQS626_CH_TP_3,
IQS626_CH_GEN_0,
IQS626_CH_GEN_1,
IQS626_CH_GEN_2,
IQS626_CH_HALL,
};
enum iqs626_rx_inactive {
IQS626_RX_INACTIVE_VSS,
IQS626_RX_INACTIVE_FLOAT,
IQS626_RX_INACTIVE_VREG,
};
enum iqs626_st_offs {
IQS626_ST_OFFS_PROX,
IQS626_ST_OFFS_DIR,
IQS626_ST_OFFS_TOUCH,
IQS626_ST_OFFS_DEEP,
};
enum iqs626_th_offs {
IQS626_TH_OFFS_PROX,
IQS626_TH_OFFS_TOUCH,
IQS626_TH_OFFS_DEEP,
};
enum iqs626_event_id {
IQS626_EVENT_PROX_DN,
IQS626_EVENT_PROX_UP,
IQS626_EVENT_TOUCH_DN,
IQS626_EVENT_TOUCH_UP,
IQS626_EVENT_DEEP_DN,
IQS626_EVENT_DEEP_UP,
};
enum iqs626_gesture_id {
IQS626_GESTURE_FLICK_X_POS,
IQS626_GESTURE_FLICK_X_NEG,
IQS626_GESTURE_FLICK_Y_POS,
IQS626_GESTURE_FLICK_Y_NEG,
IQS626_GESTURE_TAP,
IQS626_GESTURE_HOLD,
IQS626_NUM_GESTURES,
};
struct iqs626_event_desc {
const char *name;
enum iqs626_st_offs st_offs;
enum iqs626_th_offs th_offs;
bool dir_up;
u8 mask;
};
static const struct iqs626_event_desc iqs626_events[] = {
[IQS626_EVENT_PROX_DN] = {
.name = "event-prox",
.st_offs = IQS626_ST_OFFS_PROX,
.th_offs = IQS626_TH_OFFS_PROX,
.mask = IQS626_EVENT_MASK_PROX,
},
[IQS626_EVENT_PROX_UP] = {
.name = "event-prox-alt",
.st_offs = IQS626_ST_OFFS_PROX,
.th_offs = IQS626_TH_OFFS_PROX,
.dir_up = true,
.mask = IQS626_EVENT_MASK_PROX,
},
[IQS626_EVENT_TOUCH_DN] = {
.name = "event-touch",
.st_offs = IQS626_ST_OFFS_TOUCH,
.th_offs = IQS626_TH_OFFS_TOUCH,
.mask = IQS626_EVENT_MASK_TOUCH,
},
[IQS626_EVENT_TOUCH_UP] = {
.name = "event-touch-alt",
.st_offs = IQS626_ST_OFFS_TOUCH,
.th_offs = IQS626_TH_OFFS_TOUCH,
.dir_up = true,
.mask = IQS626_EVENT_MASK_TOUCH,
},
[IQS626_EVENT_DEEP_DN] = {
.name = "event-deep",
.st_offs = IQS626_ST_OFFS_DEEP,
.th_offs = IQS626_TH_OFFS_DEEP,
.mask = IQS626_EVENT_MASK_DEEP,
},
[IQS626_EVENT_DEEP_UP] = {
.name = "event-deep-alt",
.st_offs = IQS626_ST_OFFS_DEEP,
.th_offs = IQS626_TH_OFFS_DEEP,
.dir_up = true,
.mask = IQS626_EVENT_MASK_DEEP,
},
};
struct iqs626_ver_info {
u8 prod_num;
u8 sw_num;
u8 hw_num;
u8 padding;
} __packed;
struct iqs626_flags {
__be16 system;
u8 gesture;
u8 padding_a;
u8 states[4];
u8 ref_active;
u8 padding_b;
u8 comp_min;
u8 comp_max;
u8 trackpad_x;
u8 trackpad_y;
} __packed;
struct iqs626_ch_reg_ulp {
u8 thresh[2];
u8 hyst;
u8 filter;
u8 engine[2];
u8 ati_target;
u8 padding;
__be16 ati_comp;
u8 rx_enable;
u8 tx_enable;
} __packed;
struct iqs626_ch_reg_tp {
u8 thresh;
u8 ati_base;
__be16 ati_comp;
} __packed;
struct iqs626_tp_grp_reg {
u8 hyst;
u8 ati_target;
u8 engine[2];
struct iqs626_ch_reg_tp ch_reg_tp[IQS626_NUM_CH_TP_3];
} __packed;
struct iqs626_ch_reg_gen {
u8 thresh[3];
u8 padding;
u8 hyst;
u8 ati_target;
__be16 ati_comp;
u8 engine[5];
u8 filter;
u8 rx_enable;
u8 tx_enable;
u8 assoc_select;
u8 assoc_weight;
} __packed;
struct iqs626_ch_reg_hall {
u8 engine;
u8 thresh;
u8 hyst;
u8 ati_target;
__be16 ati_comp;
} __packed;
struct iqs626_sys_reg {
__be16 general;
u8 misc_a;
u8 event_mask;
u8 active;
u8 reseed;
u8 rate_np;
u8 rate_lp;
u8 rate_ulp;
u8 timeout_pwr;
u8 timeout_rdy;
u8 timeout_lta;
u8 misc_b;
u8 thresh_swipe;
u8 timeout_tap;
u8 timeout_swipe;
u8 redo_ati;
u8 padding;
struct iqs626_ch_reg_ulp ch_reg_ulp;
struct iqs626_tp_grp_reg tp_grp_reg;
struct iqs626_ch_reg_gen ch_reg_gen[IQS626_NUM_CH_GEN];
struct iqs626_ch_reg_hall ch_reg_hall;
} __packed;
struct iqs626_channel_desc {
const char *name;
int num_ch;
u8 active;
bool events[ARRAY_SIZE(iqs626_events)];
};
static const struct iqs626_channel_desc iqs626_channels[] = {
[IQS626_CH_ULP_0] = {
.name = "ulp-0",
.num_ch = 1,
.active = BIT(0),
.events = {
[IQS626_EVENT_PROX_DN] = true,
[IQS626_EVENT_PROX_UP] = true,
[IQS626_EVENT_TOUCH_DN] = true,
[IQS626_EVENT_TOUCH_UP] = true,
},
},
[IQS626_CH_TP_2] = {
.name = "trackpad-3x2",
.num_ch = IQS626_NUM_CH_TP_2,
.active = BIT(1),
.events = {
[IQS626_EVENT_TOUCH_DN] = true,
},
},
[IQS626_CH_TP_3] = {
.name = "trackpad-3x3",
.num_ch = IQS626_NUM_CH_TP_3,
.active = BIT(2) | BIT(1),
.events = {
[IQS626_EVENT_TOUCH_DN] = true,
},
},
[IQS626_CH_GEN_0] = {
.name = "generic-0",
.num_ch = 1,
.active = BIT(4),
.events = {
[IQS626_EVENT_PROX_DN] = true,
[IQS626_EVENT_PROX_UP] = true,
[IQS626_EVENT_TOUCH_DN] = true,
[IQS626_EVENT_TOUCH_UP] = true,
[IQS626_EVENT_DEEP_DN] = true,
[IQS626_EVENT_DEEP_UP] = true,
},
},
[IQS626_CH_GEN_1] = {
.name = "generic-1",
.num_ch = 1,
.active = BIT(5),
.events = {
[IQS626_EVENT_PROX_DN] = true,
[IQS626_EVENT_PROX_UP] = true,
[IQS626_EVENT_TOUCH_DN] = true,
[IQS626_EVENT_TOUCH_UP] = true,
[IQS626_EVENT_DEEP_DN] = true,
[IQS626_EVENT_DEEP_UP] = true,
},
},
[IQS626_CH_GEN_2] = {
.name = "generic-2",
.num_ch = 1,
.active = BIT(6),
.events = {
[IQS626_EVENT_PROX_DN] = true,
[IQS626_EVENT_PROX_UP] = true,
[IQS626_EVENT_TOUCH_DN] = true,
[IQS626_EVENT_TOUCH_UP] = true,
[IQS626_EVENT_DEEP_DN] = true,
[IQS626_EVENT_DEEP_UP] = true,
},
},
[IQS626_CH_HALL] = {
.name = "hall",
.num_ch = 1,
.active = BIT(7),
.events = {
[IQS626_EVENT_TOUCH_DN] = true,
[IQS626_EVENT_TOUCH_UP] = true,
},
},
};
struct iqs626_private {
struct i2c_client *client;
struct regmap *regmap;
struct iqs626_sys_reg sys_reg;
struct completion ati_done;
struct input_dev *keypad;
struct input_dev *trackpad;
struct touchscreen_properties prop;
unsigned int kp_type[ARRAY_SIZE(iqs626_channels)]
[ARRAY_SIZE(iqs626_events)];
unsigned int kp_code[ARRAY_SIZE(iqs626_channels)]
[ARRAY_SIZE(iqs626_events)];
unsigned int tp_code[IQS626_NUM_GESTURES];
unsigned int suspend_mode;
};
static noinline_for_stack int
iqs626_parse_events(struct iqs626_private *iqs626,
struct fwnode_handle *ch_node, enum iqs626_ch_id ch_id)
{
struct iqs626_sys_reg *sys_reg = &iqs626->sys_reg;
struct i2c_client *client = iqs626->client;
struct fwnode_handle *ev_node;
const char *ev_name;
u8 *thresh, *hyst;
unsigned int val;
int i;
switch (ch_id) {
case IQS626_CH_ULP_0:
thresh = sys_reg->ch_reg_ulp.thresh;
hyst = &sys_reg->ch_reg_ulp.hyst;
break;
case IQS626_CH_TP_2:
case IQS626_CH_TP_3:
thresh = &sys_reg->tp_grp_reg.ch_reg_tp[0].thresh;
hyst = &sys_reg->tp_grp_reg.hyst;
break;
case IQS626_CH_GEN_0:
case IQS626_CH_GEN_1:
case IQS626_CH_GEN_2:
i = ch_id - IQS626_CH_GEN_0;
thresh = sys_reg->ch_reg_gen[i].thresh;
hyst = &sys_reg->ch_reg_gen[i].hyst;
break;
case IQS626_CH_HALL:
thresh = &sys_reg->ch_reg_hall.thresh;
hyst = &sys_reg->ch_reg_hall.hyst;
break;
default:
return -EINVAL;
}
for (i = 0; i < ARRAY_SIZE(iqs626_events); i++) {
if (!iqs626_channels[ch_id].events[i])
continue;
if (ch_id == IQS626_CH_TP_2 || ch_id == IQS626_CH_TP_3) {
/*
* Trackpad touch events are simply described under the
* trackpad child node.
*/
ev_node = fwnode_handle_get(ch_node);
} else {
ev_name = iqs626_events[i].name;
ev_node = fwnode_get_named_child_node(ch_node, ev_name);
if (!ev_node)
continue;
if (!fwnode_property_read_u32(ev_node, "linux,code",
&val)) {
iqs626->kp_code[ch_id][i] = val;
if (fwnode_property_read_u32(ev_node,
"linux,input-type",
&val)) {
if (ch_id == IQS626_CH_HALL)
val = EV_SW;
else
val = EV_KEY;
}
if (val != EV_KEY && val != EV_SW) {
dev_err(&client->dev,
"Invalid input type: %u\n",
val);
fwnode_handle_put(ev_node);
return -EINVAL;
}
iqs626->kp_type[ch_id][i] = val;
sys_reg->event_mask &= ~iqs626_events[i].mask;
}
}
if (!fwnode_property_read_u32(ev_node, "azoteq,hyst", &val)) {
if (val > IQS626_CHx_HYST_MAX) {
dev_err(&client->dev,
"Invalid %s channel hysteresis: %u\n",
fwnode_get_name(ch_node), val);
fwnode_handle_put(ev_node);
return -EINVAL;
}
if (i == IQS626_EVENT_DEEP_DN ||
i == IQS626_EVENT_DEEP_UP) {
*hyst &= ~IQS626_CHx_HYST_DEEP_MASK;
*hyst |= (val << IQS626_CHx_HYST_DEEP_SHIFT);
} else if (i == IQS626_EVENT_TOUCH_DN ||
i == IQS626_EVENT_TOUCH_UP) {
*hyst &= ~IQS626_CHx_HYST_TOUCH_MASK;
*hyst |= val;
}
}
if (ch_id != IQS626_CH_TP_2 && ch_id != IQS626_CH_TP_3 &&
!fwnode_property_read_u32(ev_node, "azoteq,thresh", &val)) {
if (val > IQS626_CHx_THRESH_MAX) {
dev_err(&client->dev,
"Invalid %s channel threshold: %u\n",
fwnode_get_name(ch_node), val);
fwnode_handle_put(ev_node);
return -EINVAL;
}
if (ch_id == IQS626_CH_HALL)
*thresh = val;
else
*(thresh + iqs626_events[i].th_offs) = val;
}
fwnode_handle_put(ev_node);
}
return 0;
}
static noinline_for_stack int
iqs626_parse_ati_target(struct iqs626_private *iqs626,
struct fwnode_handle *ch_node, enum iqs626_ch_id ch_id)
{
struct iqs626_sys_reg *sys_reg = &iqs626->sys_reg;
struct i2c_client *client = iqs626->client;
unsigned int val;
u8 *ati_target;
int i;
switch (ch_id) {
case IQS626_CH_ULP_0:
ati_target = &sys_reg->ch_reg_ulp.ati_target;
break;
case IQS626_CH_TP_2:
case IQS626_CH_TP_3:
ati_target = &sys_reg->tp_grp_reg.ati_target;
break;
case IQS626_CH_GEN_0:
case IQS626_CH_GEN_1:
case IQS626_CH_GEN_2:
i = ch_id - IQS626_CH_GEN_0;
ati_target = &sys_reg->ch_reg_gen[i].ati_target;
break;
case IQS626_CH_HALL:
ati_target = &sys_reg->ch_reg_hall.ati_target;
break;
default:
return -EINVAL;
}
if (!fwnode_property_read_u32(ch_node, "azoteq,ati-target", &val)) {
if (val > IQS626_CHx_ATI_TARGET_MAX) {
dev_err(&client->dev,
"Invalid %s channel ATI target: %u\n",
fwnode_get_name(ch_node), val);
return -EINVAL;
}
*ati_target &= ~IQS626_CHx_ATI_TARGET_MASK;
*ati_target |= (val / 32);
}
if (ch_id != IQS626_CH_TP_2 && ch_id != IQS626_CH_TP_3 &&
!fwnode_property_read_u32(ch_node, "azoteq,ati-base", &val)) {
switch (val) {
case 75:
val = IQS626_CHx_ATI_BASE_75;
break;
case 100:
val = IQS626_CHx_ATI_BASE_100;
break;
case 150:
val = IQS626_CHx_ATI_BASE_150;
break;
case 200:
val = IQS626_CHx_ATI_BASE_200;
break;
default:
dev_err(&client->dev,
"Invalid %s channel ATI base: %u\n",
fwnode_get_name(ch_node), val);
return -EINVAL;
}
*ati_target &= ~IQS626_CHx_ATI_BASE_MASK;
*ati_target |= val;
}
return 0;
}
static int iqs626_parse_pins(struct iqs626_private *iqs626,
struct fwnode_handle *ch_node,
const char *propname, u8 *enable)
{
struct i2c_client *client = iqs626->client;
unsigned int val[IQS626_NUM_CRx_TX];
int error, count, i;
if (!fwnode_property_present(ch_node, propname))
return 0;
count = fwnode_property_count_u32(ch_node, propname);
if (count > IQS626_NUM_CRx_TX) {
dev_err(&client->dev,
"Too many %s channel CRX/TX pins present\n",
fwnode_get_name(ch_node));
return -EINVAL;
} else if (count < 0) {
dev_err(&client->dev,
"Failed to count %s channel CRX/TX pins: %d\n",
fwnode_get_name(ch_node), count);
return count;
}
error = fwnode_property_read_u32_array(ch_node, propname, val, count);
if (error) {
dev_err(&client->dev,
"Failed to read %s channel CRX/TX pins: %d\n",
fwnode_get_name(ch_node), error);
return error;
}
*enable = 0;
for (i = 0; i < count; i++) {
if (val[i] >= IQS626_NUM_CRx_TX) {
dev_err(&client->dev,
"Invalid %s channel CRX/TX pin: %u\n",
fwnode_get_name(ch_node), val[i]);
return -EINVAL;
}
*enable |= BIT(val[i]);
}
return 0;
}
static int iqs626_parse_trackpad(struct iqs626_private *iqs626,
struct fwnode_handle *ch_node,
enum iqs626_ch_id ch_id)
{
struct iqs626_sys_reg *sys_reg = &iqs626->sys_reg;
struct i2c_client *client = iqs626->client;
u8 *hyst = &sys_reg->tp_grp_reg.hyst;
int error, count, i;
unsigned int val;
if (!fwnode_property_read_u32(ch_node, "azoteq,lta-update", &val)) {
if (val > IQS626_MISC_A_TPx_LTA_UPDATE_MAX) {
dev_err(&client->dev,
"Invalid %s channel update rate: %u\n",
fwnode_get_name(ch_node), val);
return -EINVAL;
}
sys_reg->misc_a &= ~IQS626_MISC_A_TPx_LTA_UPDATE_MASK;
sys_reg->misc_a |= (val << IQS626_MISC_A_TPx_LTA_UPDATE_SHIFT);
}
if (!fwnode_property_read_u32(ch_node, "azoteq,filt-str-trackpad",
&val)) {
if (val > IQS626_FILT_STR_MAX) {
dev_err(&client->dev,
"Invalid %s channel filter strength: %u\n",
fwnode_get_name(ch_node), val);
return -EINVAL;
}
sys_reg->misc_b &= ~IQS626_MISC_B_FILT_STR_TPx;
sys_reg->misc_b |= val;
}
if (!fwnode_property_read_u32(ch_node, "azoteq,filt-str-np-cnt",
&val)) {
if (val > IQS626_FILT_STR_MAX) {
dev_err(&client->dev,
"Invalid %s channel filter strength: %u\n",
fwnode_get_name(ch_node), val);
return -EINVAL;
}
*hyst &= ~IQS626_FILT_STR_NP_TPx_MASK;
*hyst |= (val << IQS626_FILT_STR_NP_TPx_SHIFT);
}
if (!fwnode_property_read_u32(ch_node, "azoteq,filt-str-lp-cnt",
&val)) {
if (val > IQS626_FILT_STR_MAX) {
dev_err(&client->dev,
"Invalid %s channel filter strength: %u\n",
fwnode_get_name(ch_node), val);
return -EINVAL;
}
*hyst &= ~IQS626_FILT_STR_LP_TPx_MASK;
*hyst |= (val << IQS626_FILT_STR_LP_TPx_SHIFT);
}
for (i = 0; i < iqs626_channels[ch_id].num_ch; i++) {
u8 *ati_base = &sys_reg->tp_grp_reg.ch_reg_tp[i].ati_base;
u8 *thresh = &sys_reg->tp_grp_reg.ch_reg_tp[i].thresh;
struct fwnode_handle *tc_node;
char tc_name[10];
snprintf(tc_name, sizeof(tc_name), "channel-%d", i);
tc_node = fwnode_get_named_child_node(ch_node, tc_name);
if (!tc_node)
continue;
if (!fwnode_property_read_u32(tc_node, "azoteq,ati-base",
&val)) {
if (val < IQS626_TPx_ATI_BASE_MIN ||
val > IQS626_TPx_ATI_BASE_MAX) {
dev_err(&client->dev,
"Invalid %s %s ATI base: %u\n",
fwnode_get_name(ch_node), tc_name, val);
fwnode_handle_put(tc_node);
return -EINVAL;
}
*ati_base = val - IQS626_TPx_ATI_BASE_MIN;
}
if (!fwnode_property_read_u32(tc_node, "azoteq,thresh",
&val)) {
if (val > IQS626_CHx_THRESH_MAX) {
dev_err(&client->dev,
"Invalid %s %s threshold: %u\n",
fwnode_get_name(ch_node), tc_name, val);
fwnode_handle_put(tc_node);
return -EINVAL;
}
*thresh = val;
}
fwnode_handle_put(tc_node);
}
if (!fwnode_property_present(ch_node, "linux,keycodes"))
return 0;
count = fwnode_property_count_u32(ch_node, "linux,keycodes");
if (count > IQS626_NUM_GESTURES) {
dev_err(&client->dev, "Too many keycodes present\n");
return -EINVAL;
} else if (count < 0) {
dev_err(&client->dev, "Failed to count keycodes: %d\n", count);
return count;
}
error = fwnode_property_read_u32_array(ch_node, "linux,keycodes",
iqs626->tp_code, count);
if (error) {
dev_err(&client->dev, "Failed to read keycodes: %d\n", error);
return error;
}
sys_reg->misc_b &= ~IQS626_MISC_B_TPx_SWIPE;
if (fwnode_property_present(ch_node, "azoteq,gesture-swipe"))
sys_reg->misc_b |= IQS626_MISC_B_TPx_SWIPE;
if (!fwnode_property_read_u32(ch_node, "azoteq,timeout-tap-ms",
&val)) {
if (val > IQS626_TIMEOUT_TAP_MS_MAX) {
dev_err(&client->dev,
"Invalid %s channel timeout: %u\n",
fwnode_get_name(ch_node), val);
return -EINVAL;
}
sys_reg->timeout_tap = val / 16;
}
if (!fwnode_property_read_u32(ch_node, "azoteq,timeout-swipe-ms",
&val)) {
if (val > IQS626_TIMEOUT_SWIPE_MS_MAX) {
dev_err(&client->dev,
"Invalid %s channel timeout: %u\n",
fwnode_get_name(ch_node), val);
return -EINVAL;
}
sys_reg->timeout_swipe = val / 16;
}
if (!fwnode_property_read_u32(ch_node, "azoteq,thresh-swipe",
&val)) {
if (val > IQS626_THRESH_SWIPE_MAX) {
dev_err(&client->dev,
"Invalid %s channel threshold: %u\n",
fwnode_get_name(ch_node), val);
return -EINVAL;
}
sys_reg->thresh_swipe = val;
}
sys_reg->event_mask &= ~IQS626_EVENT_MASK_GESTURE;
return 0;
}
static noinline_for_stack int
iqs626_parse_channel(struct iqs626_private *iqs626,
struct fwnode_handle *ch_node, enum iqs626_ch_id ch_id)
{
struct iqs626_sys_reg *sys_reg = &iqs626->sys_reg;
struct i2c_client *client = iqs626->client;
u8 *engine, *filter, *rx_enable, *tx_enable;
u8 *assoc_select, *assoc_weight;
unsigned int val;
int error, i;
switch (ch_id) {
case IQS626_CH_ULP_0:
engine = sys_reg->ch_reg_ulp.engine;
break;
case IQS626_CH_TP_2:
case IQS626_CH_TP_3:
engine = sys_reg->tp_grp_reg.engine;
break;
case IQS626_CH_GEN_0:
case IQS626_CH_GEN_1:
case IQS626_CH_GEN_2:
i = ch_id - IQS626_CH_GEN_0;
engine = sys_reg->ch_reg_gen[i].engine;
break;
case IQS626_CH_HALL:
engine = &sys_reg->ch_reg_hall.engine;
break;
default:
return -EINVAL;
}
error = iqs626_parse_ati_target(iqs626, ch_node, ch_id);
if (error)
return error;
error = iqs626_parse_events(iqs626, ch_node, ch_id);
if (error)
return error;
if (!fwnode_property_present(ch_node, "azoteq,ati-exclude"))
sys_reg->redo_ati |= iqs626_channels[ch_id].active;
if (!fwnode_property_present(ch_node, "azoteq,reseed-disable"))
sys_reg->reseed |= iqs626_channels[ch_id].active;
*engine |= IQS626_CHx_ENG_0_MEAS_CAP_SIZE;
if (fwnode_property_present(ch_node, "azoteq,meas-cap-decrease"))
*engine &= ~IQS626_CHx_ENG_0_MEAS_CAP_SIZE;
*engine |= IQS626_CHx_ENG_0_RX_TERM_VSS;
if (!fwnode_property_read_u32(ch_node, "azoteq,rx-inactive", &val)) {
switch (val) {
case IQS626_RX_INACTIVE_VSS:
break;
case IQS626_RX_INACTIVE_FLOAT:
*engine &= ~IQS626_CHx_ENG_0_RX_TERM_VSS;
if (ch_id == IQS626_CH_GEN_0 ||
ch_id == IQS626_CH_GEN_1 ||
ch_id == IQS626_CH_GEN_2)
*(engine + 4) &= ~IQS626_CHx_ENG_4_RX_TERM_VREG;
break;
case IQS626_RX_INACTIVE_VREG:
if (ch_id == IQS626_CH_GEN_0 ||
ch_id == IQS626_CH_GEN_1 ||
ch_id == IQS626_CH_GEN_2) {
*engine &= ~IQS626_CHx_ENG_0_RX_TERM_VSS;
*(engine + 4) |= IQS626_CHx_ENG_4_RX_TERM_VREG;
break;
}
fallthrough;
default:
dev_err(&client->dev,
"Invalid %s channel CRX pin termination: %u\n",
fwnode_get_name(ch_node), val);
return -EINVAL;
}
}
*engine &= ~IQS626_CHx_ENG_0_LINEARIZE;
if (fwnode_property_present(ch_node, "azoteq,linearize"))
*engine |= IQS626_CHx_ENG_0_LINEARIZE;
*engine &= ~IQS626_CHx_ENG_0_DUAL_DIR;
if (fwnode_property_present(ch_node, "azoteq,dual-direction"))
*engine |= IQS626_CHx_ENG_0_DUAL_DIR;
*engine &= ~IQS626_CHx_ENG_0_FILT_DISABLE;
if (fwnode_property_present(ch_node, "azoteq,filt-disable"))
*engine |= IQS626_CHx_ENG_0_FILT_DISABLE;
if (!fwnode_property_read_u32(ch_node, "azoteq,ati-mode", &val)) {
if (val > IQS626_CHx_ENG_0_ATI_MODE_MAX) {
dev_err(&client->dev,
"Invalid %s channel ATI mode: %u\n",
fwnode_get_name(ch_node), val);
return -EINVAL;
}
*engine &= ~IQS626_CHx_ENG_0_ATI_MODE_MASK;
*engine |= val;
}
if (ch_id == IQS626_CH_HALL)
return 0;
*(engine + 1) &= ~IQS626_CHx_ENG_1_CCT_ENABLE;
if (!fwnode_property_read_u32(ch_node, "azoteq,cct-increase",
&val) && val) {
unsigned int orig_val = val--;
/*
* In the case of the generic channels, the charge cycle time
* field doubles in size and straddles two separate registers.
*/
if (ch_id == IQS626_CH_GEN_0 ||
ch_id == IQS626_CH_GEN_1 ||
ch_id == IQS626_CH_GEN_2) {
*(engine + 4) &= ~IQS626_CHx_ENG_4_CCT_LOW_1;
if (val & BIT(1))
*(engine + 4) |= IQS626_CHx_ENG_4_CCT_LOW_1;
*(engine + 4) &= ~IQS626_CHx_ENG_4_CCT_LOW_0;
if (val & BIT(0))
*(engine + 4) |= IQS626_CHx_ENG_4_CCT_LOW_0;
val >>= 2;
}
if (val & ~GENMASK(1, 0)) {
dev_err(&client->dev,
"Invalid %s channel charge cycle time: %u\n",
fwnode_get_name(ch_node), orig_val);
return -EINVAL;
}
*(engine + 1) &= ~IQS626_CHx_ENG_1_CCT_HIGH_1;
if (val & BIT(1))
*(engine + 1) |= IQS626_CHx_ENG_1_CCT_HIGH_1;
*(engine + 1) &= ~IQS626_CHx_ENG_1_CCT_HIGH_0;
if (val & BIT(0))
*(engine + 1) |= IQS626_CHx_ENG_1_CCT_HIGH_0;
*(engine + 1) |= IQS626_CHx_ENG_1_CCT_ENABLE;
}
if (!fwnode_property_read_u32(ch_node, "azoteq,proj-bias", &val)) {
if (val > IQS626_CHx_ENG_1_PROJ_BIAS_MAX) {
dev_err(&client->dev,
"Invalid %s channel bias current: %u\n",
fwnode_get_name(ch_node), val);
return -EINVAL;
}
*(engine + 1) &= ~IQS626_CHx_ENG_1_PROJ_BIAS_MASK;
*(engine + 1) |= (val << IQS626_CHx_ENG_1_PROJ_BIAS_SHIFT);
}
if (!fwnode_property_read_u32(ch_node, "azoteq,sense-freq", &val)) {
if (val > IQS626_CHx_ENG_1_SENSE_FREQ_MAX) {
dev_err(&client->dev,
"Invalid %s channel sensing frequency: %u\n",
fwnode_get_name(ch_node), val);
return -EINVAL;
}
*(engine + 1) &= ~IQS626_CHx_ENG_1_SENSE_FREQ_MASK;
*(engine + 1) |= (val << IQS626_CHx_ENG_1_SENSE_FREQ_SHIFT);
}
*(engine + 1) &= ~IQS626_CHx_ENG_1_ATI_BAND_TIGHTEN;
if (fwnode_property_present(ch_node, "azoteq,ati-band-tighten"))
*(engine + 1) |= IQS626_CHx_ENG_1_ATI_BAND_TIGHTEN;
if (ch_id == IQS626_CH_TP_2 || ch_id == IQS626_CH_TP_3)
return iqs626_parse_trackpad(iqs626, ch_node, ch_id);
if (ch_id == IQS626_CH_ULP_0) {
sys_reg->ch_reg_ulp.hyst &= ~IQS626_ULP_PROJ_ENABLE;
if (fwnode_property_present(ch_node, "azoteq,proj-enable"))
sys_reg->ch_reg_ulp.hyst |= IQS626_ULP_PROJ_ENABLE;
filter = &sys_reg->ch_reg_ulp.filter;
rx_enable = &sys_reg->ch_reg_ulp.rx_enable;
tx_enable = &sys_reg->ch_reg_ulp.tx_enable;
} else {
i = ch_id - IQS626_CH_GEN_0;
filter = &sys_reg->ch_reg_gen[i].filter;
rx_enable = &sys_reg->ch_reg_gen[i].rx_enable;
tx_enable = &sys_reg->ch_reg_gen[i].tx_enable;
}
if (!fwnode_property_read_u32(ch_node, "azoteq,filt-str-np-cnt",
&val)) {
if (val > IQS626_FILT_STR_MAX) {
dev_err(&client->dev,
"Invalid %s channel filter strength: %u\n",
fwnode_get_name(ch_node), val);
return -EINVAL;
}
*filter &= ~IQS626_FILT_STR_NP_CNT_MASK;
*filter |= (val << IQS626_FILT_STR_NP_CNT_SHIFT);
}
if (!fwnode_property_read_u32(ch_node, "azoteq,filt-str-lp-cnt",
&val)) {
if (val > IQS626_FILT_STR_MAX) {
dev_err(&client->dev,
"Invalid %s channel filter strength: %u\n",
fwnode_get_name(ch_node), val);
return -EINVAL;
}
*filter &= ~IQS626_FILT_STR_LP_CNT_MASK;
*filter |= (val << IQS626_FILT_STR_LP_CNT_SHIFT);
}
if (!fwnode_property_read_u32(ch_node, "azoteq,filt-str-np-lta",
&val)) {
if (val > IQS626_FILT_STR_MAX) {
dev_err(&client->dev,
"Invalid %s channel filter strength: %u\n",
fwnode_get_name(ch_node), val);
return -EINVAL;
}
*filter &= ~IQS626_FILT_STR_NP_LTA_MASK;
*filter |= (val << IQS626_FILT_STR_NP_LTA_SHIFT);
}
if (!fwnode_property_read_u32(ch_node, "azoteq,filt-str-lp-lta",
&val)) {
if (val > IQS626_FILT_STR_MAX) {
dev_err(&client->dev,
"Invalid %s channel filter strength: %u\n",
fwnode_get_name(ch_node), val);
return -EINVAL;
}
*filter &= ~IQS626_FILT_STR_LP_LTA_MASK;
*filter |= val;
}
error = iqs626_parse_pins(iqs626, ch_node, "azoteq,rx-enable",
rx_enable);
if (error)
return error;
error = iqs626_parse_pins(iqs626, ch_node, "azoteq,tx-enable",
tx_enable);
if (error)
return error;
if (ch_id == IQS626_CH_ULP_0)
return 0;
*(engine + 2) &= ~IQS626_CHx_ENG_2_LOCAL_CAP_ENABLE;
if (!fwnode_property_read_u32(ch_node, "azoteq,local-cap-size",
&val) && val) {
unsigned int orig_val = val--;
if (val > IQS626_CHx_ENG_2_LOCAL_CAP_MAX) {
dev_err(&client->dev,
"Invalid %s channel local cap. size: %u\n",
fwnode_get_name(ch_node), orig_val);
return -EINVAL;
}
*(engine + 2) &= ~IQS626_CHx_ENG_2_LOCAL_CAP_MASK;
*(engine + 2) |= (val << IQS626_CHx_ENG_2_LOCAL_CAP_SHIFT);
*(engine + 2) |= IQS626_CHx_ENG_2_LOCAL_CAP_ENABLE;
}
if (!fwnode_property_read_u32(ch_node, "azoteq,sense-mode", &val)) {
if (val > IQS626_CHx_ENG_2_SENSE_MODE_MAX) {
dev_err(&client->dev,
"Invalid %s channel sensing mode: %u\n",
fwnode_get_name(ch_node), val);
return -EINVAL;
}
*(engine + 2) &= ~IQS626_CHx_ENG_2_SENSE_MODE_MASK;
*(engine + 2) |= val;
}
if (!fwnode_property_read_u32(ch_node, "azoteq,tx-freq", &val)) {
if (val > IQS626_CHx_ENG_3_TX_FREQ_MAX) {
dev_err(&client->dev,
"Invalid %s channel excitation frequency: %u\n",
fwnode_get_name(ch_node), val);
return -EINVAL;
}
*(engine + 3) &= ~IQS626_CHx_ENG_3_TX_FREQ_MASK;
*(engine + 3) |= (val << IQS626_CHx_ENG_3_TX_FREQ_SHIFT);
}
*(engine + 3) &= ~IQS626_CHx_ENG_3_INV_LOGIC;
if (fwnode_property_present(ch_node, "azoteq,invert-enable"))
*(engine + 3) |= IQS626_CHx_ENG_3_INV_LOGIC;
*(engine + 4) &= ~IQS626_CHx_ENG_4_COMP_DISABLE;
if (fwnode_property_present(ch_node, "azoteq,comp-disable"))
*(engine + 4) |= IQS626_CHx_ENG_4_COMP_DISABLE;
*(engine + 4) &= ~IQS626_CHx_ENG_4_STATIC_ENABLE;
if (fwnode_property_present(ch_node, "azoteq,static-enable"))
*(engine + 4) |= IQS626_CHx_ENG_4_STATIC_ENABLE;
i = ch_id - IQS626_CH_GEN_0;
assoc_select = &sys_reg->ch_reg_gen[i].assoc_select;
assoc_weight = &sys_reg->ch_reg_gen[i].assoc_weight;
*assoc_select = 0;
if (!fwnode_property_present(ch_node, "azoteq,assoc-select"))
return 0;
for (i = 0; i < ARRAY_SIZE(iqs626_channels); i++) {
if (fwnode_property_match_string(ch_node, "azoteq,assoc-select",
iqs626_channels[i].name) < 0)
continue;
*assoc_select |= iqs626_channels[i].active;
}
if (fwnode_property_read_u32(ch_node, "azoteq,assoc-weight", &val))
return 0;
if (val > IQS626_GEN_WEIGHT_MAX) {
dev_err(&client->dev,
"Invalid %s channel associated weight: %u\n",
fwnode_get_name(ch_node), val);
return -EINVAL;
}
*assoc_weight = val;
return 0;
}
static int iqs626_parse_prop(struct iqs626_private *iqs626)
{
struct iqs626_sys_reg *sys_reg = &iqs626->sys_reg;
struct i2c_client *client = iqs626->client;
struct fwnode_handle *ch_node;
unsigned int val;
int error, i;
u16 general;
if (!device_property_read_u32(&client->dev, "azoteq,suspend-mode",
&val)) {
if (val > IQS626_SYS_SETTINGS_PWR_MODE_MAX) {
dev_err(&client->dev, "Invalid suspend mode: %u\n",
val);
return -EINVAL;
}
iqs626->suspend_mode = val;
}
error = regmap_raw_read(iqs626->regmap, IQS626_SYS_SETTINGS, sys_reg,
sizeof(*sys_reg));
if (error)
return error;
general = be16_to_cpu(sys_reg->general);
general &= IQS626_SYS_SETTINGS_ULP_UPDATE_MASK;
if (device_property_present(&client->dev, "azoteq,clk-div"))
general |= IQS626_SYS_SETTINGS_CLK_DIV;
if (device_property_present(&client->dev, "azoteq,ulp-enable"))
general |= IQS626_SYS_SETTINGS_ULP_AUTO;
if (!device_property_read_u32(&client->dev, "azoteq,ulp-update",
&val)) {
if (val > IQS626_SYS_SETTINGS_ULP_UPDATE_MAX) {
dev_err(&client->dev, "Invalid update rate: %u\n", val);
return -EINVAL;
}
general &= ~IQS626_SYS_SETTINGS_ULP_UPDATE_MASK;
general |= (val << IQS626_SYS_SETTINGS_ULP_UPDATE_SHIFT);
}
sys_reg->misc_a &= ~IQS626_MISC_A_ATI_BAND_DISABLE;
if (device_property_present(&client->dev, "azoteq,ati-band-disable"))
sys_reg->misc_a |= IQS626_MISC_A_ATI_BAND_DISABLE;
sys_reg->misc_a &= ~IQS626_MISC_A_ATI_LP_ONLY;
if (device_property_present(&client->dev, "azoteq,ati-lp-only"))
sys_reg->misc_a |= IQS626_MISC_A_ATI_LP_ONLY;
if (!device_property_read_u32(&client->dev, "azoteq,gpio3-select",
&val)) {
if (val > IQS626_MISC_A_GPIO3_SELECT_MAX) {
dev_err(&client->dev, "Invalid GPIO3 selection: %u\n",
val);
return -EINVAL;
}
sys_reg->misc_a &= ~IQS626_MISC_A_GPIO3_SELECT_MASK;
sys_reg->misc_a |= val;
}
if (!device_property_read_u32(&client->dev, "azoteq,reseed-select",
&val)) {
if (val > IQS626_MISC_B_RESEED_UI_SEL_MAX) {
dev_err(&client->dev, "Invalid reseed selection: %u\n",
val);
return -EINVAL;
}
sys_reg->misc_b &= ~IQS626_MISC_B_RESEED_UI_SEL_MASK;
sys_reg->misc_b |= (val << IQS626_MISC_B_RESEED_UI_SEL_SHIFT);
}
sys_reg->misc_b &= ~IQS626_MISC_B_THRESH_EXTEND;
if (device_property_present(&client->dev, "azoteq,thresh-extend"))
sys_reg->misc_b |= IQS626_MISC_B_THRESH_EXTEND;
sys_reg->misc_b &= ~IQS626_MISC_B_TRACKING_UI_ENABLE;
if (device_property_present(&client->dev, "azoteq,tracking-enable"))
sys_reg->misc_b |= IQS626_MISC_B_TRACKING_UI_ENABLE;
sys_reg->misc_b &= ~IQS626_MISC_B_RESEED_OFFSET;
if (device_property_present(&client->dev, "azoteq,reseed-offset"))
sys_reg->misc_b |= IQS626_MISC_B_RESEED_OFFSET;
if (!device_property_read_u32(&client->dev, "azoteq,rate-np-ms",
&val)) {
if (val > IQS626_RATE_NP_MS_MAX) {
dev_err(&client->dev, "Invalid report rate: %u\n", val);
return -EINVAL;
}
sys_reg->rate_np = val;
}
if (!device_property_read_u32(&client->dev, "azoteq,rate-lp-ms",
&val)) {
if (val > IQS626_RATE_LP_MS_MAX) {
dev_err(&client->dev, "Invalid report rate: %u\n", val);
return -EINVAL;
}
sys_reg->rate_lp = val;
}
if (!device_property_read_u32(&client->dev, "azoteq,rate-ulp-ms",
&val)) {
if (val > IQS626_RATE_ULP_MS_MAX) {
dev_err(&client->dev, "Invalid report rate: %u\n", val);
return -EINVAL;
}
sys_reg->rate_ulp = val / 16;
}
if (!device_property_read_u32(&client->dev, "azoteq,timeout-pwr-ms",
&val)) {
if (val > IQS626_TIMEOUT_PWR_MS_MAX) {
dev_err(&client->dev, "Invalid timeout: %u\n", val);
return -EINVAL;
}
sys_reg->timeout_pwr = val / 512;
}
if (!device_property_read_u32(&client->dev, "azoteq,timeout-lta-ms",
&val)) {
if (val > IQS626_TIMEOUT_LTA_MS_MAX) {
dev_err(&client->dev, "Invalid timeout: %u\n", val);
return -EINVAL;
}
sys_reg->timeout_lta = val / 512;
}
sys_reg->event_mask = ~((u8)IQS626_EVENT_MASK_SYS);
sys_reg->redo_ati = 0;
sys_reg->reseed = 0;
sys_reg->active = 0;
for (i = 0; i < ARRAY_SIZE(iqs626_channels); i++) {
ch_node = device_get_named_child_node(&client->dev,
iqs626_channels[i].name);
if (!ch_node)
continue;
error = iqs626_parse_channel(iqs626, ch_node, i);
fwnode_handle_put(ch_node);
if (error)
return error;
sys_reg->active |= iqs626_channels[i].active;
}
general |= IQS626_SYS_SETTINGS_EVENT_MODE;
/*
* Enable streaming during normal-power mode if the trackpad is used to
* report raw coordinates instead of gestures. In that case, the device
* returns to event mode during low-power mode.
*/
if (sys_reg->active & iqs626_channels[IQS626_CH_TP_2].active &&
sys_reg->event_mask & IQS626_EVENT_MASK_GESTURE)
general |= IQS626_SYS_SETTINGS_EVENT_MODE_LP;
general |= IQS626_SYS_SETTINGS_REDO_ATI;
general |= IQS626_SYS_SETTINGS_ACK_RESET;
sys_reg->general = cpu_to_be16(general);
error = regmap_raw_write(iqs626->regmap, IQS626_SYS_SETTINGS,
&iqs626->sys_reg, sizeof(iqs626->sys_reg));
if (error)
return error;
iqs626_irq_wait();
return 0;
}
static int iqs626_input_init(struct iqs626_private *iqs626)
{
struct iqs626_sys_reg *sys_reg = &iqs626->sys_reg;
struct i2c_client *client = iqs626->client;
int error, i, j;
iqs626->keypad = devm_input_allocate_device(&client->dev);
if (!iqs626->keypad)
return -ENOMEM;
iqs626->keypad->keycodemax = ARRAY_SIZE(iqs626->kp_code);
iqs626->keypad->keycode = iqs626->kp_code;
iqs626->keypad->keycodesize = sizeof(**iqs626->kp_code);
iqs626->keypad->name = "iqs626a_keypad";
iqs626->keypad->id.bustype = BUS_I2C;
for (i = 0; i < ARRAY_SIZE(iqs626_channels); i++) {
if (!(sys_reg->active & iqs626_channels[i].active))
continue;
for (j = 0; j < ARRAY_SIZE(iqs626_events); j++) {
if (!iqs626->kp_type[i][j])
continue;
input_set_capability(iqs626->keypad,
iqs626->kp_type[i][j],
iqs626->kp_code[i][j]);
}
}
if (!(sys_reg->active & iqs626_channels[IQS626_CH_TP_2].active))
return 0;
iqs626->trackpad = devm_input_allocate_device(&client->dev);
if (!iqs626->trackpad)
return -ENOMEM;
iqs626->trackpad->keycodemax = ARRAY_SIZE(iqs626->tp_code);
iqs626->trackpad->keycode = iqs626->tp_code;
iqs626->trackpad->keycodesize = sizeof(*iqs626->tp_code);
iqs626->trackpad->name = "iqs626a_trackpad";
iqs626->trackpad->id.bustype = BUS_I2C;
/*
* Present the trackpad as a traditional pointing device if no gestures
* have been mapped to a keycode.
*/
if (sys_reg->event_mask & IQS626_EVENT_MASK_GESTURE) {
u8 tp_mask = iqs626_channels[IQS626_CH_TP_3].active;
input_set_capability(iqs626->trackpad, EV_KEY, BTN_TOUCH);
input_set_abs_params(iqs626->trackpad, ABS_Y, 0, 255, 0, 0);
if ((sys_reg->active & tp_mask) == tp_mask)
input_set_abs_params(iqs626->trackpad,
ABS_X, 0, 255, 0, 0);
else
input_set_abs_params(iqs626->trackpad,
ABS_X, 0, 128, 0, 0);
touchscreen_parse_properties(iqs626->trackpad, false,
&iqs626->prop);
} else {
for (i = 0; i < IQS626_NUM_GESTURES; i++)
if (iqs626->tp_code[i] != KEY_RESERVED)
input_set_capability(iqs626->trackpad, EV_KEY,
iqs626->tp_code[i]);
}
error = input_register_device(iqs626->trackpad);
if (error)
dev_err(&client->dev, "Failed to register trackpad: %d\n",
error);
return error;
}
static int iqs626_report(struct iqs626_private *iqs626)
{
struct iqs626_sys_reg *sys_reg = &iqs626->sys_reg;
struct i2c_client *client = iqs626->client;
struct iqs626_flags flags;
__le16 hall_output;
int error, i, j;
u8 state;
u8 *dir_mask = &flags.states[IQS626_ST_OFFS_DIR];
error = regmap_raw_read(iqs626->regmap, IQS626_SYS_FLAGS, &flags,
sizeof(flags));
if (error) {
dev_err(&client->dev, "Failed to read device status: %d\n",
error);
return error;
}
/*
* The device resets itself if its own watchdog bites, which can happen
* in the event of an I2C communication error. In this case, the device
* asserts a SHOW_RESET interrupt and all registers must be restored.
*/
if (be16_to_cpu(flags.system) & IQS626_SYS_FLAGS_SHOW_RESET) {
dev_err(&client->dev, "Unexpected device reset\n");
error = regmap_raw_write(iqs626->regmap, IQS626_SYS_SETTINGS,
sys_reg, sizeof(*sys_reg));
if (error)
dev_err(&client->dev,
"Failed to re-initialize device: %d\n", error);
return error;
}
if (be16_to_cpu(flags.system) & IQS626_SYS_FLAGS_IN_ATI)
return 0;
/*
* Unlike the ULP or generic channels, the Hall channel does not have a
* direction flag. Instead, the direction (i.e. magnet polarity) can be
* derived based on the sign of the 2's complement differential output.
*/
if (sys_reg->active & iqs626_channels[IQS626_CH_HALL].active) {
error = regmap_raw_read(iqs626->regmap, IQS626_HALL_OUTPUT,
&hall_output, sizeof(hall_output));
if (error) {
dev_err(&client->dev,
"Failed to read Hall output: %d\n", error);
return error;
}
*dir_mask &= ~iqs626_channels[IQS626_CH_HALL].active;
if (le16_to_cpu(hall_output) < 0x8000)
*dir_mask |= iqs626_channels[IQS626_CH_HALL].active;
}
for (i = 0; i < ARRAY_SIZE(iqs626_channels); i++) {
if (!(sys_reg->active & iqs626_channels[i].active))
continue;
for (j = 0; j < ARRAY_SIZE(iqs626_events); j++) {
if (!iqs626->kp_type[i][j])
continue;
state = flags.states[iqs626_events[j].st_offs];
state &= iqs626_events[j].dir_up ? *dir_mask
: ~(*dir_mask);
state &= iqs626_channels[i].active;
input_event(iqs626->keypad, iqs626->kp_type[i][j],
iqs626->kp_code[i][j], !!state);
}
}
input_sync(iqs626->keypad);
/*
* The following completion signals that ATI has finished, any initial
* switch states have been reported and the keypad can be registered.
*/
complete_all(&iqs626->ati_done);
if (!(sys_reg->active & iqs626_channels[IQS626_CH_TP_2].active))
return 0;
if (sys_reg->event_mask & IQS626_EVENT_MASK_GESTURE) {
state = flags.states[IQS626_ST_OFFS_TOUCH];
state &= iqs626_channels[IQS626_CH_TP_2].active;
input_report_key(iqs626->trackpad, BTN_TOUCH, state);
if (state)
touchscreen_report_pos(iqs626->trackpad, &iqs626->prop,
flags.trackpad_x,
flags.trackpad_y, false);
} else {
for (i = 0; i < IQS626_NUM_GESTURES; i++)
input_report_key(iqs626->trackpad, iqs626->tp_code[i],
flags.gesture & BIT(i));
if (flags.gesture & GENMASK(IQS626_GESTURE_TAP, 0)) {
input_sync(iqs626->trackpad);
/*
* Momentary gestures are followed by a complementary
* release cycle so as to emulate a full keystroke.
*/
for (i = 0; i < IQS626_GESTURE_HOLD; i++)
input_report_key(iqs626->trackpad,
iqs626->tp_code[i], 0);
}
}
input_sync(iqs626->trackpad);
return 0;
}
static irqreturn_t iqs626_irq(int irq, void *context)
{
struct iqs626_private *iqs626 = context;
if (iqs626_report(iqs626))
return IRQ_NONE;
/*
* The device does not deassert its interrupt (RDY) pin until shortly
* after receiving an I2C stop condition; the following delay ensures
* the interrupt handler does not return before this time.
*/
iqs626_irq_wait();
return IRQ_HANDLED;
}
static const struct regmap_config iqs626_regmap_config = {
.reg_bits = 8,
.val_bits = 16,
.max_register = IQS626_MAX_REG,
};
static int iqs626_probe(struct i2c_client *client)
{
struct iqs626_ver_info ver_info;
struct iqs626_private *iqs626;
int error;
iqs626 = devm_kzalloc(&client->dev, sizeof(*iqs626), GFP_KERNEL);
if (!iqs626)
return -ENOMEM;
i2c_set_clientdata(client, iqs626);
iqs626->client = client;
iqs626->regmap = devm_regmap_init_i2c(client, &iqs626_regmap_config);
if (IS_ERR(iqs626->regmap)) {
error = PTR_ERR(iqs626->regmap);
dev_err(&client->dev, "Failed to initialize register map: %d\n",
error);
return error;
}
init_completion(&iqs626->ati_done);
error = regmap_raw_read(iqs626->regmap, IQS626_VER_INFO, &ver_info,
sizeof(ver_info));
if (error)
return error;
if (ver_info.prod_num != IQS626_VER_INFO_PROD_NUM) {
dev_err(&client->dev, "Unrecognized product number: 0x%02X\n",
ver_info.prod_num);
return -EINVAL;
}
error = iqs626_parse_prop(iqs626);
if (error)
return error;
error = iqs626_input_init(iqs626);
if (error)
return error;
error = devm_request_threaded_irq(&client->dev, client->irq,
NULL, iqs626_irq, IRQF_ONESHOT,
client->name, iqs626);
if (error) {
dev_err(&client->dev, "Failed to request IRQ: %d\n", error);
return error;
}
if (!wait_for_completion_timeout(&iqs626->ati_done,
msecs_to_jiffies(2000))) {
dev_err(&client->dev, "Failed to complete ATI\n");
return -ETIMEDOUT;
}
/*
* The keypad may include one or more switches and is not registered
* until ATI is complete and the initial switch states are read.
*/
error = input_register_device(iqs626->keypad);
if (error)
dev_err(&client->dev, "Failed to register keypad: %d\n", error);
return error;
}
static int iqs626_suspend(struct device *dev)
{
struct iqs626_private *iqs626 = dev_get_drvdata(dev);
struct i2c_client *client = iqs626->client;
unsigned int val;
int error;
if (!iqs626->suspend_mode)
return 0;
disable_irq(client->irq);
/*
* Automatic power mode switching must be disabled before the device is
* forced into any particular power mode. In this case, the device will
* transition into normal-power mode.
*/
error = regmap_update_bits(iqs626->regmap, IQS626_SYS_SETTINGS,
IQS626_SYS_SETTINGS_DIS_AUTO, ~0);
if (error)
goto err_irq;
/*
* The following check ensures the device has completed its transition
* into normal-power mode before a manual mode switch is performed.
*/
error = regmap_read_poll_timeout(iqs626->regmap, IQS626_SYS_FLAGS, val,
!(val & IQS626_SYS_FLAGS_PWR_MODE_MASK),
IQS626_PWR_MODE_POLL_SLEEP_US,
IQS626_PWR_MODE_POLL_TIMEOUT_US);
if (error)
goto err_irq;
error = regmap_update_bits(iqs626->regmap, IQS626_SYS_SETTINGS,
IQS626_SYS_SETTINGS_PWR_MODE_MASK,
iqs626->suspend_mode <<
IQS626_SYS_SETTINGS_PWR_MODE_SHIFT);
if (error)
goto err_irq;
/*
* This last check ensures the device has completed its transition into
* the desired power mode to prevent any spurious interrupts from being
* triggered after iqs626_suspend has already returned.
*/
error = regmap_read_poll_timeout(iqs626->regmap, IQS626_SYS_FLAGS, val,
(val & IQS626_SYS_FLAGS_PWR_MODE_MASK)
== (iqs626->suspend_mode <<
IQS626_SYS_FLAGS_PWR_MODE_SHIFT),
IQS626_PWR_MODE_POLL_SLEEP_US,
IQS626_PWR_MODE_POLL_TIMEOUT_US);
err_irq:
iqs626_irq_wait();
enable_irq(client->irq);
return error;
}
static int iqs626_resume(struct device *dev)
{
struct iqs626_private *iqs626 = dev_get_drvdata(dev);
struct i2c_client *client = iqs626->client;
unsigned int val;
int error;
if (!iqs626->suspend_mode)
return 0;
disable_irq(client->irq);
error = regmap_update_bits(iqs626->regmap, IQS626_SYS_SETTINGS,
IQS626_SYS_SETTINGS_PWR_MODE_MASK, 0);
if (error)
goto err_irq;
/*
* This check ensures the device has returned to normal-power mode
* before automatic power mode switching is re-enabled.
*/
error = regmap_read_poll_timeout(iqs626->regmap, IQS626_SYS_FLAGS, val,
!(val & IQS626_SYS_FLAGS_PWR_MODE_MASK),
IQS626_PWR_MODE_POLL_SLEEP_US,
IQS626_PWR_MODE_POLL_TIMEOUT_US);
if (error)
goto err_irq;
error = regmap_update_bits(iqs626->regmap, IQS626_SYS_SETTINGS,
IQS626_SYS_SETTINGS_DIS_AUTO, 0);
if (error)
goto err_irq;
/*
* This step reports any events that may have been "swallowed" as a
* result of polling PWR_MODE (which automatically acknowledges any
* pending interrupts).
*/
error = iqs626_report(iqs626);
err_irq:
iqs626_irq_wait();
enable_irq(client->irq);
return error;
}
static DEFINE_SIMPLE_DEV_PM_OPS(iqs626_pm, iqs626_suspend, iqs626_resume);
static const struct of_device_id iqs626_of_match[] = {
{ .compatible = "azoteq,iqs626a" },
{ }
};
MODULE_DEVICE_TABLE(of, iqs626_of_match);
static struct i2c_driver iqs626_i2c_driver = {
.driver = {
.name = "iqs626a",
.of_match_table = iqs626_of_match,
.pm = pm_sleep_ptr(&iqs626_pm),
},
.probe_new = iqs626_probe,
};
module_i2c_driver(iqs626_i2c_driver);
MODULE_AUTHOR("Jeff LaBundy <jeff@labundy.com>");
MODULE_DESCRIPTION("Azoteq IQS626A Capacitive Touch Controller");
MODULE_LICENSE("GPL");