vimc-lens.c

  1// SPDX-License-Identifier: GPL-2.0-or-later
  2/*
  3 * vimc-lens.c Virtual Media Controller Driver
  4 * Copyright (C) 2022 Google, Inc
  5 * Author: yunkec@google.com (Yunke Cao)
  6 */
  7
  8#include <media/v4l2-ctrls.h>
  9#include <media/v4l2-event.h>
 10#include <media/v4l2-subdev.h>
 11
 12#include "vimc-common.h"
 13
 14#define VIMC_LENS_MAX_FOCUS_POS	1023
 15#define VIMC_LENS_MAX_FOCUS_STEP	1
 16
 17struct vimc_lens_device {
 18	struct vimc_ent_device ved;
 19	struct v4l2_subdev sd;
 20	struct v4l2_ctrl_handler hdl;
 21	u32 focus_absolute;
 22};
 23
 24static const struct v4l2_subdev_core_ops vimc_lens_core_ops = {
 25	.log_status = v4l2_ctrl_subdev_log_status,
 26	.subscribe_event = v4l2_ctrl_subdev_subscribe_event,
 27	.unsubscribe_event = v4l2_event_subdev_unsubscribe,
 28};
 29
 30static const struct v4l2_subdev_ops vimc_lens_ops = {
 31	.core = &vimc_lens_core_ops
 32};
 33
 34static int vimc_lens_s_ctrl(struct v4l2_ctrl *ctrl)
 35{
 36	struct vimc_lens_device *vlens =
 37		container_of(ctrl->handler, struct vimc_lens_device, hdl);
 38	if (ctrl->id == V4L2_CID_FOCUS_ABSOLUTE) {
 39		vlens->focus_absolute = ctrl->val;
 40		return 0;
 41	}
 42	return -EINVAL;
 43}
 44
 45static const struct v4l2_ctrl_ops vimc_lens_ctrl_ops = {
 46	.s_ctrl = vimc_lens_s_ctrl,
 47};
 48
 49static struct vimc_ent_device *vimc_lens_add(struct vimc_device *vimc,
 50					     const char *vcfg_name)
 51{
 52	struct v4l2_device *v4l2_dev = &vimc->v4l2_dev;
 53	struct vimc_lens_device *vlens;
 54	int ret;
 55
 56	/* Allocate the vlens struct */
 57	vlens = kzalloc(sizeof(*vlens), GFP_KERNEL);
 58	if (!vlens)
 59		return ERR_PTR(-ENOMEM);
 60
 61	v4l2_ctrl_handler_init(&vlens->hdl, 1);
 62
 63	v4l2_ctrl_new_std(&vlens->hdl, &vimc_lens_ctrl_ops,
 64			  V4L2_CID_FOCUS_ABSOLUTE, 0,
 65			  VIMC_LENS_MAX_FOCUS_POS, VIMC_LENS_MAX_FOCUS_STEP, 0);
 66	vlens->sd.ctrl_handler = &vlens->hdl;
 67	if (vlens->hdl.error) {
 68		ret = vlens->hdl.error;
 69		goto err_free_vlens;
 70	}
 71	vlens->ved.dev = vimc->mdev.dev;
 72
 73	ret = vimc_ent_sd_register(&vlens->ved, &vlens->sd, v4l2_dev,
 74				   vcfg_name, MEDIA_ENT_F_LENS, 0,
 75				   NULL, NULL, &vimc_lens_ops);
 76	if (ret)
 77		goto err_free_hdl;
 78
 79	return &vlens->ved;
 80
 81err_free_hdl:
 82	v4l2_ctrl_handler_free(&vlens->hdl);
 83err_free_vlens:
 84	kfree(vlens);
 85
 86	return ERR_PTR(ret);
 87}
 88
 89static void vimc_lens_release(struct vimc_ent_device *ved)
 90{
 91	struct vimc_lens_device *vlens =
 92		container_of(ved, struct vimc_lens_device, ved);
 93
 94	v4l2_ctrl_handler_free(&vlens->hdl);
 95	v4l2_subdev_cleanup(&vlens->sd);
 96	media_entity_cleanup(vlens->ved.ent);
 97	kfree(vlens);
 98}
 99
100const struct vimc_ent_type vimc_lens_type = {
101	.add = vimc_lens_add,
102	.release = vimc_lens_release
103};