112 	struct stmfts_data *sdata = container_of(led_cdev,  in stmfts_brightness_set()  local
116 	if (value == sdata->led_status || !sdata->ledvdd)  in stmfts_brightness_set()
120 		regulator_disable(sdata->ledvdd);  in stmfts_brightness_set()
122 		err = regulator_enable(sdata->ledvdd);  in stmfts_brightness_set()
124 			dev_warn(&sdata->client->dev,  in stmfts_brightness_set()
129 	sdata->led_status = value;  in stmfts_brightness_set()
134 	struct stmfts_data *sdata = container_of(led_cdev,  in stmfts_brightness_get()  local
137 	return !!regulator_is_enabled(sdata->ledvdd);  in stmfts_brightness_get()
144 static int stmfts_read_events(struct stmfts_data *sdata)  in stmfts_read_events()  argument
149 			.addr	= sdata->client->addr,  in stmfts_read_events()
154 			.addr	= sdata->client->addr,  in stmfts_read_events()
157 			.buf	= sdata->data,  in stmfts_read_events()
162 	ret = i2c_transfer(sdata->client->adapter, msgs, ARRAY_SIZE(msgs));  in stmfts_read_events()
169 static void stmfts_report_contact_event(struct stmfts_data *sdata,  in stmfts_report_contact_event()  argument
180 	input_mt_slot(sdata->input, slot_id);  in stmfts_report_contact_event()
182 	input_mt_report_slot_state(sdata->input, MT_TOOL_FINGER, true);  in stmfts_report_contact_event()
183 	input_report_abs(sdata->input, ABS_MT_POSITION_X, x);  in stmfts_report_contact_event()
184 	input_report_abs(sdata->input, ABS_MT_POSITION_Y, y);  in stmfts_report_contact_event()
185 	input_report_abs(sdata->input, ABS_MT_TOUCH_MAJOR, maj);  in stmfts_report_contact_event()
186 	input_report_abs(sdata->input, ABS_MT_TOUCH_MINOR, min);  in stmfts_report_contact_event()
187 	input_report_abs(sdata->input, ABS_MT_PRESSURE, area);  in stmfts_report_contact_event()
188 	input_report_abs(sdata->input, ABS_MT_ORIENTATION, orientation);  in stmfts_report_contact_event()
190 	input_sync(sdata->input);  in stmfts_report_contact_event()
193 static void stmfts_report_contact_release(struct stmfts_data *sdata,  in stmfts_report_contact_release()  argument
198 	input_mt_slot(sdata->input, slot_id);  in stmfts_report_contact_release()
199 	input_mt_report_slot_state(sdata->input, MT_TOOL_FINGER, false);  in stmfts_report_contact_release()
201 	input_sync(sdata->input);  in stmfts_report_contact_release()
204 static void stmfts_report_hover_event(struct stmfts_data *sdata,  in stmfts_report_hover_event()  argument
211 	input_report_abs(sdata->input, ABS_X, x);  in stmfts_report_hover_event()
212 	input_report_abs(sdata->input, ABS_Y, y);  in stmfts_report_hover_event()
213 	input_report_abs(sdata->input, ABS_DISTANCE, z);  in stmfts_report_hover_event()
215 	input_sync(sdata->input);  in stmfts_report_hover_event()
218 static void stmfts_report_key_event(struct stmfts_data *sdata, const u8 event[])  in stmfts_report_key_event()  argument
222 		input_report_key(sdata->input, KEY_BACK, 0);  in stmfts_report_key_event()
223 		input_report_key(sdata->input, KEY_MENU, 0);  in stmfts_report_key_event()
227 		input_report_key(sdata->input, KEY_BACK, 1);  in stmfts_report_key_event()
231 		input_report_key(sdata->input, KEY_MENU, 1);  in stmfts_report_key_event()
235 		dev_warn(&sdata->client->dev,  in stmfts_report_key_event()
240 	input_sync(sdata->input);  in stmfts_report_key_event()
243 static void stmfts_parse_events(struct stmfts_data *sdata)  in stmfts_parse_events()  argument
248 		u8 *event = &sdata->data[i * STMFTS_EVENT_SIZE];  in stmfts_parse_events()
255 			complete(&sdata->cmd_done);  in stmfts_parse_events()
267 			stmfts_report_contact_event(sdata, event);  in stmfts_parse_events()
271 			stmfts_report_contact_release(sdata, event);  in stmfts_parse_events()
277 			stmfts_report_hover_event(sdata, event);  in stmfts_parse_events()
281 			stmfts_report_key_event(sdata, event);  in stmfts_parse_events()
285 			dev_warn(&sdata->client->dev,  in stmfts_parse_events()
292 			dev_err(&sdata->client->dev,  in stmfts_parse_events()
300 	struct stmfts_data *sdata = dev;  in stmfts_irq_handler()  local
303 	mutex_lock(&sdata->mutex);  in stmfts_irq_handler()
305 	err = stmfts_read_events(sdata);  in stmfts_irq_handler()
307 		dev_err(&sdata->client->dev,  in stmfts_irq_handler()
310 		stmfts_parse_events(sdata);  in stmfts_irq_handler()
312 	mutex_unlock(&sdata->mutex);  in stmfts_irq_handler()
316 static int stmfts_command(struct stmfts_data *sdata, const u8 cmd)  in stmfts_command()  argument
320 	reinit_completion(&sdata->cmd_done);  in stmfts_command()
322 	err = i2c_smbus_write_byte(sdata->client, cmd);  in stmfts_command()
326 	if (!wait_for_completion_timeout(&sdata->cmd_done,  in stmfts_command()
335 	struct stmfts_data *sdata = input_get_drvdata(dev);  in stmfts_input_open()  local
338 	err = pm_runtime_get_sync(&sdata->client->dev);  in stmfts_input_open()
342 	err = i2c_smbus_write_byte(sdata->client, STMFTS_MS_MT_SENSE_ON);  in stmfts_input_open()
346 	mutex_lock(&sdata->mutex);  in stmfts_input_open()
347 	sdata->running = true;  in stmfts_input_open()
349 	if (sdata->hover_enabled) {  in stmfts_input_open()
350 		err = i2c_smbus_write_byte(sdata->client,  in stmfts_input_open()
353 			dev_warn(&sdata->client->dev,  in stmfts_input_open()
356 	mutex_unlock(&sdata->mutex);  in stmfts_input_open()
358 	if (sdata->use_key) {  in stmfts_input_open()
359 		err = i2c_smbus_write_byte(sdata->client,  in stmfts_input_open()
363 			dev_warn(&sdata->client->dev,  in stmfts_input_open()
372 	struct stmfts_data *sdata = input_get_drvdata(dev);  in stmfts_input_close()  local
375 	err = i2c_smbus_write_byte(sdata->client, STMFTS_MS_MT_SENSE_OFF);  in stmfts_input_close()
377 		dev_warn(&sdata->client->dev,  in stmfts_input_close()
380 	mutex_lock(&sdata->mutex);  in stmfts_input_close()
382 	sdata->running = false;  in stmfts_input_close()
384 	if (sdata->hover_enabled) {  in stmfts_input_close()
385 		err = i2c_smbus_write_byte(sdata->client,  in stmfts_input_close()
388 			dev_warn(&sdata->client->dev,  in stmfts_input_close()
391 	mutex_unlock(&sdata->mutex);  in stmfts_input_close()
393 	if (sdata->use_key) {  in stmfts_input_close()
394 		err = i2c_smbus_write_byte(sdata->client,  in stmfts_input_close()
397 			dev_warn(&sdata->client->dev,  in stmfts_input_close()
401 	pm_runtime_put_sync(&sdata->client->dev);  in stmfts_input_close()
407 	struct stmfts_data *sdata = dev_get_drvdata(dev);  in stmfts_sysfs_chip_id()  local
409 	return sprintf(buf, "%#x\n", sdata->chip_id);  in stmfts_sysfs_chip_id()
415 	struct stmfts_data *sdata = dev_get_drvdata(dev);  in stmfts_sysfs_chip_version()  local
417 	return sprintf(buf, "%u\n", sdata->chip_ver);  in stmfts_sysfs_chip_version()
423 	struct stmfts_data *sdata = dev_get_drvdata(dev);  in stmfts_sysfs_fw_ver()  local
425 	return sprintf(buf, "%u\n", sdata->fw_ver);  in stmfts_sysfs_fw_ver()
431 	struct stmfts_data *sdata = dev_get_drvdata(dev);  in stmfts_sysfs_config_id()  local
433 	return sprintf(buf, "%#x\n", sdata->config_id);  in stmfts_sysfs_config_id()
439 	struct stmfts_data *sdata = dev_get_drvdata(dev);  in stmfts_sysfs_config_version()  local
441 	return sprintf(buf, "%u\n", sdata->config_ver);  in stmfts_sysfs_config_version()
447 	struct stmfts_data *sdata = dev_get_drvdata(dev);  in stmfts_sysfs_read_status()  local
451 	err = i2c_smbus_read_i2c_block_data(sdata->client, STMFTS_READ_STATUS,  in stmfts_sysfs_read_status()
462 	struct stmfts_data *sdata = dev_get_drvdata(dev);  in stmfts_sysfs_hover_enable_read()  local
464 	return sprintf(buf, "%u\n", sdata->hover_enabled);  in stmfts_sysfs_hover_enable_read()
471 	struct stmfts_data *sdata = dev_get_drvdata(dev);  in stmfts_sysfs_hover_enable_write()  local
478 	mutex_lock(&sdata->mutex);  in stmfts_sysfs_hover_enable_write()
480 	if (value & sdata->hover_enabled)  in stmfts_sysfs_hover_enable_write()
483 	if (sdata->running)  in stmfts_sysfs_hover_enable_write()
484 		err = i2c_smbus_write_byte(sdata->client,  in stmfts_sysfs_hover_enable_write()
489 		sdata->hover_enabled = !!value;  in stmfts_sysfs_hover_enable_write()
492 	mutex_unlock(&sdata->mutex);  in stmfts_sysfs_hover_enable_write()
521 static int stmfts_power_on(struct stmfts_data *sdata)  in stmfts_power_on()  argument
526 	err = regulator_bulk_enable(ARRAY_SIZE(sdata->regulators),  in stmfts_power_on()
527 				    sdata->regulators);  in stmfts_power_on()
537 	err = i2c_smbus_read_i2c_block_data(sdata->client, STMFTS_READ_INFO,  in stmfts_power_on()
544 	sdata->chip_id = be16_to_cpup((__be16 *)&reg[6]);  in stmfts_power_on()
545 	sdata->chip_ver = reg[0];  in stmfts_power_on()
546 	sdata->fw_ver = be16_to_cpup((__be16 *)&reg[2]);  in stmfts_power_on()
547 	sdata->config_id = reg[4];  in stmfts_power_on()
548 	sdata->config_ver = reg[5];  in stmfts_power_on()
550 	enable_irq(sdata->client->irq);  in stmfts_power_on()
554 	err = stmfts_command(sdata, STMFTS_SYSTEM_RESET);  in stmfts_power_on()
558 	err = stmfts_command(sdata, STMFTS_SLEEP_OUT);  in stmfts_power_on()
563 	err = stmfts_command(sdata, STMFTS_MS_CX_TUNING);  in stmfts_power_on()
565 		dev_warn(&sdata->client->dev,  in stmfts_power_on()
569 	err = stmfts_command(sdata, STMFTS_SS_CX_TUNING);  in stmfts_power_on()
571 		dev_warn(&sdata->client->dev,  in stmfts_power_on()
574 	err = stmfts_command(sdata, STMFTS_FULL_FORCE_CALIBRATION);  in stmfts_power_on()
582 	(void) i2c_smbus_write_byte(sdata->client, STMFTS_SLEEP_IN);  in stmfts_power_on()
589 	struct stmfts_data *sdata = data;  in stmfts_power_off()  local
591 	disable_irq(sdata->client->irq);  in stmfts_power_off()
592 	regulator_bulk_disable(ARRAY_SIZE(sdata->regulators),  in stmfts_power_off()
593 						sdata->regulators);  in stmfts_power_off()
599 static int stmfts_enable_led(struct stmfts_data *sdata)  in stmfts_enable_led()  argument
604 	sdata->ledvdd = devm_regulator_get(&sdata->client->dev, "ledvdd");  in stmfts_enable_led()
605 	if (IS_ERR(sdata->ledvdd))  in stmfts_enable_led()
606 		return PTR_ERR(sdata->ledvdd);  in stmfts_enable_led()
608 	sdata->led_cdev.name = STMFTS_DEV_NAME;  in stmfts_enable_led()
609 	sdata->led_cdev.max_brightness = LED_ON;  in stmfts_enable_led()
610 	sdata->led_cdev.brightness = LED_OFF;  in stmfts_enable_led()
611 	sdata->led_cdev.brightness_set = stmfts_brightness_set;  in stmfts_enable_led()
612 	sdata->led_cdev.brightness_get = stmfts_brightness_get;  in stmfts_enable_led()
614 	err = devm_led_classdev_register(&sdata->client->dev, &sdata->led_cdev);  in stmfts_enable_led()
616 		devm_regulator_put(sdata->ledvdd);  in stmfts_enable_led()
627 	struct stmfts_data *sdata;  in stmfts_probe()  local
634 	sdata = devm_kzalloc(&client->dev, sizeof(*sdata), GFP_KERNEL);  in stmfts_probe()
635 	if (!sdata)  in stmfts_probe()
638 	i2c_set_clientdata(client, sdata);  in stmfts_probe()
640 	sdata->client = client;  in stmfts_probe()
641 	mutex_init(&sdata->mutex);  in stmfts_probe()
642 	init_completion(&sdata->cmd_done);  in stmfts_probe()
644 	sdata->regulators[STMFTS_REGULATOR_VDD].supply = "vdd";  in stmfts_probe()
645 	sdata->regulators[STMFTS_REGULATOR_AVDD].supply = "avdd";  in stmfts_probe()
647 				      ARRAY_SIZE(sdata->regulators),  in stmfts_probe()
648 				      sdata->regulators);  in stmfts_probe()
652 	sdata->input = devm_input_allocate_device(&client->dev);  in stmfts_probe()
653 	if (!sdata->input)  in stmfts_probe()
656 	sdata->input->name = STMFTS_DEV_NAME;  in stmfts_probe()
657 	sdata->input->id.bustype = BUS_I2C;  in stmfts_probe()
658 	sdata->input->open = stmfts_input_open;  in stmfts_probe()
659 	sdata->input->close = stmfts_input_close;  in stmfts_probe()
661 	input_set_capability(sdata->input, EV_ABS, ABS_MT_POSITION_X);  in stmfts_probe()
662 	input_set_capability(sdata->input, EV_ABS, ABS_MT_POSITION_Y);  in stmfts_probe()
663 	touchscreen_parse_properties(sdata->input, true, &sdata->prop);  in stmfts_probe()
665 	input_set_abs_params(sdata->input, ABS_MT_TOUCH_MAJOR, 0, 255, 0, 0);  in stmfts_probe()
666 	input_set_abs_params(sdata->input, ABS_MT_TOUCH_MINOR, 0, 255, 0, 0);  in stmfts_probe()
667 	input_set_abs_params(sdata->input, ABS_MT_ORIENTATION, 0, 255, 0, 0);  in stmfts_probe()
668 	input_set_abs_params(sdata->input, ABS_MT_PRESSURE, 0, 255, 0, 0);  in stmfts_probe()
669 	input_set_abs_params(sdata->input, ABS_DISTANCE, 0, 255, 0, 0);  in stmfts_probe()
671 	sdata->use_key = device_property_read_bool(&client->dev,  in stmfts_probe()
673 	if (sdata->use_key) {  in stmfts_probe()
674 		input_set_capability(sdata->input, EV_KEY, KEY_MENU);  in stmfts_probe()
675 		input_set_capability(sdata->input, EV_KEY, KEY_BACK);  in stmfts_probe()
678 	err = input_mt_init_slots(sdata->input,  in stmfts_probe()
683 	input_set_drvdata(sdata->input, sdata);  in stmfts_probe()
696 					"stmfts_irq", sdata);  in stmfts_probe()
702 	err = stmfts_power_on(sdata);  in stmfts_probe()
706 	err = devm_add_action_or_reset(&client->dev, stmfts_power_off, sdata);  in stmfts_probe()
710 	err = input_register_device(sdata->input);  in stmfts_probe()
714 	if (sdata->use_key) {  in stmfts_probe()
715 		err = stmfts_enable_led(sdata);  in stmfts_probe()
724 			sdata->ledvdd = NULL;  in stmfts_probe()
747 	struct stmfts_data *sdata = dev_get_drvdata(dev);  in stmfts_runtime_suspend()  local
750 	ret = i2c_smbus_write_byte(sdata->client, STMFTS_SLEEP_IN);  in stmfts_runtime_suspend()
759 	struct stmfts_data *sdata = dev_get_drvdata(dev);  in stmfts_runtime_resume()  local
762 	ret = i2c_smbus_write_byte(sdata->client, STMFTS_SLEEP_OUT);  in stmfts_runtime_resume()
771 	struct stmfts_data *sdata = dev_get_drvdata(dev);  in stmfts_suspend()  local
773 	stmfts_power_off(sdata);  in stmfts_suspend()
780 	struct stmfts_data *sdata = dev_get_drvdata(dev);  in stmfts_resume()  local
782 	return stmfts_power_on(sdata);  in stmfts_resume()