[libcamera-devel,v3,3/7] libcamera: V4L2Device: Support v4l2 menu control
diff mbox series

Message ID 20210428073617.373422-4-hiroh@chromium.org
State Superseded
Headers show
Series
  • Report Android HAL client test pattern modes
Related show

Commit Message

Hirokazu Honda April 28, 2021, 7:36 a.m. UTC
This adds a support of v4l2 menu.

Signed-off-by: Hirokazu Honda <hiroh@chromium.org>
---
 include/libcamera/internal/v4l2_device.h |  3 +
 src/libcamera/v4l2_device.cpp            | 73 +++++++++++++++++++++---
 2 files changed, 69 insertions(+), 7 deletions(-)

Patch
diff mbox series

diff --git a/include/libcamera/internal/v4l2_device.h b/include/libcamera/internal/v4l2_device.h
index 087f07e7..c7a2539c 100644
--- a/include/libcamera/internal/v4l2_device.h
+++ b/include/libcamera/internal/v4l2_device.h
@@ -54,6 +54,9 @@  protected:
 	int fd() const { return fd_; }
 
 private:
+	bool createControlInfoForMenu(const v4l2_query_ext_ctrl &ctrl,
+				      ControlInfo &ctrlInfo);
+
 	void listControls();
 	void updateControls(ControlList *ctrls,
 			    Span<const v4l2_ext_control> v4l2Ctrls);
diff --git a/src/libcamera/v4l2_device.cpp b/src/libcamera/v4l2_device.cpp
index 64501523..f2a9038e 100644
--- a/src/libcamera/v4l2_device.cpp
+++ b/src/libcamera/v4l2_device.cpp
@@ -446,6 +446,7 @@  int V4L2Device::ioctl(unsigned long request, void *argp)
 	return 0;
 }
 
+
 /**
  * \fn V4L2Device::deviceNode()
  * \brief Retrieve the device node path
@@ -453,10 +454,55 @@  int V4L2Device::ioctl(unsigned long request, void *argp)
  */
 
 /**
- * \fn V4L2Device::fd()
- * \brief Retrieve the V4L2 device file descriptor
- * \return The V4L2 device file descriptor, -1 if the device node is not open
+ * \brief Create ControlInfo for v4l2 menu ctrl.
+ * \param[in] ctrl The v4l2_query_ext_ctrl that represents a menu
+ * \param[out] ctrlInfo The created controlInfo
+ *
+ * The created ControlInfo contains not only values and also extra values, which
+ * are indices and name/value acquired by VIDIOC_QUERYMENU, respectively. The
+ * extra values contains std::string if the type of \a ctrl is
+ * V4L2_CTRL_TYPE_MENU or int64_t otherwise.
+ *
+ * \return True on success or false otherwise
  */
+bool V4L2Device::createControlInfoForMenu(const v4l2_query_ext_ctrl &ctrl,
+					  ControlInfo &ctrlInfo)
+{
+	ASSERT(ctrl.type == V4L2_CTRL_TYPE_MENU ||
+	       ctrl.type == V4L2_CTRL_TYPE_INTEGER_MENU);
+	const bool isName = ctrl.type == V4L2_CTRL_TYPE_MENU;
+
+	std::vector<ControlValue> indices;
+	std::vector<ControlValue> values;
+	v4l2_querymenu menu;
+	memset(&menu, 0, sizeof(menu));
+	menu.id = ctrl.id;
+
+	for (menu.index = ctrl.minimum;
+	     static_cast<int>(menu.index) <= ctrl.maximum; menu.index++) {
+		if (ioctl(VIDIOC_QUERYMENU, &menu) != 0)
+			continue;
+
+		indices.emplace_back(static_cast<int32_t>(menu.index));
+		if (isName) {
+			std::string name(reinterpret_cast<const char *>(menu.name));
+			values.emplace_back(std::move(name));
+		} else {
+			values.emplace_back(static_cast<int64_t>(menu.value));
+		}
+	}
+
+	if (values.empty()) {
+		LOG(V4L2, Error)
+			<< "No applicable value: " << utils::hex(ctrl.id);
+
+		return false;
+	}
+
+	ctrlInfo = ControlInfo(indices, values);
+
+	return true;
+}
 
 /*
  * \brief List and store information about all controls supported by the
@@ -467,7 +513,6 @@  void V4L2Device::listControls()
 	ControlInfoMap::Map ctrls;
 	struct v4l2_query_ext_ctrl ctrl = {};
 
-	/* \todo Add support for menu controls. */
 	while (1) {
 		ctrl.id |= V4L2_CTRL_FLAG_NEXT_CTRL |
 			   V4L2_CTRL_FLAG_NEXT_COMPOUND;
@@ -478,15 +523,22 @@  void V4L2Device::listControls()
 		    ctrl.flags & V4L2_CTRL_FLAG_DISABLED)
 			continue;
 
+		ControlInfo ctrlInfo;
 		switch (ctrl.type) {
 		case V4L2_CTRL_TYPE_INTEGER:
 		case V4L2_CTRL_TYPE_BOOLEAN:
-		case V4L2_CTRL_TYPE_MENU:
 		case V4L2_CTRL_TYPE_BUTTON:
 		case V4L2_CTRL_TYPE_INTEGER64:
 		case V4L2_CTRL_TYPE_BITMASK:
-		case V4L2_CTRL_TYPE_INTEGER_MENU:
 		case V4L2_CTRL_TYPE_U8:
+			ctrlInfo = V4L2ControlInfo(ctrl);
+			break;
+
+		case V4L2_CTRL_TYPE_INTEGER_MENU:
+		case V4L2_CTRL_TYPE_MENU:
+			if (!createControlInfoForMenu(ctrl, ctrlInfo))
+				continue;
+
 			break;
 		/* \todo Support other control types. */
 		default:
@@ -496,10 +548,13 @@  void V4L2Device::listControls()
 			continue;
 		}
 
+		LOG(V4L2, Debug) << "Control: " << ctrl.name
+				 << " (" << utils::hex(ctrl.id) << ")";
+
 		controlIds_.emplace_back(std::make_unique<V4L2ControlId>(ctrl));
 		controlInfo_.emplace(ctrl.id, ctrl);
 
-		ctrls.emplace(controlIds_.back().get(), V4L2ControlInfo(ctrl));
+		ctrls.emplace(controlIds_.back().get(), ctrlInfo);
 	}
 
 	controls_ = std::move(ctrls);
@@ -523,6 +578,10 @@  void V4L2Device::updateControls(ControlList *ctrls,
 			value.set<int64_t>(v4l2Ctrl.value64);
 			break;
 
+		case ControlTypeInteger32:
+			value.set<int64_t>(v4l2Ctrl.value);
+			break;
+
 		case ControlTypeByte:
 			/*
 			 * No action required, the VIDIOC_[GS]_EXT_CTRLS ioctl