v4l2-m2m: support userptr mode

Add userptr buffer mode support for v4l2-m2m.

Signed-off-by: niyinghao <[email protected]>

Author: nyh163925

drivers/video/v4l2_m2m.c

@@ -351,6 +351,7 @@ static int codec_querybuf(FAR struct file *filep,
   FAR codec_mng_t *cmng = inode->i_private;
   FAR codec_file_t *cfile = filep->f_priv;
   FAR codec_type_inf_t *type_inf;
+  FAR vbuf_container_t *container;
   struct v4l2_format format;
   uint32_t offset = 0;
   size_t bufsize;
@@ -390,6 +391,8 @@ static int codec_querybuf(FAR struct file *filep,
       return -EINVAL;
     }
 
+  container = video_framebuff_find_container(&type_inf->bufinf, buf->index);
+
   if (V4L2_TYPE_IS_MULTIPLANAR(buf->type))
     {
       for (i = 0; i < format.fmt.pix_mp.num_planes; i++)
@@ -404,6 +407,11 @@ static int codec_querybuf(FAR struct file *filep,
                 offset += buf->m.planes[i].length;
                 break;
 
+              case V4L2_MEMORY_USERPTR:
+                buf->m.planes[i].m.userptr = container ?
+                    container->buf.m.planes[i].m.userptr : 0;
+                break;
+
               default:
                 return -EINVAL;
             }
@@ -418,6 +426,10 @@ static int codec_querybuf(FAR struct file *filep,
             buf->m.offset = offset + bufsize * buf->index;
             break;
 
+          case V4L2_MEMORY_USERPTR:
+            buf->m.userptr = container ? container->buf.m.userptr : 0;
+            break;
+
           default:
             return -EINVAL;
         }
@@ -484,6 +496,11 @@ static int codec_qbuf(FAR struct file *filep,
                      offset + type_inf->bufheap);
                 break;
 
+              case V4L2_MEMORY_USERPTR:
+                container->buf.m.planes[i].m.vaddr =
+                    (FAR void *)buf->m.planes[i].m.userptr;
+                break;
+
               default:
                 return -EINVAL;
             }
@@ -498,6 +515,10 @@ static int codec_qbuf(FAR struct file *filep,
                 (FAR void *)(type_inf->bufheap + buf->m.offset - offset);
             break;
 
+          case V4L2_MEMORY_USERPTR:
+            container->buf.m.vaddr = (FAR void *)buf->m.userptr;
+            break;
+
           default:
             return -EINVAL;
         }
@@ -577,6 +598,11 @@ static int codec_dqbuf(FAR struct file *filep,
                      type_inf->bufheap + offset);
                 break;
 
+              case V4L2_MEMORY_USERPTR:
+                buf->m.planes[i].m.userptr = (unsigned long)
+                    buf->m.planes[i].m.vaddr;
+                break;
+
               default:
                 return -EINVAL;
             }
@@ -591,6 +617,10 @@ static int codec_dqbuf(FAR struct file *filep,
                             type_inf->bufheap + offset);
             break;
 
+          case V4L2_MEMORY_USERPTR:
+            buf->m.userptr = (unsigned long)buf->m.vaddr;
+            break;
+
           default:
             return -EINVAL;
         }

drivers/video/video_framebuff.c

@@ -289,3 +289,51 @@ vbuf_container_t *video_framebuff_pop_curr_container(video_framebuff_t *fbuf)
   spin_unlock_irqrestore(&fbuf->lock_queue, flags);
   return ret;
 }
+
+vbuf_container_t *video_framebuff_find_container(video_framebuff_t *fbuf,
+                                                 uint32_t index)
+{
+  vbuf_container_t *ret = NULL;
+  vbuf_container_t *curr;
+  vbuf_container_t *start;
+  irqstate_t flags;
+
+  flags = spin_lock_irqsave(&fbuf->lock_queue);
+  if (fbuf->vbuf_top != NULL)
+    {
+      curr = start = fbuf->vbuf_top;
+      do
+        {
+          if (curr->buf.index == index)
+            {
+              ret = curr;
+              break;
+            }
+
+          curr = curr->next;
+        }
+      while (curr != NULL && curr != start);
+    }
+
+  spin_unlock_irqrestore(&fbuf->lock_queue, flags);
+
+  if (ret == NULL)
+    {
+      nxmutex_lock(&fbuf->lock_empty);
+      curr = fbuf->vbuf_empty;
+      while (curr != NULL)
+        {
+          if (curr->buf.index == index)
+            {
+              ret = curr;
+              break;
+            }
+
+          curr = curr->next;
+        }
+
+      nxmutex_unlock(&fbuf->lock_empty);
+    }
+
+  return ret;
+}

drivers/video/video_framebuff.h

@@ -90,5 +90,7 @@ void              video_framebuff_capture_done
                        (video_framebuff_t *fbuf);
 void              video_framebuff_change_mode
                        (video_framebuff_t *fbuf, enum v4l2_buf_mode mode);
+vbuf_container_t *video_framebuff_find_container
+                       (video_framebuff_t *fbuf, uint32_t index);
 
 #endif  /* __DRIVERS_VIDEO_VIDEO_FRAMEBUFF_H */