[libcamera-devel,v3,2/6] libcamera: v4l2_device: List controls at device open

Message ID 20190613112046.25260-3-jacopo@jmondi.org
State Superseded
Headers show
Series
  • Add support for V4L2 Controls
Related show

Commit Message

Jacopo Mondi June 13, 2019, 11:20 a.m. UTC
Enumerate all the controls a device supports at open() time.
Store the control informations in a map inside the device to save
querying the control when setting or getting its value from the device.

Signed-off-by: Jacopo Mondi <jacopo@jmondi.org>
---
 src/libcamera/include/v4l2_device.h |  8 +++++++-
 src/libcamera/v4l2_device.cpp       | 31 +++++++++++++++++++++++++++++
 2 files changed, 38 insertions(+), 1 deletion(-)

Patch

diff --git a/src/libcamera/include/v4l2_device.h b/src/libcamera/include/v4l2_device.h
index a73e1b600500..727b9d2e210a 100644
--- a/src/libcamera/include/v4l2_device.h
+++ b/src/libcamera/include/v4l2_device.h
@@ -7,14 +7,17 @@ 
 #ifndef __LIBCAMERA_V4L2_DEVICE_H__
 #define __LIBCAMERA_V4L2_DEVICE_H__
 
+#include <map>
 #include <string>
 
 namespace libcamera {
 
+class V4L2ControlInfo;
+
 class V4L2Device
 {
 public:
-	virtual ~V4L2Device() { close(); }
+	virtual ~V4L2Device();
 
 protected:
 	V4L2Device();
@@ -28,7 +31,10 @@  protected:
 	int ioctl(unsigned long request, void *argp);
 
 private:
+	int listControls();
+
 	int fd_;
+	std::map<unsigned int, V4L2ControlInfo *> controls_;
 };
 
 } /* namespace libcamera */
diff --git a/src/libcamera/v4l2_device.cpp b/src/libcamera/v4l2_device.cpp
index 6cbfc212a725..b60b446050e9 100644
--- a/src/libcamera/v4l2_device.cpp
+++ b/src/libcamera/v4l2_device.cpp
@@ -13,6 +13,7 @@ 
 #include <unistd.h>
 
 #include "log.h"
+#include "v4l2_controls.h"
 
 /**
  * \file v4l2_device.h
@@ -50,6 +51,14 @@  V4L2Device::V4L2Device()
 {
 }
 
+V4L2Device::~V4L2Device()
+{
+	for (auto &pair : controls_)
+		delete pair.second;
+
+	close();
+}
+
 /**
  * \fn V4L2Device::fd()
  * \brief Retrieve the V4L2 device file descriptor
@@ -82,6 +91,28 @@  int V4L2Device::open(const std::string &pathname, unsigned int flags)
 
 	fd_ = ret;
 
+	listControls();
+
+	return 0;
+}
+
+int V4L2Device::listControls()
+{
+	struct v4l2_query_ext_ctrl ctrl = {};
+
+	/* \todo: add support for menu and compound controls. */
+	ctrl.id = V4L2_CTRL_FLAG_NEXT_CTRL;
+	while (ioctl(VIDIOC_QUERY_EXT_CTRL, &ctrl) == 0) {
+		if (ctrl.type == V4L2_CTRL_TYPE_CTRL_CLASS ||
+		    ctrl.flags & V4L2_CTRL_FLAG_DISABLED) {
+			ctrl.id |= V4L2_CTRL_FLAG_NEXT_CTRL;
+			continue;
+		}
+
+		controls_[ctrl.id] = new V4L2ControlInfo(ctrl);
+		ctrl.id |= V4L2_CTRL_FLAG_NEXT_CTRL;
+	}
+
 	return 0;
 }