^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1) // SPDX-License-Identifier: GPL-2.0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3) * virtual camera driver
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5) * Copyright (C) 2018 Fuzhou Rockchip Electronics Co., Ltd.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8) #include <linux/device.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9) #include <linux/i2c.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) #include <linux/of_graph.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) #include <media/media-entity.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) #include <media/v4l2-async.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) #include <media/v4l2-ctrls.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) #include <media/v4l2-fwnode.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) #include <media/v4l2-subdev.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) #define PROP_WIDTH "width"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) #define PROP_HEIGHT "height"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) #define PROP_BUSFMT "bus-format"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) #define VCAM_VTS_MAX 0x7fff
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) struct output_mode {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) u32 width;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) u32 height;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) u32 hts_def;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) u32 vts_def;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) struct output_pixfmt {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) u32 code;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) u32 reserved;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) struct virtual_camera {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) struct i2c_client *client;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) bool streaming;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) struct mutex mutex; /* lock for updating format protection */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) struct v4l2_subdev subdev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) struct media_pad pad;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) struct v4l2_ctrl *hblank;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) struct v4l2_ctrl *vblank;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) struct v4l2_ctrl *link_freq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) struct v4l2_ctrl_handler ctrl_handler;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) struct v4l2_mbus_framefmt def_fmt;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) const struct output_mode *cur_mode;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) int fmt_code;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) s64 link_frequency;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) #define to_virtual_camera(sd) container_of(sd, struct virtual_camera, subdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) static const s64 link_freq_menu_items[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) 40000000, /* minimum support frequency */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) 55000000,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) 75000000,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) 100000000,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) 125000000,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) 150000000,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) 200000000,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) 250000000,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) 300000000,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) 350000000,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) 400000000,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) 500000000,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) 600000000,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) 700000000,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) 752000000,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) 800000000,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) 900000000,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) 1000000000,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) 1100000000,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) 1200000000,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) 1250000000 /* maximum support frequency */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) static const struct output_pixfmt supported_formats[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80) .code = MEDIA_BUS_FMT_SBGGR8_1X8,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) }, {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) .code = MEDIA_BUS_FMT_SGBRG8_1X8,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) }, {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) .code = MEDIA_BUS_FMT_SGRBG8_1X8,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) }, {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86) .code = MEDIA_BUS_FMT_SRGGB8_1X8,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87) }, {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88) .code = MEDIA_BUS_FMT_SBGGR10_1X10,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89) }, {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90) .code = MEDIA_BUS_FMT_SGBRG10_1X10,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) }, {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92) .code = MEDIA_BUS_FMT_SGRBG10_1X10,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93) }, {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94) .code = MEDIA_BUS_FMT_SRGGB10_1X10,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95) }, {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96) .code = MEDIA_BUS_FMT_RGB888_1X24,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97) },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) static const struct output_mode supported_modes[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) .width = 1280,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) .height = 720,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) .hts_def = 1500,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) .vts_def = 900,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) }, {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) .width = 1920,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) .height = 1080,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) .hts_def = 2400,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) .vts_def = 1200,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) }, {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) .width = 3840,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) .height = 720,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) .hts_def = 4300,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) .vts_def = 900,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) }, {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) .width = 3840,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) .height = 2160,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) .hts_def = 4300,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) .vts_def = 2400,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) }, {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) .width = 4096,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) .height = 2048,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) .hts_def = 4300,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) .vts_def = 2400,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) }, {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) .width = 5120,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) .height = 2880,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) .hts_def = 5800,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) .vts_def = 3100,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) }, {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) .width = 5760,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) .height = 1080,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) .hts_def = 6400,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) .vts_def = 1300,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) static int vcamera_get_reso_dist(const struct output_mode *mode,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) struct v4l2_mbus_framefmt *fmt)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) return abs(mode->width - fmt->width) +
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) abs(mode->height - fmt->height);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) static const struct output_mode *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) vcamera_get_best_mode(struct v4l2_mbus_framefmt *fmt)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) int dist = 0, min_dist = -1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) int best = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) unsigned int i = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) for (i = 0; i < ARRAY_SIZE(supported_modes); i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) dist = vcamera_get_reso_dist(&supported_modes[i], fmt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) if (min_dist == -1 || dist < min_dist) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) min_dist = dist;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) best = i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) return &supported_modes[best];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) static void vcamera_fill_fmt(struct virtual_camera *vcam,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) struct v4l2_mbus_framefmt *fmt)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) fmt->code = vcam->fmt_code;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) fmt->width = vcam->cur_mode->width;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) fmt->height = vcam->cur_mode->height;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) fmt->field = V4L2_FIELD_NONE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) static void vcamera_get_default_fmt(struct virtual_camera *vcam)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) struct device *dev = &vcam->client->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) struct v4l2_mbus_framefmt *def_fmt = &vcam->def_fmt;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) int index = ARRAY_SIZE(supported_formats);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) vcam->cur_mode = vcamera_get_best_mode(def_fmt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) if (vcam->cur_mode->width != def_fmt->width ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) vcam->cur_mode->height != def_fmt->height)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) dev_warn(dev, "get dts res: %dx%d, select best res: %dx%d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) def_fmt->width, def_fmt->height,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) vcam->cur_mode->width, vcam->cur_mode->height);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) while (--index >= 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) if (supported_formats[index].code == def_fmt->code)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) if (index < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) vcam->fmt_code = MEDIA_BUS_FMT_SBGGR8_1X8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) dev_warn(dev, "get dts fmt: 0x%x, select default fmt: 0x%x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) def_fmt->code, vcam->fmt_code);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) vcam->fmt_code = def_fmt->code;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) /* if not found link-frequencies in dts, set a default value */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) if (!vcam->link_frequency)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200) vcam->link_frequency = 500000000;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) vcamera_fill_fmt(vcam, def_fmt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) static int vcamera_get_fmt(struct v4l2_subdev *sd,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) struct v4l2_subdev_pad_config *cfg,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207) struct v4l2_subdev_format *fmt)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209) struct virtual_camera *vcam = to_virtual_camera(sd);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) struct v4l2_mbus_framefmt *mbus_fmt = &fmt->format;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212) if (fmt->which == V4L2_SUBDEV_FORMAT_TRY) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213) #ifdef CONFIG_VIDEO_V4L2_SUBDEV_API
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214) struct v4l2_mbus_framefmt *mf;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216) mf = v4l2_subdev_get_try_format(sd, cfg, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217) mutex_lock(&vcam->mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) fmt->format = *mf;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) mutex_unlock(&vcam->mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) #else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222) return -ENOTTY;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226) mutex_lock(&vcam->mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) vcamera_fill_fmt(vcam, mbus_fmt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228) mutex_unlock(&vcam->mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233) static int vcamera_set_fmt(struct v4l2_subdev *sd,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) struct v4l2_subdev_pad_config *cfg,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) struct v4l2_subdev_format *fmt)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) struct virtual_camera *vcam = to_virtual_camera(sd);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238) struct v4l2_mbus_framefmt *mf = &fmt->format;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239) int index = ARRAY_SIZE(supported_formats);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241) vcam->cur_mode = vcamera_get_best_mode(mf);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243) while (--index >= 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) if (supported_formats[index].code == mf->code)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247) if (index < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250) vcam->fmt_code = supported_formats[index].code;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) mutex_lock(&vcam->mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254) if (fmt->which == V4L2_SUBDEV_FORMAT_TRY) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255) #ifdef CONFIG_VIDEO_V4L2_SUBDEV_API
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256) mf = v4l2_subdev_get_try_format(sd, cfg, fmt->pad);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) *mf = fmt->format;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258) #else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) mutex_unlock(&vcam->mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260) return -ENOTTY;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263) if (vcam->streaming) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264) mutex_unlock(&vcam->mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265) return -EBUSY;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268) vcamera_fill_fmt(vcam, mf);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271) mutex_unlock(&vcam->mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276) static int vcamera_enum_mbus_code(struct v4l2_subdev *sd,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) struct v4l2_subdev_pad_config *cfg,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278) struct v4l2_subdev_mbus_code_enum *code)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280) if (code->index >= ARRAY_SIZE(supported_formats))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283) code->code = supported_formats[code->index].code;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 287)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 288) static int vcamera_enum_frame_sizes(struct v4l2_subdev *sd,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289) struct v4l2_subdev_pad_config *cfg,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 290) struct v4l2_subdev_frame_size_enum *fse)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 291) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 292) unsigned int index = fse->index;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 293) int i = ARRAY_SIZE(supported_formats);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 294)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 295) if (index >= ARRAY_SIZE(supported_modes))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 296) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 297)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 298) while (--i >= 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 299) if (fse->code == supported_formats[i].code)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 300) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 301)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 302) fse->code = supported_formats[i].code;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 303)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 304) fse->min_width = supported_modes[index].width;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 305) fse->max_width = fse->min_width;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 306) fse->max_height = supported_modes[index].height;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 307) fse->min_height = fse->max_height;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 308)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 309) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 310) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 311)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 312) static inline void vcamera_set_vts(struct virtual_camera *vcam, s32 val)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 313) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 314) /* TODO */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 315) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 316)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 317) static int vcamera_s_stream(struct v4l2_subdev *sd, int on)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 318) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 319) struct virtual_camera *vcam = to_virtual_camera(sd);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 320)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 321) mutex_lock(&vcam->mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 322)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 323) on = !!on;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 324) if (on == vcam->streaming)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 325) goto unlock_and_return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 326)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 327) /* TODO */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 328) vcam->streaming = on;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 329)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 330) unlock_and_return:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 331) mutex_unlock(&vcam->mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 332) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 333) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 334)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 335) #ifdef CONFIG_VIDEO_V4L2_SUBDEV_API
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 336) static int vcamera_open(struct v4l2_subdev *sd, struct v4l2_subdev_fh *fh)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 337) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 338) struct virtual_camera *vcam = to_virtual_camera(sd);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 339) struct v4l2_mbus_framefmt *try_fmt;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 340)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 341) mutex_lock(&vcam->mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 342)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 343) try_fmt = v4l2_subdev_get_try_format(sd, fh->pad, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 344) /* Initialize try_fmt */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 345) vcamera_fill_fmt(vcam, try_fmt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 346)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 347) mutex_unlock(&vcam->mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 348)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 349) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 350) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 351) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 352)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 353) static int vcamera_s_ctrl(struct v4l2_ctrl *ctrl)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 354) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 355) struct virtual_camera *vcam = container_of(ctrl->handler,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 356) struct virtual_camera,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 357) ctrl_handler);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 358) struct i2c_client *client = vcam->client;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 359)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 360) /* Propagate change of current control to all related controls */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 361) switch (ctrl->id) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 362) case V4L2_CID_VBLANK:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 363) vcamera_set_vts(vcam, ctrl->val);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 364) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 365) case V4L2_CID_LINK_FREQ:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 366) vcam->link_frequency = link_freq_menu_items[ctrl->val];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 367) dev_info(&client->dev, "link freq ctrl->val: %d freq: %lld\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 368) ctrl->val, vcam->link_frequency);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 369) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 370) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 371) dev_warn(&client->dev, "%s Unhandled id:0x%x, val:0x%x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 372) __func__, ctrl->id, ctrl->val);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 373) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 374) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 375)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 376) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 377) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 378)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 379) static struct v4l2_subdev_core_ops vcamera_core_ops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 380) .log_status = v4l2_ctrl_subdev_log_status,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 381) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 382)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 383) static struct v4l2_subdev_video_ops vcamera_video_ops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 384) .s_stream = vcamera_s_stream,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 385) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 386)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 387) static struct v4l2_subdev_pad_ops vcamera_pad_ops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 388) .enum_mbus_code = vcamera_enum_mbus_code,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 389) .enum_frame_size = vcamera_enum_frame_sizes,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 390) .get_fmt = vcamera_get_fmt,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 391) .set_fmt = vcamera_set_fmt,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 392) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 393)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 394) static struct v4l2_subdev_ops vcamera_subdev_ops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 395) .core = &vcamera_core_ops,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 396) .video = &vcamera_video_ops,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 397) .pad = &vcamera_pad_ops,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 398) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 399)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 400) #ifdef CONFIG_VIDEO_V4L2_SUBDEV_API
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 401) static const struct v4l2_subdev_internal_ops vcamera_internal_ops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 402) .open = vcamera_open,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 403) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 404) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 405)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 406) static const struct v4l2_ctrl_ops vcamera_ctrl_ops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 407) .s_ctrl = vcamera_s_ctrl,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 408) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 409)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 410) static int vcamera_initialize_controls(struct virtual_camera *vcam)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 411) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 412) const struct output_mode *mode;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 413) struct v4l2_ctrl_handler *handler;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 414) u32 h_blank, i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 415) int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 416)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 417) handler = &vcam->ctrl_handler;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 418) mode = vcam->cur_mode;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 419) ret = v4l2_ctrl_handler_init(handler, 3);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 420) if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 421) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 422)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 423) handler->lock = &vcam->mutex;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 424)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 425) vcam->link_freq = v4l2_ctrl_new_int_menu(handler, &vcamera_ctrl_ops,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 426) V4L2_CID_LINK_FREQ,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 427) ARRAY_SIZE(link_freq_menu_items) - 1, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 428) link_freq_menu_items);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 429)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 430) h_blank = mode->hts_def - mode->width;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 431) vcam->hblank = v4l2_ctrl_new_std(handler, NULL, V4L2_CID_HBLANK,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 432) h_blank, h_blank, 1, h_blank);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 433) if (vcam->hblank)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 434) vcam->hblank->flags |= V4L2_CTRL_FLAG_READ_ONLY;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 435)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 436) vcam->vblank = v4l2_ctrl_new_std(handler, &vcamera_ctrl_ops,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 437) V4L2_CID_VBLANK, mode->vts_def - mode->height,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 438) VCAM_VTS_MAX - mode->height, 1,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 439) mode->vts_def - mode->height);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 440)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 441) if (handler->error) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 442) v4l2_ctrl_handler_free(handler);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 443) return handler->error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 444) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 445)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 446) vcam->subdev.ctrl_handler = handler;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 447)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 448) for (i = 0; i < ARRAY_SIZE(link_freq_menu_items); i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 449) if (link_freq_menu_items[i] > vcam->link_frequency && i >= 1) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 450) v4l2_ctrl_s_ctrl(vcam->link_freq, i - 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 451) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 452) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 453) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 454)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 455) if (i == ARRAY_SIZE(link_freq_menu_items)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 456) dev_warn(&vcam->client->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 457) "vcam->link_frequency: %lld, max support clock: %lld\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 458) vcam->link_frequency, link_freq_menu_items[i - 1]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 459) v4l2_ctrl_s_ctrl(vcam->link_freq, i - 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 460) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 461)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 462) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 463) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 464)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 465) static int vcamera_check_sensor_id(struct virtual_camera *vcam,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 466) struct i2c_client *client)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 467) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 468) /* TODO */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 469) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 470) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 471)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 472) static int vcamera_get_pdata(struct i2c_client *client,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 473) struct virtual_camera *vcam)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 474) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 475) struct v4l2_fwnode_endpoint *bus_cfg;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 476) struct device_node *np = client->dev.of_node;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 477) struct device_node *endpoint;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 478) u32 val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 479)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 480) if (!IS_ENABLED(CONFIG_OF) || !np)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 481) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 482)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 483) if (!of_property_read_u32(np, PROP_WIDTH, &val))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 484) vcam->def_fmt.width = val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 485)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 486) if (!of_property_read_u32(np, PROP_HEIGHT, &val))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 487) vcam->def_fmt.height = val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 488)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 489) if (!of_property_read_u32(np, PROP_BUSFMT, &val))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 490) vcam->def_fmt.code = val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 491)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 492) endpoint = of_graph_get_next_endpoint(np, NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 493) if (!endpoint)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 494) return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 495)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 496) bus_cfg = v4l2_fwnode_endpoint_alloc_parse(of_fwnode_handle(endpoint));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 497) if (IS_ERR(bus_cfg))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 498) goto done;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 499)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 500) if (!bus_cfg->nr_of_link_frequencies) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 501) dev_info(&client->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 502) "link-frequencies property not found or too many\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 503) goto done;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 504) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 505)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 506) vcam->link_frequency = bus_cfg->link_frequencies[0];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 507)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 508) done:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 509) v4l2_fwnode_endpoint_free(bus_cfg);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 510) of_node_put(endpoint);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 511) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 512) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 513)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 514) static int vcamera_probe(struct i2c_client *client,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 515) const struct i2c_device_id *id)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 516) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 517) struct device *dev = &client->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 518) struct virtual_camera *vcam;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 519) int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 520)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 521) vcam = devm_kzalloc(dev, sizeof(*vcam), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 522) if (!vcam)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 523) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 524)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 525) vcam->client = client;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 526) vcamera_get_pdata(client, vcam);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 527) vcamera_get_default_fmt(vcam);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 528)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 529) mutex_init(&vcam->mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 530) v4l2_i2c_subdev_init(&vcam->subdev, client, &vcamera_subdev_ops);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 531) ret = vcamera_initialize_controls(vcam);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 532) if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 533) goto destroy_mutex;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 534)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 535) ret = vcamera_check_sensor_id(vcam, client);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 536) if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 537) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 538)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 539) #ifdef CONFIG_VIDEO_V4L2_SUBDEV_API
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 540) vcam->subdev.internal_ops = &vcamera_internal_ops;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 541) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 542) #if defined(CONFIG_MEDIA_CONTROLLER)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 543) vcam->pad.flags = MEDIA_PAD_FL_SOURCE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 544) vcam->subdev.flags |= V4L2_SUBDEV_FL_HAS_DEVNODE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 545) vcam->subdev.entity.type = MEDIA_ENT_T_V4L2_SUBDEV_SENSOR;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 546) ret = media_entity_init(&vcam->subdev.entity, 1, &vcam->pad, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 547) if (ret < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 548) goto free_ctrl_handler;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 549) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 550)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 551) ret = v4l2_async_register_subdev(&vcam->subdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 552) if (ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 553) dev_err(dev, "v4l2 async register subdev failed\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 554) goto clean_entity;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 555) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 556)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 557) dev_info(dev, "virtual camera register success\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 558)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 559) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 560)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 561) clean_entity:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 562) #if defined(CONFIG_MEDIA_CONTROLLER)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 563) media_entity_cleanup(&vcam->subdev.entity);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 564) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 565) free_ctrl_handler:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 566) v4l2_ctrl_handler_free(&vcam->ctrl_handler);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 567) destroy_mutex:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 568) mutex_destroy(&vcam->mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 569)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 570) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 571) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 572)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 573) static int vcamera_remove(struct i2c_client *client)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 574) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 575) struct virtual_camera *vcam = i2c_get_clientdata(client);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 576)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 577) v4l2_async_unregister_subdev(&vcam->subdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 578) media_entity_cleanup(&vcam->subdev.entity);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 579) v4l2_ctrl_handler_free(&vcam->ctrl_handler);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 580) mutex_destroy(&vcam->mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 581)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 582) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 583) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 584)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 585) static const struct i2c_device_id vcamera_id[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 586) { "virtual-camera", 0 },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 587) { /* sentinel */ },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 588) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 589) MODULE_DEVICE_TABLE(i2c, vcamera_id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 590)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 591) static const struct of_device_id vcamera_of_match[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 592) { .compatible = "rockchip,virtual-camera" },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 593) {},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 594) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 595)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 596) static struct i2c_driver vcamera_i2c_driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 597) .driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 598) .name = "virtual-camera",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 599) .of_match_table = vcamera_of_match
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 600) },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 601) .probe = vcamera_probe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 602) .remove = vcamera_remove,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 603) .id_table = vcamera_id,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 604) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 605)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 606) module_i2c_driver(vcamera_i2c_driver);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 607)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 608) MODULE_AUTHOR("Rockchip Camera/ISP team");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 609) MODULE_DESCRIPTION("Rockchip virtual camera sensor driver");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 610) MODULE_LICENSE("GPL v2");
Orange Pi5 kernel
Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards
3 Commits
0 Branches
0 Tags