Lines Matching refs:f54
128 static bool is_f54_report_type_valid(struct f54_data *f54, in is_f54_report_type_valid() argument
133 return f54->capabilities & F54_CAP_IMAGE8; in is_f54_report_type_valid()
136 return f54->capabilities & F54_CAP_IMAGE16; in is_f54_report_type_valid()
138 return f54->capabilities & F54_CAP_IMAGE16; in is_f54_report_type_valid()
147 static enum rmi_f54_report_type rmi_f54_get_reptype(struct f54_data *f54, in rmi_f54_get_reptype() argument
153 return f54->inputs[i]; in rmi_f54_get_reptype()
156 static void rmi_f54_create_input_map(struct f54_data *f54) in rmi_f54_create_input_map() argument
162 if (!is_f54_report_type_valid(f54, reptype)) in rmi_f54_create_input_map()
165 f54->inputs[i++] = reptype; in rmi_f54_create_input_map()
173 struct f54_data *f54 = dev_get_drvdata(&fn->dev); in rmi_f54_request_report() local
178 if (f54->report_type != report_type) { in rmi_f54_request_report()
179 error = rmi_write(rmi_dev, f54->fn->fd.data_base_addr, in rmi_f54_request_report()
183 f54->report_type = report_type; in rmi_f54_request_report()
193 mutex_lock(&f54->data_mutex); in rmi_f54_request_report()
199 init_completion(&f54->cmd_done); in rmi_f54_request_report()
201 f54->is_busy = 1; in rmi_f54_request_report()
202 f54->timeout = jiffies + msecs_to_jiffies(100); in rmi_f54_request_report()
204 queue_delayed_work(f54->workqueue, &f54->work, 0); in rmi_f54_request_report()
207 mutex_unlock(&f54->data_mutex); in rmi_f54_request_report()
212 static size_t rmi_f54_get_report_size(struct f54_data *f54) in rmi_f54_get_report_size() argument
214 struct rmi_device *rmi_dev = f54->fn->rmi_dev; in rmi_f54_get_report_size()
216 u8 rx = drv_data->num_rx_electrodes ? : f54->num_rx_electrodes; in rmi_f54_get_report_size()
217 u8 tx = drv_data->num_tx_electrodes ? : f54->num_tx_electrodes; in rmi_f54_get_report_size()
220 switch (rmi_f54_get_reptype(f54, f54->input)) { in rmi_f54_get_report_size()
281 struct f54_data *f54 = q->drv_priv; in rmi_f54_queue_setup() local
284 return sizes[0] < rmi_f54_get_report_size(f54) ? -EINVAL : 0; in rmi_f54_queue_setup()
287 sizes[0] = rmi_f54_get_report_size(f54); in rmi_f54_queue_setup()
295 struct f54_data *f54 = vb2_get_drv_priv(vb->vb2_queue); in rmi_f54_buffer_queue() local
301 mutex_lock(&f54->status_mutex); in rmi_f54_buffer_queue()
304 reptype = rmi_f54_get_reptype(f54, f54->input); in rmi_f54_buffer_queue()
310 if (f54->is_busy) { in rmi_f54_buffer_queue()
315 ret = rmi_f54_request_report(f54->fn, reptype); in rmi_f54_buffer_queue()
317 dev_err(&f54->fn->dev, "Error requesting F54 report\n"); in rmi_f54_buffer_queue()
323 mutex_lock(&f54->data_mutex); in rmi_f54_buffer_queue()
325 while (f54->is_busy) { in rmi_f54_buffer_queue()
326 mutex_unlock(&f54->data_mutex); in rmi_f54_buffer_queue()
327 if (!wait_for_completion_timeout(&f54->cmd_done, in rmi_f54_buffer_queue()
329 dev_err(&f54->fn->dev, "Timed out\n"); in rmi_f54_buffer_queue()
333 mutex_lock(&f54->data_mutex); in rmi_f54_buffer_queue()
338 dev_err(&f54->fn->dev, "Error acquiring frame ptr\n"); in rmi_f54_buffer_queue()
343 memcpy(ptr, f54->report_data, f54->report_size); in rmi_f54_buffer_queue()
344 vb2_set_plane_payload(vb, 0, rmi_f54_get_report_size(f54)); in rmi_f54_buffer_queue()
348 mutex_unlock(&f54->data_mutex); in rmi_f54_buffer_queue()
352 vbuf->sequence = f54->sequence++; in rmi_f54_buffer_queue()
354 mutex_unlock(&f54->status_mutex); in rmi_f54_buffer_queue()
359 struct f54_data *f54 = vb2_get_drv_priv(q); in rmi_f54_stop_streaming() local
361 f54->sequence = 0; in rmi_f54_stop_streaming()
385 struct f54_data *f54 = video_drvdata(file); in rmi_f54_vidioc_querycap() local
390 "rmi4:%s", dev_name(&f54->fn->dev)); in rmi_f54_vidioc_querycap()
398 struct f54_data *f54 = video_drvdata(file); in rmi_f54_vidioc_enum_input() local
401 reptype = rmi_f54_get_reptype(f54, i->index); in rmi_f54_vidioc_enum_input()
411 static int rmi_f54_set_input(struct f54_data *f54, unsigned int i) in rmi_f54_set_input() argument
413 struct rmi_device *rmi_dev = f54->fn->rmi_dev; in rmi_f54_set_input()
415 u8 rx = drv_data->num_rx_electrodes ? : f54->num_rx_electrodes; in rmi_f54_set_input()
416 u8 tx = drv_data->num_tx_electrodes ? : f54->num_tx_electrodes; in rmi_f54_set_input()
417 struct v4l2_pix_format *f = &f54->format; in rmi_f54_set_input()
421 reptype = rmi_f54_get_reptype(f54, i); in rmi_f54_set_input()
429 f54->input = i; in rmi_f54_set_input()
449 struct f54_data *f54 = video_drvdata(file); in rmi_f54_vidioc_g_input() local
451 *i = f54->input; in rmi_f54_vidioc_g_input()
459 struct f54_data *f54 = video_drvdata(file); in rmi_f54_vidioc_fmt() local
461 f->fmt.pix = f54->format; in rmi_f54_vidioc_fmt()
469 struct f54_data *f54 = video_drvdata(file); in rmi_f54_vidioc_enum_fmt() local
477 fmt->pixelformat = f54->format.pixelformat; in rmi_f54_vidioc_enum_fmt()
529 struct f54_data *f54 = container_of(work, struct f54_data, work.work); in rmi_f54_work() local
530 struct rmi_function *fn = f54->fn; in rmi_f54_work()
537 report_size = rmi_f54_get_report_size(f54); in rmi_f54_work()
540 f54->report_type); in rmi_f54_work()
545 mutex_lock(&f54->data_mutex); in rmi_f54_work()
551 error = rmi_read(fn->rmi_dev, f54->fn->fd.command_base_addr, in rmi_f54_work()
558 if (time_after(jiffies, f54->timeout)) { in rmi_f54_work()
583 f54->report_data + i, size); in rmi_f54_work()
592 f54->report_size = error ? 0 : report_size; in rmi_f54_work()
598 queue_delayed_work(f54->workqueue, &f54->work, in rmi_f54_work()
601 f54->is_busy = false; in rmi_f54_work()
602 complete(&f54->cmd_done); in rmi_f54_work()
605 mutex_unlock(&f54->data_mutex); in rmi_f54_work()
620 struct f54_data *f54; in rmi_f54_detect() local
623 f54 = dev_get_drvdata(&fn->dev); in rmi_f54_detect()
633 f54->num_rx_electrodes = buf[0]; in rmi_f54_detect()
634 f54->num_tx_electrodes = buf[1]; in rmi_f54_detect()
635 f54->capabilities = buf[2]; in rmi_f54_detect()
636 f54->clock_rate = buf[3] | (buf[4] << 8); in rmi_f54_detect()
637 f54->family = buf[5]; in rmi_f54_detect()
640 f54->num_rx_electrodes); in rmi_f54_detect()
642 f54->num_tx_electrodes); in rmi_f54_detect()
644 f54->capabilities); in rmi_f54_detect()
646 f54->clock_rate); in rmi_f54_detect()
648 f54->family); in rmi_f54_detect()
650 f54->is_busy = false; in rmi_f54_detect()
657 struct f54_data *f54; in rmi_f54_probe() local
661 f54 = devm_kzalloc(&fn->dev, sizeof(struct f54_data), GFP_KERNEL); in rmi_f54_probe()
662 if (!f54) in rmi_f54_probe()
665 f54->fn = fn; in rmi_f54_probe()
666 dev_set_drvdata(&fn->dev, f54); in rmi_f54_probe()
672 mutex_init(&f54->data_mutex); in rmi_f54_probe()
673 mutex_init(&f54->status_mutex); in rmi_f54_probe()
675 rx = f54->num_rx_electrodes; in rmi_f54_probe()
676 tx = f54->num_tx_electrodes; in rmi_f54_probe()
677 f54->report_data = devm_kzalloc(&fn->dev, in rmi_f54_probe()
680 if (f54->report_data == NULL) in rmi_f54_probe()
683 INIT_DELAYED_WORK(&f54->work, rmi_f54_work); in rmi_f54_probe()
685 f54->workqueue = create_singlethread_workqueue("rmi4-poller"); in rmi_f54_probe()
686 if (!f54->workqueue) in rmi_f54_probe()
689 rmi_f54_create_input_map(f54); in rmi_f54_probe()
690 rmi_f54_set_input(f54, 0); in rmi_f54_probe()
693 strlcpy(f54->v4l2.name, F54_NAME, sizeof(f54->v4l2.name)); in rmi_f54_probe()
694 ret = v4l2_device_register(&fn->dev, &f54->v4l2); in rmi_f54_probe()
701 mutex_init(&f54->lock); in rmi_f54_probe()
702 f54->queue = rmi_f54_queue; in rmi_f54_probe()
703 f54->queue.drv_priv = f54; in rmi_f54_probe()
704 f54->queue.lock = &f54->lock; in rmi_f54_probe()
705 f54->queue.dev = &fn->dev; in rmi_f54_probe()
707 ret = vb2_queue_init(&f54->queue); in rmi_f54_probe()
711 f54->vdev = rmi_f54_video_device; in rmi_f54_probe()
712 f54->vdev.v4l2_dev = &f54->v4l2; in rmi_f54_probe()
713 f54->vdev.lock = &f54->lock; in rmi_f54_probe()
714 f54->vdev.vfl_dir = VFL_DIR_RX; in rmi_f54_probe()
715 f54->vdev.queue = &f54->queue; in rmi_f54_probe()
716 video_set_drvdata(&f54->vdev, f54); in rmi_f54_probe()
718 ret = video_register_device(&f54->vdev, VFL_TYPE_TOUCH, -1); in rmi_f54_probe()
727 v4l2_device_unregister(&f54->v4l2); in rmi_f54_probe()
729 cancel_delayed_work_sync(&f54->work); in rmi_f54_probe()
730 flush_workqueue(f54->workqueue); in rmi_f54_probe()
731 destroy_workqueue(f54->workqueue); in rmi_f54_probe()
737 struct f54_data *f54 = dev_get_drvdata(&fn->dev); in rmi_f54_remove() local
739 video_unregister_device(&f54->vdev); in rmi_f54_remove()
740 v4l2_device_unregister(&f54->v4l2); in rmi_f54_remove()
741 destroy_workqueue(f54->workqueue); in rmi_f54_remove()