104 lines · c
1// SPDX-License-Identifier: GPL-2.0-or-later2/*3 * vimc-lens.c Virtual Media Controller Driver4 * Copyright (C) 2022 Google, Inc5 * 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 102315#define VIMC_LENS_MAX_FOCUS_STEP 116 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_ops32};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_release103};104