mirror of
https://github.com/BobTheBlinker/android_kernel_motorola_sm6375.git
synced 2026-10-25 22:23:14 -04:00
sec_mmi: add grip supp distance register
Add store/show functions to the grip supp distance register at 0xAC. Change-Id: I522bc2de32a1dcbe5af1ade338646babaedcd923 Signed-off-by: Ryan Lattrel <ryanl@motorola.com> Reviewed-on: https://gerrit.mot.com/1514568 SLTApproved: Slta Waiver SME-Granted: SME Approvals Granted Tested-by: Jira Key Reviewed-by: Konstantin Makariev <kmakariev@motorola.com> Submit-Approved: Jira Key
This commit is contained in:
parent
8816d3dac8
commit
48c97a9726
3 changed files with 89 additions and 1 deletions
|
|
@ -1342,6 +1342,7 @@ static int sec_ts_parse_dt(struct i2c_client *client)
|
|||
pdata->suppression_ctrl = of_property_read_bool(np, "sec,suppression-control");
|
||||
pdata->pill_region_ctrl = of_property_read_bool(np, "sec,pill-region-control");
|
||||
pdata->hold_distance_ctrl = of_property_read_bool(np, "sec,hold-distance-control");
|
||||
pdata->gs_distance_ctrl = of_property_read_bool(np, "sec,gs-distance-control");
|
||||
pdata->poweron_calibration = of_property_read_bool(np, "sec,poweron-calibration");
|
||||
|
||||
#ifdef CONFIG_SEC_FACTORY
|
||||
|
|
|
|||
|
|
@ -714,6 +714,7 @@ struct sec_ts_data {
|
|||
unsigned char suppression_data;
|
||||
unsigned char pill_region_data[5];
|
||||
unsigned char hold_distance_data;
|
||||
unsigned char gs_distance_data;
|
||||
|
||||
/* for factory - factory_cmd_result_all() */
|
||||
short cm_raw_set_p2p_min; //CM_RAW_SET_P2P
|
||||
|
|
@ -787,6 +788,7 @@ struct sec_ts_plat_data {
|
|||
bool suppression_ctrl;
|
||||
bool pill_region_ctrl;
|
||||
bool hold_distance_ctrl;
|
||||
bool gs_distance_ctrl;
|
||||
};
|
||||
|
||||
typedef struct {
|
||||
|
|
|
|||
|
|
@ -62,6 +62,10 @@ static ssize_t sec_mmi_write_store(struct device *dev,
|
|||
struct device_attribute *attr, const char *buf, size_t size);
|
||||
static ssize_t sec_mmi_data_show(struct device *dev,
|
||||
struct device_attribute *attr, char *buf);
|
||||
static ssize_t sec_mmi_gs_distance_store(struct device *dev,
|
||||
struct device_attribute *attr, const char *buf, size_t size);
|
||||
static ssize_t sec_mmi_gs_distance_show(struct device *dev,
|
||||
struct device_attribute *attr, char *buf);
|
||||
|
||||
static DEVICE_ATTR(address, (S_IWUSR | S_IWGRP), NULL, sec_mmi_address_store);
|
||||
static DEVICE_ATTR(size, (S_IWUSR | S_IWGRP), NULL, sec_mmi_size_store);
|
||||
|
|
@ -73,6 +77,8 @@ static DEVICE_ATTR(pill_region, (S_IRUGO | S_IWUSR | S_IWGRP),
|
|||
sec_mmi_pill_region_show, sec_mmi_pill_region_store);
|
||||
static DEVICE_ATTR(hold_distance, (S_IRUGO | S_IWUSR | S_IWGRP),
|
||||
sec_mmi_hold_distance_show, sec_mmi_hold_distance_store);
|
||||
static DEVICE_ATTR(gs_distance, (S_IRUGO | S_IWUSR | S_IWGRP),
|
||||
sec_mmi_gs_distance_show, sec_mmi_gs_distance_store);
|
||||
|
||||
#define MAX_ATTRS_ENTRIES 10
|
||||
#define ADD_ATTR(name) { \
|
||||
|
|
@ -106,6 +112,9 @@ static int sec_mmi_extend_attribute_group(struct device *dev, struct attribute_g
|
|||
if (ts->plat_data->hold_distance_ctrl)
|
||||
ADD_ATTR(hold_distance);
|
||||
|
||||
if (ts->plat_data->gs_distance_ctrl)
|
||||
ADD_ATTR(gs_distance);
|
||||
|
||||
if (strncmp(bi_bootmode(), "mot-factory", strlen("mot-factory")) == 0) {
|
||||
ADD_ATTR(address);
|
||||
ADD_ATTR(size);
|
||||
|
|
@ -428,6 +437,66 @@ static ssize_t sec_mmi_hold_distance_show(struct device *dev,
|
|||
return blen;
|
||||
}
|
||||
|
||||
static ssize_t sec_mmi_gs_distance_store(struct device *dev,
|
||||
struct device_attribute *attr, const char *buf, size_t size)
|
||||
{
|
||||
struct sec_ts_data *ts;
|
||||
unsigned char buffer;
|
||||
unsigned long value;
|
||||
int error;
|
||||
|
||||
dev = MMI_DEV_TO_TS_DEV(dev);
|
||||
GET_TS_DATA(dev);
|
||||
|
||||
error = kstrtoul(buf, 0, &value);
|
||||
if (error)
|
||||
return -EINVAL;
|
||||
|
||||
buffer = (unsigned char)value;
|
||||
dev_dbg(dev, "%s: program value 0x%02x\n", __func__, (unsigned int)buffer);
|
||||
|
||||
ts->gs_distance_data = buffer;
|
||||
if (ts->power_status == SEC_TS_STATE_POWER_OFF) {
|
||||
dev_dbg(dev, "%s: power off state\n", __func__);
|
||||
return size;
|
||||
}
|
||||
|
||||
error = ts->sec_ts_i2c_write(ts, SEC_TS_CMD_GRIP_SUPP_AREA, &buffer, sizeof(buffer));
|
||||
if (error < 0)
|
||||
dev_err(dev, "%s: failed to write grip suppression distance (%d)\n",
|
||||
__func__, error);
|
||||
|
||||
return size;
|
||||
}
|
||||
|
||||
static ssize_t sec_mmi_gs_distance_show(struct device *dev,
|
||||
struct device_attribute *attr, char *buf)
|
||||
{
|
||||
struct sec_ts_data *ts;
|
||||
unsigned char buffer;
|
||||
ssize_t blen = 0;
|
||||
int error;
|
||||
|
||||
dev = MMI_DEV_TO_TS_DEV(dev);
|
||||
GET_TS_DATA(dev);
|
||||
|
||||
if (ts->power_status == SEC_TS_STATE_POWER_OFF) {
|
||||
dev_dbg(dev, "%s: power off state\n", __func__);
|
||||
blen += scnprintf(buf, PAGE_SIZE, "0x%02x", (unsigned int)(ts->gs_distance_data));
|
||||
return blen;
|
||||
}
|
||||
|
||||
error = ts->sec_ts_i2c_read(ts, SEC_TS_CMD_GRIP_SUPP_AREA, &buffer, sizeof(buffer));
|
||||
if (error < 0)
|
||||
dev_err(dev, "%s: failed to read grip suppression distance info (%d)\n",
|
||||
__func__, error);
|
||||
else {
|
||||
blen += scnprintf(buf, PAGE_SIZE, "0x%02x", (unsigned int)buffer);
|
||||
}
|
||||
|
||||
return blen;
|
||||
}
|
||||
|
||||
#define MAX_DATA_SZ 1024
|
||||
static u8 reg_address;
|
||||
static int data_size;
|
||||
|
|
@ -939,6 +1008,14 @@ static int sec_mmi_post_resume(struct device *dev) {
|
|||
__func__, ret);
|
||||
}
|
||||
|
||||
if(ts->plat_data->gs_distance_ctrl) {
|
||||
ret = ts->sec_ts_i2c_write(ts, SEC_TS_CMD_GRIP_SUPP_AREA,
|
||||
&ts->gs_distance_data, sizeof(ts->gs_distance_data));
|
||||
if (ret < 0)
|
||||
dev_err(dev, "%s: failed to write grip supp distance (%d)\n",
|
||||
__func__, ret);
|
||||
}
|
||||
|
||||
ret = ts->sec_ts_i2c_read(ts, SEC_TS_READ_BOOT_STATUS,
|
||||
&buffer, sizeof(buffer));
|
||||
if (ret < 0)
|
||||
|
|
@ -1068,7 +1145,15 @@ int sec_mmi_data_init(struct sec_ts_data *ts, bool enable)
|
|||
ret = ts->sec_ts_i2c_read(ts, SEC_TS_CMD_HOLD_DISTANCE,
|
||||
&ts->hold_distance_data, sizeof(ts->hold_distance_data));
|
||||
if (ret < 0)
|
||||
dev_err(&ts->client->dev, "%s: failed to write pill region (%d)\n",
|
||||
dev_err(&ts->client->dev, "%s: failed to write hold distance (%d)\n",
|
||||
__func__, ret);
|
||||
}
|
||||
|
||||
if(ts->plat_data->gs_distance_ctrl) {
|
||||
ret = ts->sec_ts_i2c_read(ts, SEC_TS_CMD_GRIP_SUPP_AREA,
|
||||
&ts->gs_distance_data, sizeof(ts->gs_distance_data));
|
||||
if (ret < 0)
|
||||
dev_err(&ts->client->dev, "%s: failed to write grip supp distance (%d)\n",
|
||||
__func__, ret);
|
||||
}
|
||||
} else
|
||||
|
|
|
|||
Loading…
Reference in a new issue