Skip to content

Commit

Permalink
drivers: video: common: add helpers to check video control range
Browse files Browse the repository at this point in the history
This allows implementing the VIDEO_CTRL_GET_MIN/MAX/DEF controls on
drivers with minimum modification of the drivers.

A typical usage in a video_get_ctrl() implementation would be:

	ret = video_get_ctrl_range(cid, val, 0, 320, 9);
	if (ret <= 0) {
		return ret;
	}
	return sensor_read_u32(&cfg->i2c, EXPOSURE_REG, val, 2);

A typical usage in a video_set_ctrl() implementation would be:

	ret = video_check_range_u32(dev, cid, u32);
	if (ret < 0) {
		return ret;
	}
	return sensor_read_reg(&cfg->i2c, EXPOSURE_REG, &u16, 2);

Signed-off-by: Josuah Demangeon <[email protected]>
  • Loading branch information
josuah committed Oct 6, 2024
1 parent 882b5d6 commit b6a2b3c
Show file tree
Hide file tree
Showing 2 changed files with 89 additions and 1 deletion.
45 changes: 44 additions & 1 deletion drivers/video/video_common.c
Original file line number Diff line number Diff line change
Expand Up @@ -3,10 +3,11 @@
*
* SPDX-License-Identifier: Apache-2.0
*/

#include <zephyr/kernel.h>
#include <zephyr/drivers/video.h>

#include <video_common.h>

K_HEAP_DEFINE(video_buffer_pool,
CONFIG_VIDEO_BUFFER_POOL_SZ_MAX *
CONFIG_VIDEO_BUFFER_POOL_NUM_MAX);
Expand Down Expand Up @@ -74,3 +75,45 @@ void video_buffer_release(struct video_buffer *vbuf)
k_heap_free(&video_buffer_pool, block->data);
}
}

int video_get_range_u32(unsigned int cid, uint32_t *u32, uint32_t min, uint32_t max, uint32_t def)
{
switch (cid & VIDEO_CTRL_GET_MASK) {
case VIDEO_CTRL_GET_MIN:
*u32 = min;
return 0;
case VIDEO_CTRL_GET_MAX:
*u32 = max;
return 0;
case VIDEO_CTRL_GET_DEF:
*u32 = def;
return 0;
case VIDEO_CTRL_GET_CUR:
return 1;
default:
return -ENOTSUP;
}
}

int video_check_range_u32(const struct device *dev, unsigned int cid, uint32_t u32)
{
uint32_t min;
uint32_t max;
int ret;

ret = video_get_ctrl(dev, cid | VIDEO_CTRL_GET_MIN, &min);
if (ret < 0) {
return ret;
}

ret = video_get_ctrl(dev, cid | VIDEO_CTRL_GET_MAX, &max);
if (ret < 0) {
return ret;
}

if (u32 < min || u32 > max) {
return -ERANGE;
}

return 0;
}
45 changes: 45 additions & 0 deletions drivers/video/video_common.h
Original file line number Diff line number Diff line change
@@ -0,0 +1,45 @@
/*
* Copyright (c) 2024, tinyVision.ai Inc.
*
* SPDX-License-Identifier: Apache-2.0
*/

#ifndef ZEPHYR_INCLUDE_VIDEO_COMMON_H
#define ZEPHYR_INCLUDE_VIDEO_COMMON_H

/**
* @brief Provide the minimum/maximum/default 32-bit value depending on the CID.
*
* Video CIDs can contain sub-operations. This function facilitates
* implementation of video controls in the drivers by handling these
* the range-related CIDs.
*
* @param cid The Video Control ID which contains the operation.
* @param min The minimum value returned if the CID requested it.
* @param max The maximum value returned if the CID requested it.
* @param def The default value returned if the CID requested it.
*
* @return 0 if the operation was regarding a range CID and the value could
* be set. In which case, there is nothing else to do than returning 0.
* @return 1 if the operation is not for the range, but the current value,
* in which case it is the duty of the driver to query the current
* value to the hardware
* @return A negative error code if an error occurred.
*/
int video_get_range_u32(unsigned int cid, uint32_t *u32, uint32_t min, uint32_t max, uint32_t def);

/**
* @brief Check if the 32-bit value is within range for this CID.
*
* Before setting a video control, a driver might be interested in checking
* if it is within a valid range. This function facilitates it by reusing the
* video_get_ctrl() API using @c VIDEO_CTRL_GET_MIN and @c VIDEO_CTRL_GET_MAX
* to validate the input.
*
* @param dev The video device to query to learn about the min and max.
* @param cid The CID for which to check the range.
* @param u32 The 32-bit value that must be matched against the range.
*/
int video_check_range_u32(const struct device *dev, unsigned int cid, uint32_t u32);

#endif /* ZEPHYR_INCLUDE_VIDEO_COMMON_H */

0 comments on commit b6a2b3c

Please sign in to comment.