void input_set_abs_params(struct input_dev *dev, unsigned int axis,
int min, int max, int fuzz, int flat)
{
struct input_absinfo *absinfo;
input_alloc_absinfo(dev);
if (!dev->absinfo)
return;
absinfo = &dev->absinfo[axis];
absinfo->minimum = min;
absinfo->maximum = max;
absinfo->fuzz = fuzz;
absinfo->flat = flat;
dev->absbit[BIT_WORD(axis)] |= BIT_MASK(axis);
}
/**
* touchscreen_parse_properties - parse common touchscreen DT properties
* @input: input device that should be parsed
* @multitouch: specifies whether parsed properties should be applied to
* single-touch or multi-touch axes
* @prop: pointer to a struct touchscreen_properties into which to store
* axis swap and invert info for use with touchscreen_report_x_y();
* or %NULL
*
* This function parses common DT properties for touchscreens and setups the
* input device accordingly. The function keeps previously set up default
* values if no value is specified via DT.
*/
void touchscreen_parse_properties(struct input_dev *input, bool multitouch,
struct touchscreen_properties *prop)
{
struct device *dev = input->dev.parent;
unsigned int axis;
unsigned int maximum, fuzz;
bool data_present;
input_alloc_absinfo(input);
if (!input->absinfo)
return;
axis = multitouch ? ABS_MT_POSITION_X : ABS_X;
data_present = touchscreen_get_prop_u32(dev, "touchscreen-size-x",
input_abs_get_max(input,
axis) + 1,
&maximum) |
touchscreen_get_prop_u32(dev, "touchscreen-fuzz-x",
input_abs_get_fuzz(input, axis),
&fuzz);
if (data_present)
touchscreen_set_params(input, axis, maximum - 1, fuzz);
axis = multitouch ? ABS_MT_POSITION_Y : ABS_Y;
data_present = touchscreen_get_prop_u32(dev, "touchscreen-size-y",
input_abs_get_max(input,
axis) + 1,
&maximum) |
touchscreen_get_prop_u32(dev, "touchscreen-fuzz-y",
input_abs_get_fuzz(input, axis),
&fuzz);
if (data_present)
touchscreen_set_params(input, axis, maximum - 1, fuzz);
axis = multitouch ? ABS_MT_PRESSURE : ABS_PRESSURE;
data_present = touchscreen_get_prop_u32(dev,
"touchscreen-max-pressure",
input_abs_get_max(input, axis),
&maximum) |
touchscreen_get_prop_u32(dev,
"touchscreen-fuzz-pressure",
input_abs_get_fuzz(input, axis),
&fuzz);
if (data_present)
touchscreen_set_params(input, axis, maximum, fuzz);
if (!prop)
return;
axis = multitouch ? ABS_MT_POSITION_X : ABS_X;
prop->max_x = input_abs_get_max(input, axis);
prop->max_y = input_abs_get_max(input, axis + 1);
prop->invert_x =
device_property_read_bool(dev, "touchscreen-inverted-x");
prop->invert_y =
device_property_read_bool(dev, "touchscreen-inverted-y");
prop->swap_x_y =
device_property_read_bool(dev, "touchscreen-swapped-x-y");
if (prop->swap_x_y)
swap(input->absinfo[axis], input->absinfo[axis + 1]);
}
static int
sensor_probe(struct platform_device *pdev)
{
struct sensor_data *data = NULL;
struct input_dev *input_data = NULL;
int input_registered = 0, sysfs_created = 0;
int rt;
data = kzalloc(sizeof(struct sensor_data), GFP_KERNEL);
if (!data) {
rt = -ENOMEM;
goto err;
}
data->enabled = 0;
data->delay = SENSOR_DEFAULT_DELAY;
input_data = input_allocate_device();
if (!input_data) {
rt = -ENOMEM;
YLOGE(("sensor_probe: Failed to allocate input_data device\n"));
goto err;
}
input_alloc_absinfo(input_data);
set_bit(EV_ABS, input_data->evbit);
input_set_capability(input_data, EV_ABS, ABS_X);
#if SENSOR_TYPE <= 4
input_set_capability(input_data, EV_ABS, ABS_Y);
input_set_capability(input_data, EV_ABS, ABS_Z);
input_set_capability(input_data, EV_ABS, ABS_RUDDER);
#endif
input_set_capability(input_data, EV_ABS, ABS_STATUS); /* status */
input_set_capability(input_data, EV_ABS, ABS_WAKE); /* wake */
input_set_capability(input_data, EV_ABS, ABS_CONTROL_REPORT); /* enabled/delay */
input_data->name = SENSOR_NAME;
rt = input_register_device(input_data);
if (rt) {
YLOGE(("sensor_probe: Unable to register input_data device: %s\n",
input_data->name));
goto err;
}
input_set_drvdata(input_data, data);
input_registered = 1;
rt = sysfs_create_group(&input_data->dev.kobj,
&sensor_attribute_group);
if (rt) {
YLOGE(("sensor_probe: sysfs_create_group failed[%s]\n",
input_data->name));
goto err;
}
sysfs_created = 1;
mutex_init(&data->mutex);
this_data = input_data;
return 0;
err:
if (data != NULL) {
if (input_data != NULL) {
if (sysfs_created) {
sysfs_remove_group(&input_data->dev.kobj,
&sensor_attribute_group);
}
if (input_registered) {
input_unregister_device(input_data);
}
else {
input_free_device(input_data);
}
input_data = NULL;
}
kfree(data);
}
return rt;
}
