drivers/input/rmi4/rmi_2d_sensor.c

   1 // SPDX-License-Identifier: GPL-2.0-only
   2 /*
   3  * Copyright (c) 2011-2016 Synaptics Incorporated
   4  * Copyright (c) 2011 Unixphere
   5  */
   6
   7 #include <linux/kernel.h>
   8 #include <linux/device.h>
   9 #include <linux/of.h>
  10 #include <linux/input.h>
  11 #include <linux/input/mt.h>
  12 #include <linux/rmi.h>
  13 #include "rmi_driver.h"
  14 #include "rmi_2d_sensor.h"
  15
  16 #define RMI_2D_REL_POS_MIN              -128
  17 #define RMI_2D_REL_POS_MAX              127
  18
  19 /* maximum ABS_MT_POSITION displacement (in mm) */
  20 #define DMAX 10
  21
  22 void rmi_2d_sensor_abs_process(struct rmi_2d_sensor *sensor,
  23                                 struct rmi_2d_sensor_abs_object *obj,
  24                                 int slot)
  25 {
  26         struct rmi_2d_axis_alignment *axis_align = &sensor->axis_align;
  27
  28         /* we keep the previous values if the finger is released */
  29         if (obj->type == RMI_2D_OBJECT_NONE)
  30                 return;
  31
  32         if (axis_align->flip_x)
  33                 obj->x = sensor->max_x - obj->x;
  34
  35         if (axis_align->flip_y)
  36                 obj->y = sensor->max_y - obj->y;
  37
  38         if (axis_align->swap_axes)
  39                 swap(obj->x, obj->y);
  40
  41         /*
  42          * Here checking if X offset or y offset are specified is
  43          * redundant. We just add the offsets or clip the values.
  44          *
  45          * Note: offsets need to be applied before clipping occurs,
  46          * or we could get funny values that are outside of
  47          * clipping boundaries.
  48          */
  49         obj->x += axis_align->offset_x;
  50         obj->y += axis_align->offset_y;
  51
  52         obj->x =  max(axis_align->clip_x_low, obj->x);
  53         obj->y =  max(axis_align->clip_y_low, obj->y);
  54
  55         if (axis_align->clip_x_high)
  56                 obj->x = min(sensor->max_x, obj->x);
  57
  58         if (axis_align->clip_y_high)
  59                 obj->y =  min(sensor->max_y, obj->y);
  60
  61         sensor->tracking_pos[slot].x = obj->x;
  62         sensor->tracking_pos[slot].y = obj->y;
  63 }
  64 EXPORT_SYMBOL_GPL(rmi_2d_sensor_abs_process);
  65
  66 void rmi_2d_sensor_abs_report(struct rmi_2d_sensor *sensor,
  67                                 struct rmi_2d_sensor_abs_object *obj,
  68                                 int slot)
  69 {
  70         struct rmi_2d_axis_alignment *axis_align = &sensor->axis_align;
  71         struct input_dev *input = sensor->input;
  72         int wide, major, minor;
  73
  74         if (sensor->kernel_tracking)
  75                 input_mt_slot(input, sensor->tracking_slots[slot]);
  76         else
  77                 input_mt_slot(input, slot);
  78
  79         input_mt_report_slot_state(input, obj->mt_tool,
  80                                    obj->type != RMI_2D_OBJECT_NONE);
  81
  82         if (obj->type != RMI_2D_OBJECT_NONE) {
  83                 obj->x = sensor->tracking_pos[slot].x;
  84                 obj->y = sensor->tracking_pos[slot].y;
  85
  86                 if (axis_align->swap_axes)
  87                         swap(obj->wx, obj->wy);
  88
  89                 wide = (obj->wx > obj->wy);
  90                 major = max(obj->wx, obj->wy);
  91                 minor = min(obj->wx, obj->wy);
  92
  93                 if (obj->type == RMI_2D_OBJECT_STYLUS) {
  94                         major = max(1, major);
  95                         minor = max(1, minor);
  96                 }
  97
  98                 input_event(sensor->input, EV_ABS, ABS_MT_POSITION_X, obj->x);
  99                 input_event(sensor->input, EV_ABS, ABS_MT_POSITION_Y, obj->y);
 100                 input_event(sensor->input, EV_ABS, ABS_MT_ORIENTATION, wide);
 101                 input_event(sensor->input, EV_ABS, ABS_MT_PRESSURE, obj->z);
 102                 input_event(sensor->input, EV_ABS, ABS_MT_TOUCH_MAJOR, major);
 103                 input_event(sensor->input, EV_ABS, ABS_MT_TOUCH_MINOR, minor);
 104
 105                 rmi_dbg(RMI_DEBUG_2D_SENSOR, &sensor->input->dev,
 106                         "%s: obj[%d]: type: 0x%02x X: %d Y: %d Z: %d WX: %d WY: %d\n",
 107                         __func__, slot, obj->type, obj->x, obj->y, obj->z,
 108                         obj->wx, obj->wy);
 109         }
 110 }
 111 EXPORT_SYMBOL_GPL(rmi_2d_sensor_abs_report);
 112
 113 void rmi_2d_sensor_rel_report(struct rmi_2d_sensor *sensor, int x, int y)
 114 {
 115         struct rmi_2d_axis_alignment *axis_align = &sensor->axis_align;
 116
 117         x = min(RMI_2D_REL_POS_MAX, max(RMI_2D_REL_POS_MIN, (int)x));
 118         y = min(RMI_2D_REL_POS_MAX, max(RMI_2D_REL_POS_MIN, (int)y));
 119
 120         if (axis_align->flip_x)
 121                 x = min(RMI_2D_REL_POS_MAX, -x);
 122
 123         if (axis_align->flip_y)
 124                 y = min(RMI_2D_REL_POS_MAX, -y);
 125
 126         if (axis_align->swap_axes)
 127                 swap(x, y);
 128
 129         if (x || y) {
 130                 input_report_rel(sensor->input, REL_X, x);
 131                 input_report_rel(sensor->input, REL_Y, y);
 132         }
 133 }
 134 EXPORT_SYMBOL_GPL(rmi_2d_sensor_rel_report);
 135
 136 static void rmi_2d_sensor_set_input_params(struct rmi_2d_sensor *sensor)
 137 {
 138         struct input_dev *input = sensor->input;
 139         int res_x;
 140         int res_y;
 141         int max_x, max_y;
 142         int input_flags = 0;
 143
 144         if (sensor->report_abs) {
 145                 sensor->min_x = sensor->axis_align.clip_x_low;
 146                 if (sensor->axis_align.clip_x_high)
 147                         sensor->max_x = min(sensor->max_x,
 148                                 sensor->axis_align.clip_x_high);
 149
 150                 sensor->min_y = sensor->axis_align.clip_y_low;
 151                 if (sensor->axis_align.clip_y_high)
 152                         sensor->max_y = min(sensor->max_y,
 153                                 sensor->axis_align.clip_y_high);
 154
 155                 set_bit(EV_ABS, input->evbit);
 156
 157                 max_x = sensor->max_x;
 158                 max_y = sensor->max_y;
 159                 if (sensor->axis_align.swap_axes)
 160                         swap(max_x, max_y);
 161                 input_set_abs_params(input, ABS_MT_POSITION_X, 0, max_x, 0, 0);
 162                 input_set_abs_params(input, ABS_MT_POSITION_Y, 0, max_y, 0, 0);
 163
 164                 if (sensor->x_mm && sensor->y_mm) {
 165                         res_x = (sensor->max_x - sensor->min_x) / sensor->x_mm;
 166                         res_y = (sensor->max_y - sensor->min_y) / sensor->y_mm;
 167                         if (sensor->axis_align.swap_axes)
 168                                 swap(res_x, res_y);
 169
 170                         input_abs_set_res(input, ABS_X, res_x);
 171                         input_abs_set_res(input, ABS_Y, res_y);
 172
 173                         input_abs_set_res(input, ABS_MT_POSITION_X, res_x);
 174                         input_abs_set_res(input, ABS_MT_POSITION_Y, res_y);
 175
 176                         if (!sensor->dmax)
 177                                 sensor->dmax = DMAX * res_x;
 178                 }
 179
 180                 input_set_abs_params(input, ABS_MT_PRESSURE, 0, 0xff, 0, 0);
 181                 input_set_abs_params(input, ABS_MT_TOUCH_MAJOR, 0, 0x0f, 0, 0);
 182                 input_set_abs_params(input, ABS_MT_TOUCH_MINOR, 0, 0x0f, 0, 0);
 183                 input_set_abs_params(input, ABS_MT_ORIENTATION, 0, 1, 0, 0);
 184                 input_set_abs_params(input, ABS_MT_TOOL_TYPE,
 185                                      0, MT_TOOL_MAX, 0, 0);
 186
 187                 if (sensor->sensor_type == rmi_sensor_touchpad)
 188                         input_flags = INPUT_MT_POINTER;
 189                 else
 190                         input_flags = INPUT_MT_DIRECT;
 191
 192                 if (sensor->kernel_tracking)
 193                         input_flags |= INPUT_MT_TRACK;
 194
 195                 input_mt_init_slots(input, sensor->nbr_fingers, input_flags);
 196         }
 197
 198         if (sensor->report_rel) {
 199                 set_bit(EV_REL, input->evbit);
 200                 set_bit(REL_X, input->relbit);
 201                 set_bit(REL_Y, input->relbit);
 202         }
 203
 204         if (sensor->topbuttonpad)
 205                 set_bit(INPUT_PROP_TOPBUTTONPAD, input->propbit);
 206 }
 207 EXPORT_SYMBOL_GPL(rmi_2d_sensor_set_input_params);
 208
 209 int rmi_2d_sensor_configure_input(struct rmi_function *fn,
 210                                         struct rmi_2d_sensor *sensor)
 211 {
 212         struct rmi_device *rmi_dev = fn->rmi_dev;
 213         struct rmi_driver_data *drv_data = dev_get_drvdata(&rmi_dev->dev);
 214
 215         if (!drv_data->input)
 216                 return -ENODEV;
 217
 218         sensor->input = drv_data->input;
 219         rmi_2d_sensor_set_input_params(sensor);
 220
 221         return 0;
 222 }
 223 EXPORT_SYMBOL_GPL(rmi_2d_sensor_configure_input);
 224
 225 #ifdef CONFIG_OF
 226 int rmi_2d_sensor_of_probe(struct device *dev,
 227                         struct rmi_2d_sensor_platform_data *pdata)
 228 {
 229         int retval;
 230         u32 val;
 231
 232         pdata->axis_align.swap_axes = of_property_read_bool(dev->of_node,
 233                                                 "touchscreen-swapped-x-y");
 234
 235         pdata->axis_align.flip_x = of_property_read_bool(dev->of_node,
 236                                                 "touchscreen-inverted-x");
 237
 238         pdata->axis_align.flip_y = of_property_read_bool(dev->of_node,
 239                                                 "touchscreen-inverted-y");
 240
 241         retval = rmi_of_property_read_u32(dev, &val, "syna,clip-x-low", 1);
 242         if (retval)
 243                 return retval;
 244
 245         pdata->axis_align.clip_x_low = val;
 246
 247         retval = rmi_of_property_read_u32(dev, &val, "syna,clip-y-low", 1);
 248         if (retval)
 249                 return retval;
 250
 251         pdata->axis_align.clip_y_low = val;
 252
 253         retval = rmi_of_property_read_u32(dev, &val, "syna,clip-x-high", 1);
 254         if (retval)
 255                 return retval;
 256
 257         pdata->axis_align.clip_x_high = val;
 258
 259         retval = rmi_of_property_read_u32(dev, &val, "syna,clip-y-high", 1);
 260         if (retval)
 261                 return retval;
 262
 263         pdata->axis_align.clip_y_high = val;
 264
 265         retval = rmi_of_property_read_u32(dev, &val, "syna,offset-x", 1);
 266         if (retval)
 267                 return retval;
 268
 269         pdata->axis_align.offset_x = val;
 270
 271         retval = rmi_of_property_read_u32(dev, &val, "syna,offset-y", 1);
 272         if (retval)
 273                 return retval;
 274
 275         pdata->axis_align.offset_y = val;
 276
 277         retval = rmi_of_property_read_u32(dev, &val, "syna,delta-x-threshold",
 278                                                 1);
 279         if (retval)
 280                 return retval;
 281
 282         pdata->axis_align.delta_x_threshold = val;
 283
 284         retval = rmi_of_property_read_u32(dev, &val, "syna,delta-y-threshold",
 285                                                 1);
 286         if (retval)
 287                 return retval;
 288
 289         pdata->axis_align.delta_y_threshold = val;
 290
 291         retval = rmi_of_property_read_u32(dev, (u32 *)&pdata->sensor_type,
 292                         "syna,sensor-type", 1);
 293         if (retval)
 294                 return retval;
 295
 296         retval = rmi_of_property_read_u32(dev, &val, "touchscreen-x-mm", 1);
 297         if (retval)
 298                 return retval;
 299
 300         pdata->x_mm = val;
 301
 302         retval = rmi_of_property_read_u32(dev, &val, "touchscreen-y-mm", 1);
 303         if (retval)
 304                 return retval;
 305
 306         pdata->y_mm = val;
 307
 308         retval = rmi_of_property_read_u32(dev, &val,
 309                                 "syna,disable-report-mask", 1);
 310         if (retval)
 311                 return retval;
 312
 313         pdata->disable_report_mask = val;
 314
 315         retval = rmi_of_property_read_u32(dev, &val, "syna,rezero-wait-ms",
 316                                                 1);
 317         if (retval)
 318                 return retval;
 319
 320         pdata->rezero_wait = val;
 321
 322         return 0;
 323 }
 324 #else
 325 inline int rmi_2d_sensor_of_probe(struct device *dev,
 326                         struct rmi_2d_sensor_platform_data *pdata)
 327 {
 328         return -ENODEV;
 329 }
 330 #endif
 331 EXPORT_SYMBOL_GPL(rmi_2d_sensor_of_probe);