#include <media/v4l2-isp.h>
#include <linux/bitops.h>
#include <linux/device.h>
#include <media/videobuf2-core.h>
int v4l2_isp_params_validate_buffer_size(struct device *dev,
struct vb2_buffer *vb,
size_t max_size)
{
size_t header_size = offsetof(struct v4l2_isp_params_buffer, data);
size_t payload_size = vb2_get_plane_payload(vb, 0);
if (payload_size > max_size) {
dev_dbg(dev, "Payload size is too large: %zu\n", payload_size);
return -EINVAL;
}
if (payload_size < header_size) {
dev_dbg(dev, "Payload size is too small: %zu\n", payload_size);
return -EINVAL;
}
return 0;
}
EXPORT_SYMBOL_GPL(v4l2_isp_params_validate_buffer_size);
int v4l2_isp_params_validate_buffer(struct device *dev, struct vb2_buffer *vb,
const struct v4l2_isp_params_buffer *buffer,
const struct v4l2_isp_params_block_type_info *type_info,
size_t num_block_types)
{
size_t header_size = offsetof(struct v4l2_isp_params_buffer, data);
size_t payload_size = vb2_get_plane_payload(vb, 0);
size_t block_offset = 0;
size_t buffer_size;
if (buffer->version != V4L2_ISP_PARAMS_VERSION_V0 &&
buffer->version != V4L2_ISP_PARAMS_VERSION_V1) {
dev_dbg(dev,
"Unsupported V4L2 ISP parameters format version: %u\n",
buffer->version);
return -EINVAL;
}
buffer_size = header_size + buffer->data_size;
if (buffer_size != payload_size) {
dev_dbg(dev, "Data size %zu and payload size %zu are different\n",
buffer_size, payload_size);
return -EINVAL;
}
buffer_size = buffer->data_size;
while (buffer_size >= sizeof(struct v4l2_isp_params_block_header)) {
const struct v4l2_isp_params_block_type_info *info;
const struct v4l2_isp_params_block_header *block;
block = (const struct v4l2_isp_params_block_header *)
(buffer->data + block_offset);
if (block->type >= num_block_types) {
dev_dbg(dev,
"Invalid block type %u at offset %zu\n",
block->type, block_offset);
return -EINVAL;
}
if (block->size > buffer_size) {
dev_dbg(dev, "Premature end of parameters data\n");
return -EINVAL;
}
if ((block->flags & (V4L2_ISP_PARAMS_FL_BLOCK_ENABLE |
V4L2_ISP_PARAMS_FL_BLOCK_DISABLE)) ==
(V4L2_ISP_PARAMS_FL_BLOCK_ENABLE |
V4L2_ISP_PARAMS_FL_BLOCK_DISABLE)) {
dev_dbg(dev, "Invalid block flags %x at offset %zu\n",
block->flags, block_offset);
return -EINVAL;
}
info = &type_info[block->type];
if (!info->size) {
dev_dbg(dev, "Unsupported block type %u at offset %zu\n",
block->type, block_offset);
return -EINVAL;
}
if (block->size != info->size &&
(!(block->flags & V4L2_ISP_PARAMS_FL_BLOCK_DISABLE) ||
block->size != sizeof(*block))) {
dev_dbg(dev,
"Invalid block size %u (expected %zu) at offset %zu\n",
block->size, info->size, block_offset);
return -EINVAL;
}
if (info->block_validate && info->block_validate(dev, block))
return -EINVAL;
block_offset += block->size;
buffer_size -= block->size;
}
if (buffer_size) {
dev_dbg(dev, "Unexpected data after the parameters buffer end\n");
return -EINVAL;
}
return 0;
}
EXPORT_SYMBOL_GPL(v4l2_isp_params_validate_buffer);
void v4l2_isp_stats_init_buffer(struct v4l2_isp_buffer *buf,
enum v4l2_isp_version version)
{
if (WARN_ON(!buf))
return;
if (WARN_ON(version > V4L2_ISP_VERSION_V1))
return;
buf->version = version;
buf->data_size = 0;
}
EXPORT_SYMBOL_GPL(v4l2_isp_stats_init_buffer);
struct v4l2_isp_block_header *
v4l2_isp_stats_init_block(struct device *dev, struct v4l2_isp_buffer *buf,
const struct v4l2_isp_stats_block_type_info *type_info,
size_t num_block_types, unsigned int block_type,
size_t max_size)
{
const struct v4l2_isp_stats_block_type_info *block_info;
struct v4l2_isp_block_header *header;
size_t used;
if (WARN_ON(!dev || !buf || !type_info))
return ERR_PTR(-EINVAL);
if (block_type >= num_block_types) {
dev_err(dev, "Invalid block type %u\n", block_type);
return ERR_PTR(-EINVAL);
}
block_info = &type_info[block_type];
used = buf->data_size;
if (used + block_info->size > max_size) {
dev_err(dev, "No space for stats block type %u of size %zu\n",
block_type, block_info->size);
return ERR_PTR(-ENOMEM);
}
buf->data_size += block_info->size;
header = (struct v4l2_isp_block_header *)&buf->data[used];
header->type = block_type;
header->size = block_info->size;
header->flags = 0;
return header;
}
EXPORT_SYMBOL_GPL(v4l2_isp_stats_init_block);
MODULE_LICENSE("GPL");
MODULE_AUTHOR("Jacopo Mondi <jacopo.mondi@ideasonboard.com");
MODULE_DESCRIPTION("V4L2 generic ISP parameters and statistics helpers"