1 // SPDX-License-Identifier: GPL-2.0
3 * Copyright (C) 2017 - 2018 Intel Corporation
4 * Copyright 2017 Google LLC
6 * Based on Intel IPU4 driver.
10 #include <linux/delay.h>
11 #include <linux/interrupt.h>
12 #include <linux/module.h>
13 #include <linux/pm_runtime.h>
16 #include "ipu3-dmamap.h"
19 #define IMGU_PCI_ID 0x1919
20 #define IMGU_PCI_BAR 0
21 #define IMGU_DMA_MASK DMA_BIT_MASK(39)
22 #define IMGU_MAX_QUEUE_DEPTH (2 + 2)
25 * pre-allocated buffer size for IMGU dummy buffers. Those
26 * values should be tuned to big enough to avoid buffer
27 * re-allocation when streaming to lower streaming latency.
29 #define CSS_QUEUE_IN_BUF_SIZE 0
30 #define CSS_QUEUE_PARAMS_BUF_SIZE 0
31 #define CSS_QUEUE_OUT_BUF_SIZE (4160 * 3120 * 12 / 8)
32 #define CSS_QUEUE_VF_BUF_SIZE (1920 * 1080 * 12 / 8)
33 #define CSS_QUEUE_STAT_3A_BUF_SIZE sizeof(struct ipu3_uapi_stats_3a)
35 static const size_t css_queue_buf_size_map[IPU3_CSS_QUEUES] = {
36 [IPU3_CSS_QUEUE_IN] = CSS_QUEUE_IN_BUF_SIZE,
37 [IPU3_CSS_QUEUE_PARAMS] = CSS_QUEUE_PARAMS_BUF_SIZE,
38 [IPU3_CSS_QUEUE_OUT] = CSS_QUEUE_OUT_BUF_SIZE,
39 [IPU3_CSS_QUEUE_VF] = CSS_QUEUE_VF_BUF_SIZE,
40 [IPU3_CSS_QUEUE_STAT_3A] = CSS_QUEUE_STAT_3A_BUF_SIZE,
43 static const struct imgu_node_mapping imgu_node_map[IMGU_NODE_NUM] = {
44 [IMGU_NODE_IN] = {IPU3_CSS_QUEUE_IN, "input"},
45 [IMGU_NODE_PARAMS] = {IPU3_CSS_QUEUE_PARAMS, "parameters"},
46 [IMGU_NODE_OUT] = {IPU3_CSS_QUEUE_OUT, "output"},
47 [IMGU_NODE_VF] = {IPU3_CSS_QUEUE_VF, "viewfinder"},
48 [IMGU_NODE_STAT_3A] = {IPU3_CSS_QUEUE_STAT_3A, "3a stat"},
51 unsigned int imgu_node_to_queue(unsigned int node)
53 return imgu_node_map[node].css_queue;
56 unsigned int imgu_map_node(struct imgu_device *imgu, unsigned int css_queue)
60 for (i = 0; i < IMGU_NODE_NUM; i++)
61 if (imgu_node_map[i].css_queue == css_queue)
67 /**************** Dummy buffers ****************/
69 static void imgu_dummybufs_cleanup(struct imgu_device *imgu, unsigned int pipe)
72 struct imgu_media_pipe *imgu_pipe = &imgu->imgu_pipe[pipe];
74 for (i = 0; i < IPU3_CSS_QUEUES; i++)
75 imgu_dmamap_free(imgu,
76 &imgu_pipe->queues[i].dmap);
79 static int imgu_dummybufs_preallocate(struct imgu_device *imgu,
84 struct imgu_media_pipe *imgu_pipe = &imgu->imgu_pipe[pipe];
86 for (i = 0; i < IPU3_CSS_QUEUES; i++) {
87 size = css_queue_buf_size_map[i];
89 * Do not enable dummy buffers for master queue,
90 * always require that real buffers from user are
93 if (i == IMGU_QUEUE_MASTER || size == 0)
96 if (!imgu_dmamap_alloc(imgu,
97 &imgu_pipe->queues[i].dmap, size)) {
98 imgu_dummybufs_cleanup(imgu, pipe);
106 static int imgu_dummybufs_init(struct imgu_device *imgu, unsigned int pipe)
108 const struct v4l2_pix_format_mplane *mpix;
109 const struct v4l2_meta_format *meta;
110 unsigned int i, k, node;
112 struct imgu_media_pipe *imgu_pipe = &imgu->imgu_pipe[pipe];
114 /* Allocate a dummy buffer for each queue where buffer is optional */
115 for (i = 0; i < IPU3_CSS_QUEUES; i++) {
116 node = imgu_map_node(imgu, i);
117 if (!imgu_pipe->queue_enabled[node] || i == IMGU_QUEUE_MASTER)
120 if (!imgu_pipe->nodes[IMGU_NODE_VF].enabled &&
121 i == IPU3_CSS_QUEUE_VF)
123 * Do not enable dummy buffers for VF if it is not
124 * requested by the user.
128 meta = &imgu_pipe->nodes[node].vdev_fmt.fmt.meta;
129 mpix = &imgu_pipe->nodes[node].vdev_fmt.fmt.pix_mp;
131 if (node == IMGU_NODE_STAT_3A || node == IMGU_NODE_PARAMS)
132 size = meta->buffersize;
134 size = mpix->plane_fmt[0].sizeimage;
136 if (imgu_css_dma_buffer_resize(imgu,
137 &imgu_pipe->queues[i].dmap,
139 imgu_dummybufs_cleanup(imgu, pipe);
143 for (k = 0; k < IMGU_MAX_QUEUE_DEPTH; k++)
144 imgu_css_buf_init(&imgu_pipe->queues[i].dummybufs[k], i,
145 imgu_pipe->queues[i].dmap.daddr);
151 /* May be called from atomic context */
152 static struct imgu_css_buffer *imgu_dummybufs_get(struct imgu_device *imgu,
153 int queue, unsigned int pipe)
156 struct imgu_media_pipe *imgu_pipe = &imgu->imgu_pipe[pipe];
158 /* dummybufs are not allocated for master q */
159 if (queue == IPU3_CSS_QUEUE_IN)
162 if (WARN_ON(!imgu_pipe->queues[queue].dmap.vaddr))
163 /* Buffer should not be allocated here */
166 for (i = 0; i < IMGU_MAX_QUEUE_DEPTH; i++)
167 if (imgu_css_buf_state(&imgu_pipe->queues[queue].dummybufs[i]) !=
168 IPU3_CSS_BUFFER_QUEUED)
171 if (i == IMGU_MAX_QUEUE_DEPTH)
174 imgu_css_buf_init(&imgu_pipe->queues[queue].dummybufs[i], queue,
175 imgu_pipe->queues[queue].dmap.daddr);
177 return &imgu_pipe->queues[queue].dummybufs[i];
180 /* Check if given buffer is a dummy buffer */
181 static bool imgu_dummybufs_check(struct imgu_device *imgu,
182 struct imgu_css_buffer *buf,
186 struct imgu_media_pipe *imgu_pipe = &imgu->imgu_pipe[pipe];
188 for (i = 0; i < IMGU_MAX_QUEUE_DEPTH; i++)
189 if (buf == &imgu_pipe->queues[buf->queue].dummybufs[i])
192 return i < IMGU_MAX_QUEUE_DEPTH;
195 static void imgu_buffer_done(struct imgu_device *imgu, struct vb2_buffer *vb,
196 enum vb2_buffer_state state)
198 mutex_lock(&imgu->lock);
199 imgu_v4l2_buffer_done(vb, state);
200 mutex_unlock(&imgu->lock);
203 static struct imgu_css_buffer *imgu_queue_getbuf(struct imgu_device *imgu,
207 struct imgu_buffer *buf;
208 struct imgu_media_pipe *imgu_pipe = &imgu->imgu_pipe[pipe];
210 if (WARN_ON(node >= IMGU_NODE_NUM))
213 /* Find first free buffer from the node */
214 list_for_each_entry(buf, &imgu_pipe->nodes[node].buffers, vid_buf.list) {
215 if (imgu_css_buf_state(&buf->css_buf) == IPU3_CSS_BUFFER_NEW)
216 return &buf->css_buf;
219 /* There were no free buffers, try to return a dummy buffer */
220 return imgu_dummybufs_get(imgu, imgu_node_map[node].css_queue, pipe);
224 * Queue as many buffers to CSS as possible. If all buffers don't fit into
225 * CSS buffer queues, they remain unqueued and will be queued later.
227 int imgu_queue_buffers(struct imgu_device *imgu, bool initial, unsigned int pipe)
231 struct imgu_media_pipe *imgu_pipe = &imgu->imgu_pipe[pipe];
233 if (!imgu_css_is_streaming(&imgu->css))
236 dev_dbg(&imgu->pci_dev->dev, "Queue buffers to pipe %d", pipe);
237 mutex_lock(&imgu->lock);
239 if (!imgu_css_pipe_queue_empty(&imgu->css, pipe)) {
240 mutex_unlock(&imgu->lock);
244 /* Buffer set is queued to FW only when input buffer is ready */
245 for (node = IMGU_NODE_NUM - 1;
246 imgu_queue_getbuf(imgu, IMGU_NODE_IN, pipe);
247 node = node ? node - 1 : IMGU_NODE_NUM - 1) {
248 if (node == IMGU_NODE_VF &&
249 !imgu_pipe->nodes[IMGU_NODE_VF].enabled) {
250 dev_warn(&imgu->pci_dev->dev,
251 "Vf not enabled, ignore queue");
253 } else if (node == IMGU_NODE_PARAMS &&
254 imgu_pipe->nodes[node].enabled) {
255 struct vb2_buffer *vb;
256 struct imgu_vb2_buffer *ivb;
258 /* No parameters for this frame */
259 if (list_empty(&imgu_pipe->nodes[node].buffers))
262 ivb = list_first_entry(&imgu_pipe->nodes[node].buffers,
263 struct imgu_vb2_buffer, list);
264 vb = &ivb->vbb.vb2_buf;
265 r = imgu_css_set_parameters(&imgu->css, pipe,
266 vb2_plane_vaddr(vb, 0));
268 vb2_buffer_done(vb, VB2_BUF_STATE_ERROR);
269 dev_warn(&imgu->pci_dev->dev,
270 "set parameters failed.");
274 vb2_buffer_done(vb, VB2_BUF_STATE_DONE);
275 dev_dbg(&imgu->pci_dev->dev,
276 "queue user parameters %d to css.", vb->index);
277 list_del(&ivb->list);
278 } else if (imgu_pipe->queue_enabled[node]) {
279 struct imgu_css_buffer *buf =
280 imgu_queue_getbuf(imgu, node, pipe);
281 struct imgu_buffer *ibuf = NULL;
287 r = imgu_css_buf_queue(&imgu->css, pipe, buf);
290 dummy = imgu_dummybufs_check(imgu, buf, pipe);
292 ibuf = container_of(buf, struct imgu_buffer,
294 dev_dbg(&imgu->pci_dev->dev,
295 "queue %s %s buffer %u to css da: 0x%08x\n",
296 dummy ? "dummy" : "user",
297 imgu_node_map[node].name,
298 dummy ? 0 : ibuf->vid_buf.vbb.vb2_buf.index,
302 mutex_unlock(&imgu->lock);
304 if (r && r != -EBUSY)
311 * On error, mark all buffers as failed which are not
314 dev_err(&imgu->pci_dev->dev,
315 "failed to queue buffer to CSS on queue %i (%d)\n",
319 /* If we were called from streamon(), no need to finish bufs */
322 for (node = 0; node < IMGU_NODE_NUM; node++) {
323 struct imgu_buffer *buf, *buf0;
325 if (!imgu_pipe->queue_enabled[node])
326 continue; /* Skip disabled queues */
328 mutex_lock(&imgu->lock);
329 list_for_each_entry_safe(buf, buf0,
330 &imgu_pipe->nodes[node].buffers,
332 if (imgu_css_buf_state(&buf->css_buf) ==
333 IPU3_CSS_BUFFER_QUEUED)
334 continue; /* Was already queued, skip */
336 imgu_v4l2_buffer_done(&buf->vid_buf.vbb.vb2_buf,
337 VB2_BUF_STATE_ERROR);
339 mutex_unlock(&imgu->lock);
345 static int imgu_powerup(struct imgu_device *imgu)
349 r = imgu_css_set_powerup(&imgu->pci_dev->dev, imgu->base);
353 imgu_mmu_resume(imgu->mmu);
357 static void imgu_powerdown(struct imgu_device *imgu)
359 imgu_mmu_suspend(imgu->mmu);
360 imgu_css_set_powerdown(&imgu->pci_dev->dev, imgu->base);
363 int imgu_s_stream(struct imgu_device *imgu, int enable)
365 struct device *dev = &imgu->pci_dev->dev;
370 dev_dbg(dev, "stream off\n");
371 /* Block new buffers to be queued to CSS. */
372 atomic_set(&imgu->qbuf_barrier, 1);
373 imgu_css_stop_streaming(&imgu->css);
374 synchronize_irq(imgu->pci_dev->irq);
375 atomic_set(&imgu->qbuf_barrier, 0);
376 imgu_powerdown(imgu);
377 pm_runtime_put(&imgu->pci_dev->dev);
383 r = pm_runtime_get_sync(dev);
385 dev_err(dev, "failed to set imgu power\n");
390 r = imgu_powerup(imgu);
392 dev_err(dev, "failed to power up imgu\n");
397 /* Start CSS streaming */
398 r = imgu_css_start_streaming(&imgu->css);
400 dev_err(dev, "failed to start css streaming (%d)", r);
401 goto fail_start_streaming;
404 for_each_set_bit(pipe, imgu->css.enabled_pipes, IMGU_MAX_PIPE_NUM) {
405 /* Initialize dummy buffers */
406 r = imgu_dummybufs_init(imgu, pipe);
408 dev_err(dev, "failed to initialize dummy buffers (%d)", r);
412 /* Queue as many buffers from queue as possible */
413 r = imgu_queue_buffers(imgu, true, pipe);
415 dev_err(dev, "failed to queue initial buffers (%d)", r);
422 for_each_set_bit(pipe, imgu->css.enabled_pipes, IMGU_MAX_PIPE_NUM)
423 imgu_dummybufs_cleanup(imgu, pipe);
425 imgu_css_stop_streaming(&imgu->css);
426 fail_start_streaming:
432 static int imgu_video_nodes_init(struct imgu_device *imgu)
434 struct v4l2_pix_format_mplane *fmts[IPU3_CSS_QUEUES] = { NULL };
435 struct v4l2_rect *rects[IPU3_CSS_RECTS] = { NULL };
436 struct imgu_media_pipe *imgu_pipe;
440 imgu->buf_struct_size = sizeof(struct imgu_buffer);
442 for (j = 0; j < IMGU_MAX_PIPE_NUM; j++) {
443 imgu_pipe = &imgu->imgu_pipe[j];
445 for (i = 0; i < IMGU_NODE_NUM; i++) {
446 imgu_pipe->nodes[i].name = imgu_node_map[i].name;
447 imgu_pipe->nodes[i].output = i < IMGU_QUEUE_FIRST_INPUT;
448 imgu_pipe->nodes[i].enabled = false;
450 if (i != IMGU_NODE_PARAMS && i != IMGU_NODE_STAT_3A)
451 fmts[imgu_node_map[i].css_queue] =
452 &imgu_pipe->nodes[i].vdev_fmt.fmt.pix_mp;
453 atomic_set(&imgu_pipe->nodes[i].sequence, 0);
457 r = imgu_v4l2_register(imgu);
461 /* Set initial formats and initialize formats of video nodes */
462 for (j = 0; j < IMGU_MAX_PIPE_NUM; j++) {
463 imgu_pipe = &imgu->imgu_pipe[j];
465 rects[IPU3_CSS_RECT_EFFECTIVE] = &imgu_pipe->imgu_sd.rect.eff;
466 rects[IPU3_CSS_RECT_BDS] = &imgu_pipe->imgu_sd.rect.bds;
467 imgu_css_fmt_set(&imgu->css, fmts, rects, j);
469 /* Pre-allocate dummy buffers */
470 r = imgu_dummybufs_preallocate(imgu, j);
472 dev_err(&imgu->pci_dev->dev,
473 "failed to pre-allocate dummy buffers (%d)", r);
481 for (j = 0; j < IMGU_MAX_PIPE_NUM; j++)
482 imgu_dummybufs_cleanup(imgu, j);
484 imgu_v4l2_unregister(imgu);
489 static void imgu_video_nodes_exit(struct imgu_device *imgu)
493 for (i = 0; i < IMGU_MAX_PIPE_NUM; i++)
494 imgu_dummybufs_cleanup(imgu, i);
496 imgu_v4l2_unregister(imgu);
499 /**************** PCI interface ****************/
501 static irqreturn_t imgu_isr_threaded(int irq, void *imgu_ptr)
503 struct imgu_device *imgu = imgu_ptr;
504 struct imgu_media_pipe *imgu_pipe;
507 /* Dequeue / queue buffers */
509 u64 ns = ktime_get_ns();
510 struct imgu_css_buffer *b;
511 struct imgu_buffer *buf = NULL;
512 unsigned int node, pipe;
516 mutex_lock(&imgu->lock);
517 b = imgu_css_buf_dequeue(&imgu->css);
518 mutex_unlock(&imgu->lock);
519 } while (PTR_ERR(b) == -EAGAIN);
522 if (PTR_ERR(b) != -EBUSY) /* All done */
523 dev_err(&imgu->pci_dev->dev,
524 "failed to dequeue buffers (%ld)\n",
529 node = imgu_map_node(imgu, b->queue);
531 dummy = imgu_dummybufs_check(imgu, b, pipe);
533 buf = container_of(b, struct imgu_buffer, css_buf);
534 dev_dbg(&imgu->pci_dev->dev,
535 "dequeue %s %s buffer %d daddr 0x%x from css\n",
536 dummy ? "dummy" : "user",
537 imgu_node_map[node].name,
538 dummy ? 0 : buf->vid_buf.vbb.vb2_buf.index,
542 /* It was a dummy buffer, skip it */
545 /* Fill vb2 buffer entries and tell it's ready */
546 imgu_pipe = &imgu->imgu_pipe[pipe];
547 if (!imgu_pipe->nodes[node].output) {
548 buf->vid_buf.vbb.vb2_buf.timestamp = ns;
549 buf->vid_buf.vbb.field = V4L2_FIELD_NONE;
550 buf->vid_buf.vbb.sequence =
552 &imgu_pipe->nodes[node].sequence);
553 dev_dbg(&imgu->pci_dev->dev, "vb2 buffer sequence %d",
554 buf->vid_buf.vbb.sequence);
556 imgu_buffer_done(imgu, &buf->vid_buf.vbb.vb2_buf,
557 imgu_css_buf_state(&buf->css_buf) ==
558 IPU3_CSS_BUFFER_DONE ?
560 VB2_BUF_STATE_ERROR);
561 mutex_lock(&imgu->lock);
562 if (imgu_css_queue_empty(&imgu->css))
563 wake_up_all(&imgu->buf_drain_wq);
564 mutex_unlock(&imgu->lock);
568 * Try to queue more buffers for CSS.
569 * qbuf_barrier is used to disable new buffers
570 * to be queued to CSS.
572 if (!atomic_read(&imgu->qbuf_barrier))
573 for_each_set_bit(p, imgu->css.enabled_pipes, IMGU_MAX_PIPE_NUM)
574 imgu_queue_buffers(imgu, false, p);
579 static irqreturn_t imgu_isr(int irq, void *imgu_ptr)
581 struct imgu_device *imgu = imgu_ptr;
583 /* acknowledge interruption */
584 if (imgu_css_irq_ack(&imgu->css) < 0)
587 return IRQ_WAKE_THREAD;
590 static int imgu_pci_config_setup(struct pci_dev *dev)
593 int r = pci_enable_msi(dev);
596 dev_err(&dev->dev, "failed to enable MSI (%d)\n", r);
600 pci_read_config_word(dev, PCI_COMMAND, &pci_command);
601 pci_command |= PCI_COMMAND_MEMORY | PCI_COMMAND_MASTER |
602 PCI_COMMAND_INTX_DISABLE;
603 pci_write_config_word(dev, PCI_COMMAND, pci_command);
608 static int imgu_pci_probe(struct pci_dev *pci_dev,
609 const struct pci_device_id *id)
611 struct imgu_device *imgu;
613 unsigned long phys_len;
614 void __iomem *const *iomap;
617 imgu = devm_kzalloc(&pci_dev->dev, sizeof(*imgu), GFP_KERNEL);
621 imgu->pci_dev = pci_dev;
623 r = pcim_enable_device(pci_dev);
625 dev_err(&pci_dev->dev, "failed to enable device (%d)\n", r);
629 dev_info(&pci_dev->dev, "device 0x%x (rev: 0x%x)\n",
630 pci_dev->device, pci_dev->revision);
632 phys = pci_resource_start(pci_dev, IMGU_PCI_BAR);
633 phys_len = pci_resource_len(pci_dev, IMGU_PCI_BAR);
635 r = pcim_iomap_regions(pci_dev, 1 << IMGU_PCI_BAR, pci_name(pci_dev));
637 dev_err(&pci_dev->dev, "failed to remap I/O memory (%d)\n", r);
640 dev_info(&pci_dev->dev, "physical base address %pap, %lu bytes\n",
643 iomap = pcim_iomap_table(pci_dev);
645 dev_err(&pci_dev->dev, "failed to iomap table\n");
649 imgu->base = iomap[IMGU_PCI_BAR];
651 pci_set_drvdata(pci_dev, imgu);
653 pci_set_master(pci_dev);
655 r = dma_coerce_mask_and_coherent(&pci_dev->dev, IMGU_DMA_MASK);
657 dev_err(&pci_dev->dev, "failed to set DMA mask (%d)\n", r);
661 r = imgu_pci_config_setup(pci_dev);
665 mutex_init(&imgu->lock);
666 atomic_set(&imgu->qbuf_barrier, 0);
667 init_waitqueue_head(&imgu->buf_drain_wq);
669 r = imgu_css_set_powerup(&pci_dev->dev, imgu->base);
671 dev_err(&pci_dev->dev,
672 "failed to power up CSS (%d)\n", r);
673 goto out_mutex_destroy;
676 imgu->mmu = imgu_mmu_init(&pci_dev->dev, imgu->base);
677 if (IS_ERR(imgu->mmu)) {
678 r = PTR_ERR(imgu->mmu);
679 dev_err(&pci_dev->dev, "failed to initialize MMU (%d)\n", r);
680 goto out_css_powerdown;
683 r = imgu_dmamap_init(imgu);
685 dev_err(&pci_dev->dev,
686 "failed to initialize DMA mapping (%d)\n", r);
690 /* ISP programming */
691 r = imgu_css_init(&pci_dev->dev, &imgu->css, imgu->base, phys_len);
693 dev_err(&pci_dev->dev, "failed to initialize CSS (%d)\n", r);
694 goto out_dmamap_exit;
697 /* v4l2 sub-device registration */
698 r = imgu_video_nodes_init(imgu);
700 dev_err(&pci_dev->dev, "failed to create V4L2 devices (%d)\n",
702 goto out_css_cleanup;
705 r = devm_request_threaded_irq(&pci_dev->dev, pci_dev->irq,
706 imgu_isr, imgu_isr_threaded,
707 IRQF_SHARED, IMGU_NAME, imgu);
709 dev_err(&pci_dev->dev, "failed to request IRQ (%d)\n", r);
713 pm_runtime_put_noidle(&pci_dev->dev);
714 pm_runtime_allow(&pci_dev->dev);
719 imgu_video_nodes_exit(imgu);
721 imgu_css_cleanup(&imgu->css);
723 imgu_dmamap_exit(imgu);
725 imgu_mmu_exit(imgu->mmu);
727 imgu_css_set_powerdown(&pci_dev->dev, imgu->base);
729 mutex_destroy(&imgu->lock);
734 static void imgu_pci_remove(struct pci_dev *pci_dev)
736 struct imgu_device *imgu = pci_get_drvdata(pci_dev);
738 pm_runtime_forbid(&pci_dev->dev);
739 pm_runtime_get_noresume(&pci_dev->dev);
741 imgu_video_nodes_exit(imgu);
742 imgu_css_cleanup(&imgu->css);
743 imgu_css_set_powerdown(&pci_dev->dev, imgu->base);
744 imgu_dmamap_exit(imgu);
745 imgu_mmu_exit(imgu->mmu);
746 mutex_destroy(&imgu->lock);
749 static int __maybe_unused imgu_suspend(struct device *dev)
751 struct pci_dev *pci_dev = to_pci_dev(dev);
752 struct imgu_device *imgu = pci_get_drvdata(pci_dev);
754 dev_dbg(dev, "enter %s\n", __func__);
755 imgu->suspend_in_stream = imgu_css_is_streaming(&imgu->css);
756 if (!imgu->suspend_in_stream)
758 /* Block new buffers to be queued to CSS. */
759 atomic_set(&imgu->qbuf_barrier, 1);
761 * Wait for currently running irq handler to be done so that
762 * no new buffers will be queued to fw later.
764 synchronize_irq(pci_dev->irq);
765 /* Wait until all buffers in CSS are done. */
766 if (!wait_event_timeout(imgu->buf_drain_wq,
767 imgu_css_queue_empty(&imgu->css), msecs_to_jiffies(1000)))
768 dev_err(dev, "wait buffer drain timeout.\n");
770 imgu_css_stop_streaming(&imgu->css);
771 atomic_set(&imgu->qbuf_barrier, 0);
772 imgu_powerdown(imgu);
773 pm_runtime_force_suspend(dev);
775 dev_dbg(dev, "leave %s\n", __func__);
779 static int __maybe_unused imgu_resume(struct device *dev)
781 struct pci_dev *pci_dev = to_pci_dev(dev);
782 struct imgu_device *imgu = pci_get_drvdata(pci_dev);
786 dev_dbg(dev, "enter %s\n", __func__);
788 if (!imgu->suspend_in_stream)
791 pm_runtime_force_resume(dev);
793 r = imgu_powerup(imgu);
795 dev_err(dev, "failed to power up imgu\n");
799 /* Start CSS streaming */
800 r = imgu_css_start_streaming(&imgu->css);
802 dev_err(dev, "failed to resume css streaming (%d)", r);
806 for_each_set_bit(pipe, imgu->css.enabled_pipes, IMGU_MAX_PIPE_NUM) {
807 r = imgu_queue_buffers(imgu, true, pipe);
809 dev_err(dev, "failed to queue buffers to pipe %d (%d)",
814 dev_dbg(dev, "leave %s\n", __func__);
820 * PCI rpm framework checks the existence of driver rpm callbacks.
821 * Place a dummy callback here to avoid rpm going into error state.
823 static __maybe_unused int imgu_rpm_dummy_cb(struct device *dev)
828 static const struct dev_pm_ops imgu_pm_ops = {
829 SET_RUNTIME_PM_OPS(&imgu_rpm_dummy_cb, &imgu_rpm_dummy_cb, NULL)
830 SET_SYSTEM_SLEEP_PM_OPS(&imgu_suspend, &imgu_resume)
833 static const struct pci_device_id imgu_pci_tbl[] = {
834 { PCI_DEVICE(PCI_VENDOR_ID_INTEL, IMGU_PCI_ID) },
838 MODULE_DEVICE_TABLE(pci, imgu_pci_tbl);
840 static struct pci_driver imgu_pci_driver = {
842 .id_table = imgu_pci_tbl,
843 .probe = imgu_pci_probe,
844 .remove = imgu_pci_remove,
850 module_pci_driver(imgu_pci_driver);
852 MODULE_AUTHOR("Tuukka Toivonen <tuukka.toivonen@intel.com>");
853 MODULE_AUTHOR("Tianshu Qiu <tian.shu.qiu@intel.com>");
854 MODULE_AUTHOR("Jian Xu Zheng <jian.xu.zheng@intel.com>");
855 MODULE_AUTHOR("Yuning Pu <yuning.pu@intel.com>");
856 MODULE_AUTHOR("Yong Zhi <yong.zhi@intel.com>");
857 MODULE_LICENSE("GPL v2");
858 MODULE_DESCRIPTION("Intel ipu3_imgu PCI driver");