134 static bool is_f54_report_type_valid(struct f54_data *f54,  in is_f54_report_type_valid()  argument
139 		return f54->capabilities & F54_CAP_IMAGE8;  in is_f54_report_type_valid()
142 		return f54->capabilities & F54_CAP_IMAGE16;  in is_f54_report_type_valid()
144 		return f54->capabilities & F54_CAP_IMAGE16;  in is_f54_report_type_valid()
153 static enum rmi_f54_report_type rmi_f54_get_reptype(struct f54_data *f54,  in rmi_f54_get_reptype()  argument
159 	return f54->inputs[i];  in rmi_f54_get_reptype()
162 static void rmi_f54_create_input_map(struct f54_data *f54)  in rmi_f54_create_input_map()  argument
168 		if (!is_f54_report_type_valid(f54, reptype))  in rmi_f54_create_input_map()
171 		f54->inputs[i++] = reptype;  in rmi_f54_create_input_map()
179 	struct f54_data *f54 = dev_get_drvdata(&fn->dev);  in rmi_f54_request_report()  local
184 	if (f54->report_type != report_type) {  in rmi_f54_request_report()
185 		error = rmi_write(rmi_dev, f54->fn->fd.data_base_addr,  in rmi_f54_request_report()
189 		f54->report_type = report_type;  in rmi_f54_request_report()
199 	mutex_lock(&f54->data_mutex);  in rmi_f54_request_report()
205 	init_completion(&f54->cmd_done);  in rmi_f54_request_report()
207 	f54->is_busy = 1;  in rmi_f54_request_report()
208 	f54->timeout = jiffies + msecs_to_jiffies(100);  in rmi_f54_request_report()
210 	queue_delayed_work(f54->workqueue, &f54->work, 0);  in rmi_f54_request_report()
213 	mutex_unlock(&f54->data_mutex);  in rmi_f54_request_report()
218 static size_t rmi_f54_get_report_size(struct f54_data *f54)  in rmi_f54_get_report_size()  argument
220 	struct rmi_device *rmi_dev = f54->fn->rmi_dev;  in rmi_f54_get_report_size()
222 	u8 rx = drv_data->num_rx_electrodes ? : f54->num_rx_electrodes;  in rmi_f54_get_report_size()
223 	u8 tx = drv_data->num_tx_electrodes ? : f54->num_tx_electrodes;  in rmi_f54_get_report_size()
226 	switch (rmi_f54_get_reptype(f54, f54->input)) {  in rmi_f54_get_report_size()
287 	struct f54_data *f54 = q->drv_priv;  in rmi_f54_queue_setup()  local
290 		return sizes[0] < rmi_f54_get_report_size(f54) ? -EINVAL : 0;  in rmi_f54_queue_setup()
293 	sizes[0] = rmi_f54_get_report_size(f54);  in rmi_f54_queue_setup()
301 	struct f54_data *f54 = vb2_get_drv_priv(vb->vb2_queue);  in rmi_f54_buffer_queue()  local
307 	mutex_lock(&f54->status_mutex);  in rmi_f54_buffer_queue()
310 	reptype = rmi_f54_get_reptype(f54, f54->input);  in rmi_f54_buffer_queue()
316 	if (f54->is_busy) {  in rmi_f54_buffer_queue()
321 	ret = rmi_f54_request_report(f54->fn, reptype);  in rmi_f54_buffer_queue()
323 		dev_err(&f54->fn->dev, "Error requesting F54 report\n");  in rmi_f54_buffer_queue()
329 	mutex_lock(&f54->data_mutex);  in rmi_f54_buffer_queue()
331 	while (f54->is_busy) {  in rmi_f54_buffer_queue()
332 		mutex_unlock(&f54->data_mutex);  in rmi_f54_buffer_queue()
333 		if (!wait_for_completion_timeout(&f54->cmd_done,  in rmi_f54_buffer_queue()
335 			dev_err(&f54->fn->dev, "Timed out\n");  in rmi_f54_buffer_queue()
339 		mutex_lock(&f54->data_mutex);  in rmi_f54_buffer_queue()
344 		dev_err(&f54->fn->dev, "Error acquiring frame ptr\n");  in rmi_f54_buffer_queue()
349 	memcpy(ptr, f54->report_data, f54->report_size);  in rmi_f54_buffer_queue()
350 	vb2_set_plane_payload(vb, 0, rmi_f54_get_report_size(f54));  in rmi_f54_buffer_queue()
354 	mutex_unlock(&f54->data_mutex);  in rmi_f54_buffer_queue()
358 	vbuf->sequence = f54->sequence++;  in rmi_f54_buffer_queue()
360 	mutex_unlock(&f54->status_mutex);  in rmi_f54_buffer_queue()
365 	struct f54_data *f54 = vb2_get_drv_priv(q);  in rmi_f54_stop_streaming()  local
367 	f54->sequence = 0;  in rmi_f54_stop_streaming()
391 	struct f54_data *f54 = video_drvdata(file);  in rmi_f54_vidioc_querycap()  local
396 		"rmi4:%s", dev_name(&f54->fn->dev));  in rmi_f54_vidioc_querycap()
404 	struct f54_data *f54 = video_drvdata(file);  in rmi_f54_vidioc_enum_input()  local
407 	reptype = rmi_f54_get_reptype(f54, i->index);  in rmi_f54_vidioc_enum_input()
417 static int rmi_f54_set_input(struct f54_data *f54, unsigned int i)  in rmi_f54_set_input()  argument
419 	struct rmi_device *rmi_dev = f54->fn->rmi_dev;  in rmi_f54_set_input()
421 	u8 rx = drv_data->num_rx_electrodes ? : f54->num_rx_electrodes;  in rmi_f54_set_input()
422 	u8 tx = drv_data->num_tx_electrodes ? : f54->num_tx_electrodes;  in rmi_f54_set_input()
423 	struct v4l2_pix_format *f = &f54->format;  in rmi_f54_set_input()
427 	reptype = rmi_f54_get_reptype(f54, i);  in rmi_f54_set_input()
435 	f54->input = i;  in rmi_f54_set_input()
455 	struct f54_data *f54 = video_drvdata(file);  in rmi_f54_vidioc_g_input()  local
457 	*i = f54->input;  in rmi_f54_vidioc_g_input()
465 	struct f54_data *f54 = video_drvdata(file);  in rmi_f54_vidioc_fmt()  local
467 	f->fmt.pix = f54->format;  in rmi_f54_vidioc_fmt()
475 	struct f54_data *f54 = video_drvdata(file);  in rmi_f54_vidioc_enum_fmt()  local
483 	fmt->pixelformat = f54->format.pixelformat;  in rmi_f54_vidioc_enum_fmt()
535 	struct f54_data *f54 = container_of(work, struct f54_data, work.work);  in rmi_f54_work()  local
536 	struct rmi_function *fn = f54->fn;  in rmi_f54_work()
543 	report_size = rmi_f54_get_report_size(f54);  in rmi_f54_work()
546 				f54->report_type);  in rmi_f54_work()
551 	mutex_lock(&f54->data_mutex);  in rmi_f54_work()
557 	error = rmi_read(fn->rmi_dev, f54->fn->fd.command_base_addr,  in rmi_f54_work()
564 		if (time_after(jiffies, f54->timeout)) {  in rmi_f54_work()
589 				       f54->report_data + i, size);  in rmi_f54_work()
598 	f54->report_size = error ? 0 : report_size;  in rmi_f54_work()
604 		queue_delayed_work(f54->workqueue, &f54->work,  in rmi_f54_work()
607 		f54->is_busy = false;  in rmi_f54_work()
608 		complete(&f54->cmd_done);  in rmi_f54_work()
611 	mutex_unlock(&f54->data_mutex);  in rmi_f54_work()
626 	struct f54_data *f54;  in rmi_f54_detect()  local
629 	f54 = dev_get_drvdata(&fn->dev);  in rmi_f54_detect()
639 	f54->num_rx_electrodes = buf[0];  in rmi_f54_detect()
640 	f54->num_tx_electrodes = buf[1];  in rmi_f54_detect()
641 	f54->capabilities = buf[2];  in rmi_f54_detect()
642 	f54->clock_rate = buf[3] | (buf[4] << 8);  in rmi_f54_detect()
643 	f54->family = buf[5];  in rmi_f54_detect()
646 		f54->num_rx_electrodes);  in rmi_f54_detect()
648 		f54->num_tx_electrodes);  in rmi_f54_detect()
650 		f54->capabilities);  in rmi_f54_detect()
652 		f54->clock_rate);  in rmi_f54_detect()
654 		f54->family);  in rmi_f54_detect()
656 	f54->is_busy = false;  in rmi_f54_detect()
663 	struct f54_data *f54;  in rmi_f54_probe()  local
667 	f54 = devm_kzalloc(&fn->dev, sizeof(struct f54_data), GFP_KERNEL);  in rmi_f54_probe()
668 	if (!f54)  in rmi_f54_probe()
671 	f54->fn = fn;  in rmi_f54_probe()
672 	dev_set_drvdata(&fn->dev, f54);  in rmi_f54_probe()
678 	mutex_init(&f54->data_mutex);  in rmi_f54_probe()
679 	mutex_init(&f54->status_mutex);  in rmi_f54_probe()
681 	rx = f54->num_rx_electrodes;  in rmi_f54_probe()
682 	tx = f54->num_tx_electrodes;  in rmi_f54_probe()
683 	f54->report_data = devm_kzalloc(&fn->dev,  in rmi_f54_probe()
686 	if (f54->report_data == NULL)  in rmi_f54_probe()
689 	INIT_DELAYED_WORK(&f54->work, rmi_f54_work);  in rmi_f54_probe()
691 	f54->workqueue = create_singlethread_workqueue("rmi4-poller");  in rmi_f54_probe()
692 	if (!f54->workqueue)  in rmi_f54_probe()
695 	rmi_f54_create_input_map(f54);  in rmi_f54_probe()
696 	rmi_f54_set_input(f54, 0);  in rmi_f54_probe()
699 	strscpy(f54->v4l2.name, F54_NAME, sizeof(f54->v4l2.name));  in rmi_f54_probe()
700 	ret = v4l2_device_register(&fn->dev, &f54->v4l2);  in rmi_f54_probe()
707 	mutex_init(&f54->lock);  in rmi_f54_probe()
708 	f54->queue = rmi_f54_queue;  in rmi_f54_probe()
709 	f54->queue.drv_priv = f54;  in rmi_f54_probe()
710 	f54->queue.lock = &f54->lock;  in rmi_f54_probe()
711 	f54->queue.dev = &fn->dev;  in rmi_f54_probe()
713 	ret = vb2_queue_init(&f54->queue);  in rmi_f54_probe()
717 	f54->vdev = rmi_f54_video_device;  in rmi_f54_probe()
718 	f54->vdev.v4l2_dev = &f54->v4l2;  in rmi_f54_probe()
719 	f54->vdev.lock = &f54->lock;  in rmi_f54_probe()
720 	f54->vdev.vfl_dir = VFL_DIR_RX;  in rmi_f54_probe()
721 	f54->vdev.queue = &f54->queue;  in rmi_f54_probe()
722 	video_set_drvdata(&f54->vdev, f54);  in rmi_f54_probe()
724 	ret = video_register_device(&f54->vdev, VFL_TYPE_TOUCH, -1);  in rmi_f54_probe()
733 	v4l2_device_unregister(&f54->v4l2);  in rmi_f54_probe()
735 	cancel_delayed_work_sync(&f54->work);  in rmi_f54_probe()
736 	destroy_workqueue(f54->workqueue);  in rmi_f54_probe()
742 	struct f54_data *f54 = dev_get_drvdata(&fn->dev);  in rmi_f54_remove()  local
744 	video_unregister_device(&f54->vdev);  in rmi_f54_remove()
745 	v4l2_device_unregister(&f54->v4l2);  in rmi_f54_remove()
746 	destroy_workqueue(f54->workqueue);  in rmi_f54_remove()