1 // SPDX-License-Identifier: GPL-2.0 2 /* 3 * Allied Vision Technologies GmbH Alvium camera driver 4 * 5 * Copyright (C) 2023 Tommaso Merciai 6 * Copyright (C) 2023 Martin Hecht 7 * Copyright (C) 2023 Avnet EMG GmbH 8 */ 9 10 #include <linux/i2c.h> 11 #include <linux/module.h> 12 #include <linux/pm_runtime.h> 13 #include <linux/regmap.h> 14 #include <linux/regulator/consumer.h> 15 #include <media/mipi-csi2.h> 16 #include <media/v4l2-async.h> 17 #include <media/v4l2-ctrls.h> 18 #include <media/v4l2-device.h> 19 #include <media/v4l2-fwnode.h> 20 #include <media/v4l2-subdev.h> 21 22 #include "alvium-csi2.h" 23 24 static const struct v4l2_mbus_framefmt alvium_csi2_default_fmt = { 25 .code = MEDIA_BUS_FMT_UYVY8_1X16, 26 .width = 640, 27 .height = 480, 28 .colorspace = V4L2_COLORSPACE_SRGB, 29 .ycbcr_enc = V4L2_MAP_YCBCR_ENC_DEFAULT(V4L2_COLORSPACE_SRGB), 30 .quantization = V4L2_QUANTIZATION_FULL_RANGE, 31 .xfer_func = V4L2_MAP_XFER_FUNC_DEFAULT(V4L2_COLORSPACE_SRGB), 32 .field = V4L2_FIELD_NONE, 33 }; 34 35 static const struct alvium_pixfmt alvium_csi2_fmts[] = { 36 { 37 /* UYVY8_2X8 */ 38 .id = ALVIUM_FMT_UYVY8_2X8, 39 .code = MEDIA_BUS_FMT_UYVY8_2X8, 40 .colorspace = V4L2_COLORSPACE_SRGB, 41 .fmt_av_bit = ALVIUM_BIT_YUV422_8, 42 .bay_av_bit = ALVIUM_BIT_BAY_NONE, 43 .mipi_fmt_regval = MIPI_CSI2_DT_YUV422_8B, 44 .bay_fmt_regval = -1, 45 .is_raw = 0, 46 }, { 47 /* UYVY8_1X16 */ 48 .id = ALVIUM_FMT_UYVY8_1X16, 49 .code = MEDIA_BUS_FMT_UYVY8_1X16, 50 .colorspace = V4L2_COLORSPACE_SRGB, 51 .fmt_av_bit = ALVIUM_BIT_YUV422_8, 52 .bay_av_bit = ALVIUM_BIT_BAY_NONE, 53 .mipi_fmt_regval = MIPI_CSI2_DT_YUV422_8B, 54 .bay_fmt_regval = -1, 55 .is_raw = 0, 56 }, { 57 /* YUYV8_1X16 */ 58 .id = ALVIUM_FMT_YUYV8_1X16, 59 .code = MEDIA_BUS_FMT_YUYV8_1X16, 60 .colorspace = V4L2_COLORSPACE_SRGB, 61 .fmt_av_bit = ALVIUM_BIT_YUV422_8, 62 .bay_av_bit = ALVIUM_BIT_BAY_NONE, 63 .mipi_fmt_regval = MIPI_CSI2_DT_YUV422_8B, 64 .bay_fmt_regval = -1, 65 .is_raw = 0, 66 }, { 67 /* YUYV8_2X8 */ 68 .id = ALVIUM_FMT_YUYV8_2X8, 69 .code = MEDIA_BUS_FMT_YUYV8_2X8, 70 .colorspace = V4L2_COLORSPACE_SRGB, 71 .fmt_av_bit = ALVIUM_BIT_YUV422_8, 72 .bay_av_bit = ALVIUM_BIT_BAY_NONE, 73 .mipi_fmt_regval = MIPI_CSI2_DT_YUV422_8B, 74 .bay_fmt_regval = -1, 75 .is_raw = 0, 76 }, { 77 /* YUYV10_1X20 */ 78 .id = ALVIUM_FMT_YUYV10_1X20, 79 .code = MEDIA_BUS_FMT_YUYV10_1X20, 80 .colorspace = V4L2_COLORSPACE_SRGB, 81 .fmt_av_bit = ALVIUM_BIT_YUV422_10, 82 .bay_av_bit = ALVIUM_BIT_BAY_NONE, 83 .mipi_fmt_regval = MIPI_CSI2_DT_YUV422_10B, 84 .bay_fmt_regval = -1, 85 .is_raw = 0, 86 }, { 87 /* RGB888_1X24 */ 88 .id = ALVIUM_FMT_RGB888_1X24, 89 .code = MEDIA_BUS_FMT_RGB888_1X24, 90 .colorspace = V4L2_COLORSPACE_SRGB, 91 .fmt_av_bit = ALVIUM_BIT_RGB888, 92 .bay_av_bit = ALVIUM_BIT_BAY_NONE, 93 .mipi_fmt_regval = MIPI_CSI2_DT_RGB888, 94 .bay_fmt_regval = -1, 95 .is_raw = 0, 96 }, { 97 /* RBG888_1X24 */ 98 .id = ALVIUM_FMT_RBG888_1X24, 99 .code = MEDIA_BUS_FMT_RBG888_1X24, 100 .colorspace = V4L2_COLORSPACE_SRGB, 101 .fmt_av_bit = ALVIUM_BIT_RGB888, 102 .bay_av_bit = ALVIUM_BIT_BAY_NONE, 103 .mipi_fmt_regval = MIPI_CSI2_DT_RGB888, 104 .bay_fmt_regval = -1, 105 .is_raw = 0, 106 }, { 107 /* BGR888_1X24 */ 108 .id = ALVIUM_FMT_BGR888_1X24, 109 .code = MEDIA_BUS_FMT_BGR888_1X24, 110 .colorspace = V4L2_COLORSPACE_SRGB, 111 .fmt_av_bit = ALVIUM_BIT_RGB888, 112 .bay_av_bit = ALVIUM_BIT_BAY_NONE, 113 .mipi_fmt_regval = MIPI_CSI2_DT_RGB888, 114 .bay_fmt_regval = -1, 115 .is_raw = 0, 116 }, { 117 /* RGB888_3X8 */ 118 .id = ALVIUM_FMT_RGB888_3X8, 119 .code = MEDIA_BUS_FMT_RGB888_3X8, 120 .colorspace = V4L2_COLORSPACE_SRGB, 121 .fmt_av_bit = ALVIUM_BIT_RGB888, 122 .bay_av_bit = ALVIUM_BIT_BAY_NONE, 123 .mipi_fmt_regval = MIPI_CSI2_DT_RGB888, 124 .bay_fmt_regval = -1, 125 .is_raw = 0, 126 }, { 127 /* Y8_1X8 */ 128 .id = ALVIUM_FMT_Y8_1X8, 129 .code = MEDIA_BUS_FMT_Y8_1X8, 130 .colorspace = V4L2_COLORSPACE_RAW, 131 .fmt_av_bit = ALVIUM_BIT_RAW8, 132 .bay_av_bit = ALVIUM_BIT_BAY_MONO, 133 .mipi_fmt_regval = MIPI_CSI2_DT_RAW8, 134 .bay_fmt_regval = 0x00, 135 .is_raw = 1, 136 }, { 137 /* SGRBG8_1X8 */ 138 .id = ALVIUM_FMT_SGRBG8_1X8, 139 .code = MEDIA_BUS_FMT_SGRBG8_1X8, 140 .colorspace = V4L2_COLORSPACE_RAW, 141 .fmt_av_bit = ALVIUM_BIT_RAW8, 142 .bay_av_bit = ALVIUM_BIT_BAY_GR, 143 .mipi_fmt_regval = MIPI_CSI2_DT_RAW8, 144 .bay_fmt_regval = 0x01, 145 .is_raw = 1, 146 }, { 147 /* SRGGB8_1X8 */ 148 .id = ALVIUM_FMT_SRGGB8_1X8, 149 .code = MEDIA_BUS_FMT_SRGGB8_1X8, 150 .colorspace = V4L2_COLORSPACE_RAW, 151 .fmt_av_bit = ALVIUM_BIT_RAW8, 152 .bay_av_bit = ALVIUM_BIT_BAY_RG, 153 .mipi_fmt_regval = MIPI_CSI2_DT_RAW8, 154 .bay_fmt_regval = 0x02, 155 .is_raw = 1, 156 }, { 157 /* SGBRG8_1X8 */ 158 .id = ALVIUM_FMT_SGBRG8_1X8, 159 .code = MEDIA_BUS_FMT_SGBRG8_1X8, 160 .colorspace = V4L2_COLORSPACE_RAW, 161 .fmt_av_bit = ALVIUM_BIT_RAW8, 162 .bay_av_bit = ALVIUM_BIT_BAY_GB, 163 .mipi_fmt_regval = MIPI_CSI2_DT_RAW8, 164 .bay_fmt_regval = 0x03, 165 .is_raw = 1, 166 }, { 167 /* SBGGR8_1X8 */ 168 .id = ALVIUM_FMT_SBGGR8_1X8, 169 .code = MEDIA_BUS_FMT_SBGGR8_1X8, 170 .colorspace = V4L2_COLORSPACE_RAW, 171 .fmt_av_bit = ALVIUM_BIT_RAW8, 172 .bay_av_bit = ALVIUM_BIT_BAY_BG, 173 .mipi_fmt_regval = MIPI_CSI2_DT_RAW8, 174 .bay_fmt_regval = 0x04, 175 .is_raw = 1, 176 }, { 177 /* Y10_1X10 */ 178 .id = ALVIUM_FMT_Y10_1X10, 179 .code = MEDIA_BUS_FMT_Y10_1X10, 180 .colorspace = V4L2_COLORSPACE_RAW, 181 .fmt_av_bit = ALVIUM_BIT_RAW10, 182 .bay_av_bit = ALVIUM_BIT_BAY_MONO, 183 .mipi_fmt_regval = MIPI_CSI2_DT_RAW10, 184 .bay_fmt_regval = 0x00, 185 .is_raw = 1, 186 }, { 187 /* SGRBG10_1X10 */ 188 .id = ALVIUM_FMT_SGRBG10_1X10, 189 .code = MEDIA_BUS_FMT_SGRBG10_1X10, 190 .colorspace = V4L2_COLORSPACE_RAW, 191 .fmt_av_bit = ALVIUM_BIT_RAW10, 192 .bay_av_bit = ALVIUM_BIT_BAY_GR, 193 .mipi_fmt_regval = MIPI_CSI2_DT_RAW10, 194 .bay_fmt_regval = 0x01, 195 .is_raw = 1, 196 }, { 197 /* SRGGB10_1X10 */ 198 .id = ALVIUM_FMT_SRGGB10_1X10, 199 .code = MEDIA_BUS_FMT_SRGGB10_1X10, 200 .colorspace = V4L2_COLORSPACE_RAW, 201 .fmt_av_bit = ALVIUM_BIT_RAW10, 202 .bay_av_bit = ALVIUM_BIT_BAY_RG, 203 .mipi_fmt_regval = MIPI_CSI2_DT_RAW10, 204 .bay_fmt_regval = 0x02, 205 .is_raw = 1, 206 }, { 207 /* SGBRG10_1X10 */ 208 .id = ALVIUM_FMT_SGBRG10_1X10, 209 .code = MEDIA_BUS_FMT_SGBRG10_1X10, 210 .colorspace = V4L2_COLORSPACE_RAW, 211 .fmt_av_bit = ALVIUM_BIT_RAW10, 212 .bay_av_bit = ALVIUM_BIT_BAY_GB, 213 .mipi_fmt_regval = MIPI_CSI2_DT_RAW10, 214 .bay_fmt_regval = 0x03, 215 .is_raw = 1, 216 }, { 217 /* SBGGR10_1X10 */ 218 .id = ALVIUM_FMT_SBGGR10_1X10, 219 .code = MEDIA_BUS_FMT_SBGGR10_1X10, 220 .colorspace = V4L2_COLORSPACE_RAW, 221 .fmt_av_bit = ALVIUM_BIT_RAW10, 222 .bay_av_bit = ALVIUM_BIT_BAY_BG, 223 .mipi_fmt_regval = MIPI_CSI2_DT_RAW10, 224 .bay_fmt_regval = 0x04, 225 .is_raw = 1, 226 }, { 227 /* Y12_1X12 */ 228 .id = ALVIUM_FMT_Y12_1X12, 229 .code = MEDIA_BUS_FMT_Y12_1X12, 230 .colorspace = V4L2_COLORSPACE_RAW, 231 .fmt_av_bit = ALVIUM_BIT_RAW12, 232 .bay_av_bit = ALVIUM_BIT_BAY_MONO, 233 .mipi_fmt_regval = MIPI_CSI2_DT_RAW12, 234 .bay_fmt_regval = 0x00, 235 .is_raw = 1, 236 }, { 237 /* SGRBG12_1X12 */ 238 .id = ALVIUM_FMT_SGRBG12_1X12, 239 .code = MEDIA_BUS_FMT_SGRBG12_1X12, 240 .colorspace = V4L2_COLORSPACE_RAW, 241 .fmt_av_bit = ALVIUM_BIT_RAW12, 242 .bay_av_bit = ALVIUM_BIT_BAY_GR, 243 .mipi_fmt_regval = MIPI_CSI2_DT_RAW12, 244 .bay_fmt_regval = 0x01, 245 .is_raw = 1, 246 }, { 247 /* SRGGB12_1X12 */ 248 .id = ALVIUM_FMT_SRGGB12_1X12, 249 .code = MEDIA_BUS_FMT_SRGGB12_1X12, 250 .colorspace = V4L2_COLORSPACE_RAW, 251 .fmt_av_bit = ALVIUM_BIT_RAW12, 252 .bay_av_bit = ALVIUM_BIT_BAY_RG, 253 .mipi_fmt_regval = MIPI_CSI2_DT_RAW12, 254 .bay_fmt_regval = 0x02, 255 .is_raw = 1, 256 }, { 257 /* SGBRG12_1X12 */ 258 .id = ALVIUM_FMT_SGBRG12_1X12, 259 .code = MEDIA_BUS_FMT_SGBRG12_1X12, 260 .colorspace = V4L2_COLORSPACE_RAW, 261 .fmt_av_bit = ALVIUM_BIT_RAW12, 262 .bay_av_bit = ALVIUM_BIT_BAY_GB, 263 .mipi_fmt_regval = MIPI_CSI2_DT_RAW12, 264 .bay_fmt_regval = 0x03, 265 .is_raw = 1, 266 }, { 267 /* SBGGR12_1X12 */ 268 .id = ALVIUM_FMT_SBGGR12_1X12, 269 .code = MEDIA_BUS_FMT_SBGGR12_1X12, 270 .colorspace = V4L2_COLORSPACE_RAW, 271 .fmt_av_bit = ALVIUM_BIT_RAW12, 272 .bay_av_bit = ALVIUM_BIT_BAY_BG, 273 .mipi_fmt_regval = MIPI_CSI2_DT_RAW12, 274 .bay_fmt_regval = 0x04, 275 .is_raw = 1, 276 }, { 277 /* SBGGR14_1X14 */ 278 .id = ALVIUM_FMT_SBGGR14_1X14, 279 .code = MEDIA_BUS_FMT_SBGGR14_1X14, 280 .colorspace = V4L2_COLORSPACE_RAW, 281 .fmt_av_bit = ALVIUM_BIT_RAW14, 282 .bay_av_bit = ALVIUM_BIT_BAY_GR, 283 .mipi_fmt_regval = MIPI_CSI2_DT_RAW14, 284 .bay_fmt_regval = 0x01, 285 .is_raw = 1, 286 }, { 287 /* SGBRG14_1X14 */ 288 .id = ALVIUM_FMT_SGBRG14_1X14, 289 .code = MEDIA_BUS_FMT_SGBRG14_1X14, 290 .colorspace = V4L2_COLORSPACE_RAW, 291 .fmt_av_bit = ALVIUM_BIT_RAW14, 292 .bay_av_bit = ALVIUM_BIT_BAY_RG, 293 .mipi_fmt_regval = MIPI_CSI2_DT_RAW14, 294 .bay_fmt_regval = 0x02, 295 .is_raw = 1, 296 }, { 297 /* SRGGB14_1X14 */ 298 .id = ALVIUM_FMT_SRGGB14_1X14, 299 .code = MEDIA_BUS_FMT_SRGGB14_1X14, 300 .colorspace = V4L2_COLORSPACE_RAW, 301 .fmt_av_bit = ALVIUM_BIT_RAW14, 302 .bay_av_bit = ALVIUM_BIT_BAY_GB, 303 .mipi_fmt_regval = MIPI_CSI2_DT_RAW14, 304 .bay_fmt_regval = 0x03, 305 .is_raw = 1, 306 }, { 307 /* SGRBG14_1X14 */ 308 .id = ALVIUM_FMT_SGRBG14_1X14, 309 .code = MEDIA_BUS_FMT_SGRBG14_1X14, 310 .colorspace = V4L2_COLORSPACE_RAW, 311 .fmt_av_bit = ALVIUM_BIT_RAW14, 312 .bay_av_bit = ALVIUM_BIT_BAY_BG, 313 .mipi_fmt_regval = MIPI_CSI2_DT_RAW14, 314 .bay_fmt_regval = 0x04, 315 .is_raw = 1, 316 }, 317 { /* sentinel */ } 318 }; 319 320 static int alvium_read(struct alvium_dev *alvium, u32 reg, u64 *val, int *err) 321 { 322 if (reg & REG_BCRM_V4L2) { 323 reg &= ~REG_BCRM_V4L2; 324 reg += alvium->bcrm_addr; 325 } 326 327 return cci_read(alvium->regmap, reg, val, err); 328 } 329 330 static int alvium_write(struct alvium_dev *alvium, u32 reg, u64 val, int *err) 331 { 332 if (reg & REG_BCRM_V4L2) { 333 reg &= ~REG_BCRM_V4L2; 334 reg += alvium->bcrm_addr; 335 } 336 337 return cci_write(alvium->regmap, reg, val, err); 338 } 339 340 static int alvium_write_hshake(struct alvium_dev *alvium, u32 reg, u64 val) 341 { 342 struct device *dev = &alvium->i2c_client->dev; 343 u64 hshake_bit; 344 int ret = 0; 345 346 /* reset handshake bit and write alvium reg */ 347 alvium_write(alvium, REG_BCRM_WRITE_HANDSHAKE_RW, 0, &ret); 348 alvium_write(alvium, reg, val, &ret); 349 if (ret) { 350 dev_err(dev, "Fail to write reg\n"); 351 return ret; 352 } 353 354 /* poll handshake bit since bit0 = 1 */ 355 read_poll_timeout(alvium_read, hshake_bit, 356 ((hshake_bit & BCRM_HANDSHAKE_W_DONE_EN_BIT) == 1), 357 15000, 45000, true, 358 alvium, REG_BCRM_WRITE_HANDSHAKE_RW, 359 &hshake_bit, &ret); 360 if (ret) { 361 dev_err(dev, "poll bit[0] = 1, hshake reg fail\n"); 362 return ret; 363 } 364 365 /* reset handshake bit, write 0 to bit0 */ 366 alvium_write(alvium, REG_BCRM_WRITE_HANDSHAKE_RW, 0, &ret); 367 if (ret) { 368 dev_err(dev, "Fail to reset hshake reg\n"); 369 return ret; 370 } 371 372 /* poll handshake bit since bit0 = 0 */ 373 read_poll_timeout(alvium_read, hshake_bit, 374 ((hshake_bit & BCRM_HANDSHAKE_W_DONE_EN_BIT) == 0), 375 15000, 45000, true, 376 alvium, REG_BCRM_WRITE_HANDSHAKE_RW, 377 &hshake_bit, &ret); 378 if (ret) { 379 dev_err(dev, "poll bit[0] = 0, hshake reg fail\n"); 380 return ret; 381 } 382 383 return 0; 384 } 385 386 static int alvium_get_bcrm_vers(struct alvium_dev *alvium) 387 { 388 struct device *dev = &alvium->i2c_client->dev; 389 u64 min, maj; 390 int ret = 0; 391 392 ret = alvium_read(alvium, REG_BCRM_MINOR_VERSION_R, &min, &ret); 393 ret = alvium_read(alvium, REG_BCRM_MAJOR_VERSION_R, &maj, &ret); 394 if (ret) 395 return ret; 396 397 dev_info(dev, "bcrm version: %llu.%llu\n", min, maj); 398 399 return 0; 400 } 401 402 static int alvium_get_fw_version(struct alvium_dev *alvium) 403 { 404 struct device *dev = &alvium->i2c_client->dev; 405 u64 val; 406 int ret; 407 408 ret = alvium_read(alvium, REG_BCRM_DEVICE_FW, &val, NULL); 409 if (ret) 410 return ret; 411 412 dev_info(dev, "fw version: %02u.%02u.%04u.%08x\n", 413 (u8)((val & BCRM_DEVICE_FW_SPEC_MASK) >> 414 BCRM_DEVICE_FW_SPEC_SHIFT), 415 (u8)((val & BCRM_DEVICE_FW_MAJOR_MASK) >> 416 BCRM_DEVICE_FW_MAJOR_SHIFT), 417 (u16)((val & BCRM_DEVICE_FW_MINOR_MASK) >> 418 BCRM_DEVICE_FW_MINOR_SHIFT), 419 (u32)((val & BCRM_DEVICE_FW_PATCH_MASK) >> 420 BCRM_DEVICE_FW_PATCH_SHIFT)); 421 422 return 0; 423 } 424 425 static int alvium_get_bcrm_addr(struct alvium_dev *alvium) 426 { 427 u64 val; 428 int ret; 429 430 ret = alvium_read(alvium, REG_BCRM_REG_ADDR_R, &val, NULL); 431 if (ret) 432 return ret; 433 434 alvium->bcrm_addr = val; 435 436 return 0; 437 } 438 439 static int alvium_is_alive(struct alvium_dev *alvium) 440 { 441 u64 bcrm, hbeat; 442 int ret = 0; 443 444 alvium_read(alvium, REG_BCRM_MINOR_VERSION_R, &bcrm, &ret); 445 alvium_read(alvium, REG_BCRM_HEARTBEAT_RW, &hbeat, &ret); 446 if (ret) 447 return ret; 448 449 return hbeat; 450 } 451 452 static void alvium_print_avail_mipi_fmt(struct alvium_dev *alvium) 453 { 454 struct device *dev = &alvium->i2c_client->dev; 455 456 dev_dbg(dev, "avail mipi_fmt yuv420_8_leg: %u\n", 457 alvium->is_mipi_fmt_avail[ALVIUM_BIT_YUV420_8_LEG]); 458 dev_dbg(dev, "avail mipi_fmt yuv420_8: %u\n", 459 alvium->is_mipi_fmt_avail[ALVIUM_BIT_YUV420_8]); 460 dev_dbg(dev, "avail mipi_fmt yuv420_10: %u\n", 461 alvium->is_mipi_fmt_avail[ALVIUM_BIT_YUV420_10]); 462 dev_dbg(dev, "avail mipi_fmt yuv420_8_csps: %u\n", 463 alvium->is_mipi_fmt_avail[ALVIUM_BIT_YUV420_8_CSPS]); 464 dev_dbg(dev, "avail mipi_fmt yuv420_10_csps: %u\n", 465 alvium->is_mipi_fmt_avail[ALVIUM_BIT_YUV420_10_CSPS]); 466 dev_dbg(dev, "avail mipi_fmt yuv422_8: %u\n", 467 alvium->is_mipi_fmt_avail[ALVIUM_BIT_YUV422_8]); 468 dev_dbg(dev, "avail mipi_fmt yuv422_10: %u\n", 469 alvium->is_mipi_fmt_avail[ALVIUM_BIT_YUV422_10]); 470 dev_dbg(dev, "avail mipi_fmt rgb888: %u\n", 471 alvium->is_mipi_fmt_avail[ALVIUM_BIT_RGB888]); 472 dev_dbg(dev, "avail mipi_fmt rgb666: %u\n", 473 alvium->is_mipi_fmt_avail[ALVIUM_BIT_RGB666]); 474 dev_dbg(dev, "avail mipi_fmt rgb565: %u\n", 475 alvium->is_mipi_fmt_avail[ALVIUM_BIT_RGB565]); 476 dev_dbg(dev, "avail mipi_fmt rgb555: %u\n", 477 alvium->is_mipi_fmt_avail[ALVIUM_BIT_RGB555]); 478 dev_dbg(dev, "avail mipi_fmt rgb444: %u\n", 479 alvium->is_mipi_fmt_avail[ALVIUM_BIT_RGB444]); 480 dev_dbg(dev, "avail mipi_fmt raw6: %u\n", 481 alvium->is_mipi_fmt_avail[ALVIUM_BIT_RAW6]); 482 dev_dbg(dev, "avail mipi_fmt raw7: %u\n", 483 alvium->is_mipi_fmt_avail[ALVIUM_BIT_RAW7]); 484 dev_dbg(dev, "avail mipi_fmt raw8: %u\n", 485 alvium->is_mipi_fmt_avail[ALVIUM_BIT_RAW8]); 486 dev_dbg(dev, "avail mipi_fmt raw10: %u\n", 487 alvium->is_mipi_fmt_avail[ALVIUM_BIT_RAW10]); 488 dev_dbg(dev, "avail mipi_fmt raw12: %u\n", 489 alvium->is_mipi_fmt_avail[ALVIUM_BIT_RAW12]); 490 dev_dbg(dev, "avail mipi_fmt raw14: %u\n", 491 alvium->is_mipi_fmt_avail[ALVIUM_BIT_RAW14]); 492 dev_dbg(dev, "avail mipi_fmt jpeg: %u\n", 493 alvium->is_mipi_fmt_avail[ALVIUM_BIT_JPEG]); 494 } 495 496 static void alvium_print_avail_feat(struct alvium_dev *alvium) 497 { 498 struct device *dev = &alvium->i2c_client->dev; 499 500 dev_dbg(dev, "feature rev_x: %u\n", alvium->avail_ft.rev_x); 501 dev_dbg(dev, "feature rev_y: %u\n", alvium->avail_ft.rev_y); 502 dev_dbg(dev, "feature int_autop: %u\n", alvium->avail_ft.int_autop); 503 dev_dbg(dev, "feature black_lvl: %u\n", alvium->avail_ft.black_lvl); 504 dev_dbg(dev, "feature gain: %u\n", alvium->avail_ft.gain); 505 dev_dbg(dev, "feature gamma: %u\n", alvium->avail_ft.gamma); 506 dev_dbg(dev, "feature contrast: %u\n", alvium->avail_ft.contrast); 507 dev_dbg(dev, "feature sat: %u\n", alvium->avail_ft.sat); 508 dev_dbg(dev, "feature hue: %u\n", alvium->avail_ft.hue); 509 dev_dbg(dev, "feature whiteb: %u\n", alvium->avail_ft.whiteb); 510 dev_dbg(dev, "feature sharp: %u\n", alvium->avail_ft.sharp); 511 dev_dbg(dev, "feature auto_exp: %u\n", alvium->avail_ft.auto_exp); 512 dev_dbg(dev, "feature auto_gain: %u\n", alvium->avail_ft.auto_gain); 513 dev_dbg(dev, "feature auto_whiteb: %u\n", alvium->avail_ft.auto_whiteb); 514 dev_dbg(dev, "feature dev_temp: %u\n", alvium->avail_ft.dev_temp); 515 dev_dbg(dev, "feature acq_abort: %u\n", alvium->avail_ft.acq_abort); 516 dev_dbg(dev, "feature acq_fr: %u\n", alvium->avail_ft.acq_fr); 517 dev_dbg(dev, "feature fr_trigger: %u\n", alvium->avail_ft.fr_trigger); 518 dev_dbg(dev, "feature exp_acq_line: %u\n", 519 alvium->avail_ft.exp_acq_line); 520 } 521 522 static void alvium_print_avail_bayer(struct alvium_dev *alvium) 523 { 524 struct device *dev = &alvium->i2c_client->dev; 525 526 dev_dbg(dev, "avail bayer mono: %u\n", 527 alvium->is_bay_avail[ALVIUM_BIT_BAY_MONO]); 528 dev_dbg(dev, "avail bayer gr: %u\n", 529 alvium->is_bay_avail[ALVIUM_BIT_BAY_GR]); 530 dev_dbg(dev, "avail bayer rg: %u\n", 531 alvium->is_bay_avail[ALVIUM_BIT_BAY_RG]); 532 dev_dbg(dev, "avail bayer gb: %u\n", 533 alvium->is_bay_avail[ALVIUM_BIT_BAY_GB]); 534 dev_dbg(dev, "avail bayer bg: %u\n", 535 alvium->is_bay_avail[ALVIUM_BIT_BAY_BG]); 536 } 537 538 static int alvium_get_feat_inq(struct alvium_dev *alvium) 539 { 540 struct alvium_avail_feat *f; 541 u64 val; 542 int ret; 543 544 ret = alvium_read(alvium, REG_BCRM_FEATURE_INQUIRY_R, &val, NULL); 545 if (ret) 546 return ret; 547 548 f = (struct alvium_avail_feat *)&val; 549 alvium->avail_ft = *f; 550 alvium_print_avail_feat(alvium); 551 552 return 0; 553 } 554 555 static int alvium_get_host_supp_csi_lanes(struct alvium_dev *alvium) 556 { 557 u64 val; 558 int ret; 559 560 ret = alvium_read(alvium, REG_BCRM_CSI2_LANE_COUNT_RW, &val, NULL); 561 if (ret) 562 return ret; 563 564 alvium->h_sup_csi_lanes = val; 565 566 return 0; 567 } 568 569 static int alvium_set_csi_lanes(struct alvium_dev *alvium) 570 { 571 struct device *dev = &alvium->i2c_client->dev; 572 u64 num_lanes; 573 int ret; 574 575 num_lanes = alvium->ep.bus.mipi_csi2.num_data_lanes; 576 577 if (num_lanes > alvium->h_sup_csi_lanes) 578 return -EINVAL; 579 580 ret = alvium_write_hshake(alvium, REG_BCRM_CSI2_LANE_COUNT_RW, 581 num_lanes); 582 if (ret) { 583 dev_err(dev, "Fail to set csi lanes reg\n"); 584 return ret; 585 } 586 587 return 0; 588 } 589 590 static int alvium_set_lp2hs_delay(struct alvium_dev *alvium) 591 { 592 struct device *dev = &alvium->i2c_client->dev; 593 int ret = 0; 594 595 /* 596 * The purpose of this reg is force a DPhy reset 597 * for the period described by the millisecond on 598 * the reg, before it starts streaming. 599 * 600 * To be clear, with that value bigger than 0 the 601 * Alvium forces a dphy-reset on all lanes for that period. 602 * That means all lanes go up into low power state. 603 * 604 */ 605 alvium_write(alvium, REG_BCRM_LP2HS_DELAY_RW, 606 ALVIUM_LP2HS_DELAY_MS, &ret); 607 if (ret) { 608 dev_err(dev, "Fail to set lp2hs delay reg\n"); 609 return ret; 610 } 611 612 return 0; 613 } 614 615 static int alvium_get_csi_clk_params(struct alvium_dev *alvium) 616 { 617 u64 min_csi_clk, max_csi_clk; 618 int ret = 0; 619 620 alvium_read(alvium, REG_BCRM_CSI2_CLOCK_MIN_R, &min_csi_clk, &ret); 621 alvium_read(alvium, REG_BCRM_CSI2_CLOCK_MAX_R, &max_csi_clk, &ret); 622 if (ret) 623 return ret; 624 625 alvium->min_csi_clk = min_csi_clk; 626 alvium->max_csi_clk = max_csi_clk; 627 628 return 0; 629 } 630 631 static int alvium_set_csi_clk(struct alvium_dev *alvium) 632 { 633 struct device *dev = &alvium->i2c_client->dev; 634 u64 csi_clk; 635 int ret; 636 637 csi_clk = clamp(alvium->ep.link_frequencies[0], 638 (u64)alvium->min_csi_clk, (u64)alvium->max_csi_clk); 639 640 if (alvium->ep.link_frequencies[0] != (u64)csi_clk) { 641 dev_warn(dev, 642 "requested csi clock (%llu MHz) out of range [%u, %u] Adjusted to %llu\n", 643 alvium->ep.link_frequencies[0], 644 alvium->min_csi_clk, alvium->max_csi_clk, csi_clk); 645 } 646 647 ret = alvium_write_hshake(alvium, REG_BCRM_CSI2_CLOCK_RW, csi_clk); 648 if (ret) { 649 dev_err(dev, "Fail to set csi clock reg\n"); 650 return ret; 651 } 652 653 alvium->link_freq = csi_clk; 654 655 return 0; 656 } 657 658 static int alvium_get_img_width_params(struct alvium_dev *alvium) 659 { 660 u64 imgw, imgw_min, imgw_max, imgw_inc; 661 int ret = 0; 662 663 alvium_read(alvium, REG_BCRM_IMG_WIDTH_RW, &imgw, &ret); 664 alvium_read(alvium, REG_BCRM_IMG_WIDTH_MIN_R, &imgw_min, &ret); 665 alvium_read(alvium, REG_BCRM_IMG_WIDTH_MAX_R, &imgw_max, &ret); 666 alvium_read(alvium, REG_BCRM_IMG_WIDTH_INC_R, &imgw_inc, &ret); 667 if (ret) 668 return ret; 669 670 alvium->dft_img_width = imgw; 671 alvium->img_min_width = imgw_min; 672 alvium->img_max_width = imgw_max; 673 alvium->img_inc_width = imgw_inc; 674 675 return 0; 676 } 677 678 static int alvium_get_img_height_params(struct alvium_dev *alvium) 679 { 680 u64 imgh, imgh_min, imgh_max, imgh_inc; 681 int ret = 0; 682 683 alvium_read(alvium, REG_BCRM_IMG_HEIGHT_RW, &imgh, &ret); 684 alvium_read(alvium, REG_BCRM_IMG_HEIGHT_MIN_R, &imgh_min, &ret); 685 alvium_read(alvium, REG_BCRM_IMG_HEIGHT_MAX_R, &imgh_max, &ret); 686 alvium_read(alvium, REG_BCRM_IMG_HEIGHT_INC_R, &imgh_inc, &ret); 687 if (ret) 688 return ret; 689 690 alvium->dft_img_height = imgh; 691 alvium->img_min_height = imgh_min; 692 alvium->img_max_height = imgh_max; 693 alvium->img_inc_height = imgh_inc; 694 695 return 0; 696 } 697 698 static int alvium_set_img_width(struct alvium_dev *alvium, u32 width) 699 { 700 struct device *dev = &alvium->i2c_client->dev; 701 int ret; 702 703 ret = alvium_write_hshake(alvium, REG_BCRM_IMG_WIDTH_RW, width); 704 if (ret) { 705 dev_err(dev, "Fail to set img width\n"); 706 return ret; 707 } 708 709 return 0; 710 } 711 712 static int alvium_set_img_height(struct alvium_dev *alvium, u32 height) 713 { 714 struct device *dev = &alvium->i2c_client->dev; 715 int ret; 716 717 ret = alvium_write_hshake(alvium, REG_BCRM_IMG_HEIGHT_RW, height); 718 if (ret) { 719 dev_err(dev, "Fail to set img height\n"); 720 return ret; 721 } 722 723 return 0; 724 } 725 726 static int alvium_set_img_offx(struct alvium_dev *alvium, u32 offx) 727 { 728 struct device *dev = &alvium->i2c_client->dev; 729 int ret; 730 731 ret = alvium_write_hshake(alvium, REG_BCRM_IMG_OFFSET_X_RW, offx); 732 if (ret) { 733 dev_err(dev, "Fail to set img offx\n"); 734 return ret; 735 } 736 737 return 0; 738 } 739 740 static int alvium_set_img_offy(struct alvium_dev *alvium, u32 offy) 741 { 742 struct device *dev = &alvium->i2c_client->dev; 743 int ret; 744 745 ret = alvium_write_hshake(alvium, REG_BCRM_IMG_OFFSET_Y_RW, offy); 746 if (ret) { 747 dev_err(dev, "Fail to set img offy\n"); 748 return ret; 749 } 750 751 return 0; 752 } 753 754 static int alvium_get_offx_params(struct alvium_dev *alvium) 755 { 756 u64 min_offx, max_offx, inc_offx; 757 int ret = 0; 758 759 alvium_read(alvium, REG_BCRM_IMG_OFFSET_X_MIN_R, &min_offx, &ret); 760 alvium_read(alvium, REG_BCRM_IMG_OFFSET_X_MAX_R, &max_offx, &ret); 761 alvium_read(alvium, REG_BCRM_IMG_OFFSET_X_INC_R, &inc_offx, &ret); 762 if (ret) 763 return ret; 764 765 alvium->min_offx = min_offx; 766 alvium->max_offx = max_offx; 767 alvium->inc_offx = inc_offx; 768 769 return 0; 770 } 771 772 static int alvium_get_offy_params(struct alvium_dev *alvium) 773 { 774 u64 min_offy, max_offy, inc_offy; 775 int ret = 0; 776 777 alvium_read(alvium, REG_BCRM_IMG_OFFSET_Y_MIN_R, &min_offy, &ret); 778 alvium_read(alvium, REG_BCRM_IMG_OFFSET_Y_MAX_R, &max_offy, &ret); 779 alvium_read(alvium, REG_BCRM_IMG_OFFSET_Y_INC_R, &inc_offy, &ret); 780 if (ret) 781 return ret; 782 783 alvium->min_offy = min_offy; 784 alvium->max_offy = max_offy; 785 alvium->inc_offy = inc_offy; 786 787 return 0; 788 } 789 790 static int alvium_get_gain_params(struct alvium_dev *alvium) 791 { 792 u64 dft_gain, min_gain, max_gain, inc_gain; 793 int ret = 0; 794 795 alvium_read(alvium, REG_BCRM_GAIN_RW, &dft_gain, &ret); 796 alvium_read(alvium, REG_BCRM_GAIN_MIN_R, &min_gain, &ret); 797 alvium_read(alvium, REG_BCRM_GAIN_MAX_R, &max_gain, &ret); 798 alvium_read(alvium, REG_BCRM_GAIN_INC_R, &inc_gain, &ret); 799 if (ret) 800 return ret; 801 802 alvium->dft_gain = dft_gain; 803 alvium->min_gain = min_gain; 804 alvium->max_gain = max_gain; 805 alvium->inc_gain = inc_gain; 806 807 return 0; 808 } 809 810 static int alvium_get_exposure_params(struct alvium_dev *alvium) 811 { 812 u64 dft_exp, min_exp, max_exp, inc_exp; 813 int ret = 0; 814 815 alvium_read(alvium, REG_BCRM_EXPOSURE_TIME_RW, &dft_exp, &ret); 816 alvium_read(alvium, REG_BCRM_EXPOSURE_TIME_MIN_R, &min_exp, &ret); 817 alvium_read(alvium, REG_BCRM_EXPOSURE_TIME_MAX_R, &max_exp, &ret); 818 alvium_read(alvium, REG_BCRM_EXPOSURE_TIME_INC_R, &inc_exp, &ret); 819 if (ret) 820 return ret; 821 822 alvium->dft_exp = dft_exp; 823 alvium->min_exp = min_exp; 824 alvium->max_exp = max_exp; 825 alvium->inc_exp = inc_exp; 826 827 return 0; 828 } 829 830 static int alvium_get_red_balance_ratio_params(struct alvium_dev *alvium) 831 { 832 u64 dft_rb, min_rb, max_rb, inc_rb; 833 int ret = 0; 834 835 alvium_read(alvium, REG_BCRM_RED_BALANCE_RATIO_RW, &dft_rb, &ret); 836 alvium_read(alvium, REG_BCRM_RED_BALANCE_RATIO_MIN_R, &min_rb, &ret); 837 alvium_read(alvium, REG_BCRM_RED_BALANCE_RATIO_MAX_R, &max_rb, &ret); 838 alvium_read(alvium, REG_BCRM_RED_BALANCE_RATIO_INC_R, &inc_rb, &ret); 839 if (ret) 840 return ret; 841 842 alvium->dft_rbalance = dft_rb; 843 alvium->min_rbalance = min_rb; 844 alvium->max_rbalance = max_rb; 845 alvium->inc_rbalance = inc_rb; 846 847 return 0; 848 } 849 850 static int alvium_get_blue_balance_ratio_params(struct alvium_dev *alvium) 851 { 852 u64 dft_bb, min_bb, max_bb, inc_bb; 853 int ret = 0; 854 855 alvium_read(alvium, REG_BCRM_BLUE_BALANCE_RATIO_RW, &dft_bb, &ret); 856 alvium_read(alvium, REG_BCRM_BLUE_BALANCE_RATIO_MIN_R, &min_bb, &ret); 857 alvium_read(alvium, REG_BCRM_BLUE_BALANCE_RATIO_MAX_R, &max_bb, &ret); 858 alvium_read(alvium, REG_BCRM_BLUE_BALANCE_RATIO_INC_R, &inc_bb, &ret); 859 if (ret) 860 return ret; 861 862 alvium->dft_bbalance = dft_bb; 863 alvium->min_bbalance = min_bb; 864 alvium->max_bbalance = max_bb; 865 alvium->inc_bbalance = inc_bb; 866 867 return 0; 868 } 869 870 static int alvium_get_hue_params(struct alvium_dev *alvium) 871 { 872 u64 dft_hue, min_hue, max_hue, inc_hue; 873 int ret = 0; 874 875 alvium_read(alvium, REG_BCRM_HUE_RW, &dft_hue, &ret); 876 alvium_read(alvium, REG_BCRM_HUE_MIN_R, &min_hue, &ret); 877 alvium_read(alvium, REG_BCRM_HUE_MAX_R, &max_hue, &ret); 878 alvium_read(alvium, REG_BCRM_HUE_INC_R, &inc_hue, &ret); 879 if (ret) 880 return ret; 881 882 alvium->dft_hue = (s32)dft_hue; 883 alvium->min_hue = (s32)min_hue; 884 alvium->max_hue = (s32)max_hue; 885 alvium->inc_hue = (s32)inc_hue; 886 887 return 0; 888 } 889 890 static int alvium_get_black_lvl_params(struct alvium_dev *alvium) 891 { 892 u64 dft_blvl, min_blvl, max_blvl, inc_blvl; 893 int ret = 0; 894 895 alvium_read(alvium, REG_BCRM_BLACK_LEVEL_RW, &dft_blvl, &ret); 896 alvium_read(alvium, REG_BCRM_BLACK_LEVEL_MIN_R, &min_blvl, &ret); 897 alvium_read(alvium, REG_BCRM_BLACK_LEVEL_MAX_R, &max_blvl, &ret); 898 alvium_read(alvium, REG_BCRM_BLACK_LEVEL_INC_R, &inc_blvl, &ret); 899 if (ret) 900 return ret; 901 902 alvium->dft_black_lvl = (s32)dft_blvl; 903 alvium->min_black_lvl = (s32)min_blvl; 904 alvium->max_black_lvl = (s32)max_blvl; 905 alvium->inc_black_lvl = (s32)inc_blvl; 906 907 return 0; 908 } 909 910 static int alvium_get_gamma_params(struct alvium_dev *alvium) 911 { 912 u64 dft_g, min_g, max_g, inc_g; 913 int ret = 0; 914 915 alvium_read(alvium, REG_BCRM_GAMMA_RW, &dft_g, &ret); 916 alvium_read(alvium, REG_BCRM_GAMMA_MIN_R, &min_g, &ret); 917 alvium_read(alvium, REG_BCRM_GAMMA_MAX_R, &max_g, &ret); 918 alvium_read(alvium, REG_BCRM_GAMMA_INC_R, &inc_g, &ret); 919 if (ret) 920 return ret; 921 922 alvium->dft_gamma = dft_g; 923 alvium->min_gamma = min_g; 924 alvium->max_gamma = max_g; 925 alvium->inc_gamma = inc_g; 926 927 return 0; 928 } 929 930 static int alvium_get_sharpness_params(struct alvium_dev *alvium) 931 { 932 u64 dft_sh, min_sh, max_sh, inc_sh; 933 int ret = 0; 934 935 alvium_read(alvium, REG_BCRM_SHARPNESS_RW, &dft_sh, &ret); 936 alvium_read(alvium, REG_BCRM_SHARPNESS_MIN_R, &min_sh, &ret); 937 alvium_read(alvium, REG_BCRM_BLACK_LEVEL_MAX_R, &max_sh, &ret); 938 alvium_read(alvium, REG_BCRM_SHARPNESS_INC_R, &inc_sh, &ret); 939 if (ret) 940 return ret; 941 942 alvium->dft_sharp = (s32)dft_sh; 943 alvium->min_sharp = (s32)min_sh; 944 alvium->max_sharp = (s32)max_sh; 945 alvium->inc_sharp = (s32)inc_sh; 946 947 return 0; 948 } 949 950 static int alvium_get_contrast_params(struct alvium_dev *alvium) 951 { 952 u64 dft_c, min_c, max_c, inc_c; 953 int ret = 0; 954 955 alvium_read(alvium, REG_BCRM_CONTRAST_VALUE_RW, &dft_c, &ret); 956 alvium_read(alvium, REG_BCRM_CONTRAST_VALUE_MIN_R, &min_c, &ret); 957 alvium_read(alvium, REG_BCRM_CONTRAST_VALUE_MAX_R, &max_c, &ret); 958 alvium_read(alvium, REG_BCRM_CONTRAST_VALUE_INC_R, &inc_c, &ret); 959 if (ret) 960 return ret; 961 962 alvium->dft_contrast = dft_c; 963 alvium->min_contrast = min_c; 964 alvium->max_contrast = max_c; 965 alvium->inc_contrast = inc_c; 966 967 return 0; 968 } 969 970 static int alvium_get_saturation_params(struct alvium_dev *alvium) 971 { 972 u64 dft_sat, min_sat, max_sat, inc_sat; 973 int ret = 0; 974 975 alvium_read(alvium, REG_BCRM_SATURATION_RW, &dft_sat, &ret); 976 alvium_read(alvium, REG_BCRM_SATURATION_MIN_R, &min_sat, &ret); 977 alvium_read(alvium, REG_BCRM_SATURATION_MAX_R, &max_sat, &ret); 978 alvium_read(alvium, REG_BCRM_SATURATION_INC_R, &inc_sat, &ret); 979 if (ret) 980 return ret; 981 982 alvium->dft_sat = dft_sat; 983 alvium->min_sat = min_sat; 984 alvium->max_sat = max_sat; 985 alvium->inc_sat = inc_sat; 986 987 return 0; 988 } 989 990 static int alvium_set_bcm_mode(struct alvium_dev *alvium) 991 { 992 int ret = 0; 993 994 alvium_write(alvium, REG_GENCP_CHANGEMODE_W, ALVIUM_BCM_MODE, &ret); 995 alvium->bcrm_mode = ALVIUM_BCM_MODE; 996 997 return ret; 998 } 999 1000 static int alvium_get_mode(struct alvium_dev *alvium) 1001 { 1002 u64 bcrm_mode; 1003 int ret; 1004 1005 ret = alvium_read(alvium, REG_GENCP_CURRENTMODE_R, &bcrm_mode, NULL); 1006 if (ret) 1007 return ret; 1008 1009 switch (bcrm_mode) { 1010 case ALVIUM_BCM_MODE: 1011 alvium->bcrm_mode = ALVIUM_BCM_MODE; 1012 break; 1013 case ALVIUM_GENCP_MODE: 1014 alvium->bcrm_mode = ALVIUM_GENCP_MODE; 1015 break; 1016 } 1017 1018 return 0; 1019 } 1020 1021 static int alvium_get_avail_mipi_data_format(struct alvium_dev *alvium) 1022 { 1023 struct alvium_avail_mipi_fmt *avail_fmt; 1024 u64 val; 1025 int ret; 1026 1027 ret = alvium_read(alvium, REG_BCRM_IMG_AVAILABLE_MIPI_DATA_FORMATS_R, 1028 &val, NULL); 1029 if (ret) 1030 return ret; 1031 1032 avail_fmt = (struct alvium_avail_mipi_fmt *)&val; 1033 1034 alvium->is_mipi_fmt_avail[ALVIUM_BIT_YUV420_8_LEG] = 1035 avail_fmt->yuv420_8_leg; 1036 alvium->is_mipi_fmt_avail[ALVIUM_BIT_YUV420_8] = 1037 avail_fmt->yuv420_8; 1038 alvium->is_mipi_fmt_avail[ALVIUM_BIT_YUV420_10] = 1039 avail_fmt->yuv420_10; 1040 alvium->is_mipi_fmt_avail[ALVIUM_BIT_YUV420_8_CSPS] = 1041 avail_fmt->yuv420_8_csps; 1042 alvium->is_mipi_fmt_avail[ALVIUM_BIT_YUV420_10_CSPS] = 1043 avail_fmt->yuv420_10_csps; 1044 alvium->is_mipi_fmt_avail[ALVIUM_BIT_YUV422_8] = 1045 avail_fmt->yuv422_8; 1046 alvium->is_mipi_fmt_avail[ALVIUM_BIT_YUV422_10] = 1047 avail_fmt->yuv422_10; 1048 alvium->is_mipi_fmt_avail[ALVIUM_BIT_RGB888] = 1049 avail_fmt->rgb888; 1050 alvium->is_mipi_fmt_avail[ALVIUM_BIT_RGB666] = 1051 avail_fmt->rgb666; 1052 alvium->is_mipi_fmt_avail[ALVIUM_BIT_RGB565] = 1053 avail_fmt->rgb565; 1054 alvium->is_mipi_fmt_avail[ALVIUM_BIT_RGB555] = 1055 avail_fmt->rgb555; 1056 alvium->is_mipi_fmt_avail[ALVIUM_BIT_RGB444] = 1057 avail_fmt->rgb444; 1058 alvium->is_mipi_fmt_avail[ALVIUM_BIT_RAW6] = 1059 avail_fmt->raw6; 1060 alvium->is_mipi_fmt_avail[ALVIUM_BIT_RAW7] = 1061 avail_fmt->raw7; 1062 alvium->is_mipi_fmt_avail[ALVIUM_BIT_RAW8] = 1063 avail_fmt->raw8; 1064 alvium->is_mipi_fmt_avail[ALVIUM_BIT_RAW10] = 1065 avail_fmt->raw10; 1066 alvium->is_mipi_fmt_avail[ALVIUM_BIT_RAW12] = 1067 avail_fmt->raw12; 1068 alvium->is_mipi_fmt_avail[ALVIUM_BIT_RAW14] = 1069 avail_fmt->raw14; 1070 alvium->is_mipi_fmt_avail[ALVIUM_BIT_JPEG] = 1071 avail_fmt->jpeg; 1072 1073 alvium_print_avail_mipi_fmt(alvium); 1074 1075 return 0; 1076 } 1077 1078 static int alvium_setup_mipi_fmt(struct alvium_dev *alvium) 1079 { 1080 unsigned int avail_fmt_cnt = 0; 1081 unsigned int fmt = 0; 1082 size_t sz = 0; 1083 1084 /* calculate fmt array size */ 1085 for (fmt = 0; fmt < ALVIUM_NUM_SUPP_MIPI_DATA_FMT; fmt++) { 1086 if (!alvium->is_mipi_fmt_avail[alvium_csi2_fmts[fmt].fmt_av_bit]) 1087 continue; 1088 1089 if (!alvium_csi2_fmts[fmt].is_raw || 1090 alvium->is_bay_avail[alvium_csi2_fmts[fmt].bay_av_bit]) 1091 sz++; 1092 } 1093 1094 /* init alvium_csi2_fmt array */ 1095 alvium->alvium_csi2_fmt_n = sz; 1096 alvium->alvium_csi2_fmt = 1097 kmalloc_array(sz, sizeof(struct alvium_pixfmt), GFP_KERNEL); 1098 if (!alvium->alvium_csi2_fmt) 1099 return -ENOMEM; 1100 1101 /* Create the alvium_csi2 fmt array from formats available */ 1102 for (fmt = 0; fmt < ALVIUM_NUM_SUPP_MIPI_DATA_FMT; fmt++) { 1103 if (!alvium->is_mipi_fmt_avail[alvium_csi2_fmts[fmt].fmt_av_bit]) 1104 continue; 1105 1106 if (!alvium_csi2_fmts[fmt].is_raw || 1107 alvium->is_bay_avail[alvium_csi2_fmts[fmt].bay_av_bit]) { 1108 alvium->alvium_csi2_fmt[avail_fmt_cnt] = 1109 alvium_csi2_fmts[fmt]; 1110 avail_fmt_cnt++; 1111 } 1112 } 1113 1114 return 0; 1115 } 1116 1117 static int alvium_set_mipi_fmt(struct alvium_dev *alvium, 1118 const struct alvium_pixfmt *pixfmt) 1119 { 1120 struct device *dev = &alvium->i2c_client->dev; 1121 int ret; 1122 1123 ret = alvium_write_hshake(alvium, REG_BCRM_IMG_MIPI_DATA_FORMAT_RW, 1124 pixfmt->mipi_fmt_regval); 1125 if (ret) { 1126 dev_err(dev, "Fail to set mipi fmt\n"); 1127 return ret; 1128 } 1129 1130 return 0; 1131 } 1132 1133 static int alvium_get_avail_bayer(struct alvium_dev *alvium) 1134 { 1135 struct alvium_avail_bayer *avail_bay; 1136 u64 val; 1137 int ret; 1138 1139 ret = alvium_read(alvium, REG_BCRM_IMG_BAYER_PATTERN_INQUIRY_R, 1140 &val, NULL); 1141 if (ret) 1142 return ret; 1143 1144 avail_bay = (struct alvium_avail_bayer *)&val; 1145 1146 alvium->is_bay_avail[ALVIUM_BIT_BAY_MONO] = avail_bay->mono; 1147 alvium->is_bay_avail[ALVIUM_BIT_BAY_GR] = avail_bay->gr; 1148 alvium->is_bay_avail[ALVIUM_BIT_BAY_RG] = avail_bay->rg; 1149 alvium->is_bay_avail[ALVIUM_BIT_BAY_GB] = avail_bay->gb; 1150 alvium->is_bay_avail[ALVIUM_BIT_BAY_BG] = avail_bay->bg; 1151 1152 alvium_print_avail_bayer(alvium); 1153 1154 return 0; 1155 } 1156 1157 static int alvium_set_bayer_pattern(struct alvium_dev *alvium, 1158 const struct alvium_pixfmt *pixfmt) 1159 { 1160 struct device *dev = &alvium->i2c_client->dev; 1161 int ret; 1162 1163 ret = alvium_write_hshake(alvium, REG_BCRM_IMG_BAYER_PATTERN_RW, 1164 pixfmt->bay_fmt_regval); 1165 if (ret) { 1166 dev_err(dev, "Fail to set bayer pattern\n"); 1167 return ret; 1168 } 1169 1170 return 0; 1171 } 1172 1173 static int alvium_get_frame_interval(struct alvium_dev *alvium, 1174 u64 *min_fr, u64 *max_fr) 1175 { 1176 int ret = 0; 1177 1178 alvium_read(alvium, REG_BCRM_ACQUISITION_FRAME_RATE_MIN_R, 1179 min_fr, &ret); 1180 alvium_read(alvium, REG_BCRM_ACQUISITION_FRAME_RATE_MAX_R, 1181 max_fr, &ret); 1182 1183 return ret; 1184 } 1185 1186 static int alvium_set_frame_rate(struct alvium_dev *alvium, u64 fr) 1187 { 1188 struct device *dev = &alvium->i2c_client->dev; 1189 int ret; 1190 1191 ret = alvium_write_hshake(alvium, REG_BCRM_ACQUISITION_FRAME_RATE_EN_RW, 1192 1); 1193 if (ret) { 1194 dev_err(dev, "Fail to set acquisition frame rate enable reg\n"); 1195 return ret; 1196 } 1197 1198 ret = alvium_write_hshake(alvium, REG_BCRM_FRAME_START_TRIGGER_MODE_RW, 1199 0); 1200 if (ret) { 1201 dev_err(dev, "Fail to set frame start trigger mode reg\n"); 1202 return ret; 1203 } 1204 1205 ret = alvium_write_hshake(alvium, REG_BCRM_ACQUISITION_FRAME_RATE_RW, 1206 fr); 1207 if (ret) { 1208 dev_err(dev, "Fail to set frame rate lanes reg\n"); 1209 return ret; 1210 } 1211 1212 dev_dbg(dev, "set frame rate: %llu us\n", fr); 1213 1214 return 0; 1215 } 1216 1217 static int alvium_set_stream_mipi(struct alvium_dev *alvium, bool on) 1218 { 1219 struct device *dev = &alvium->i2c_client->dev; 1220 int ret; 1221 1222 ret = alvium_write_hshake(alvium, on ? REG_BCRM_ACQUISITION_START_RW : 1223 REG_BCRM_ACQUISITION_STOP_RW, 0x01); 1224 if (ret) { 1225 dev_err(dev, "Fail set_stream_mipi\n"); 1226 return ret; 1227 } 1228 1229 return 0; 1230 } 1231 1232 static int alvium_get_gain(struct alvium_dev *alvium) 1233 { 1234 u64 gain; 1235 int ret; 1236 1237 /* The unit is millibel (1 mB = 0.01 dB) */ 1238 ret = alvium_read(alvium, REG_BCRM_GAIN_RW, &gain, NULL); 1239 if (ret) 1240 return ret; 1241 1242 return gain; 1243 } 1244 1245 static int alvium_set_ctrl_gain(struct alvium_dev *alvium, int gain) 1246 { 1247 struct device *dev = &alvium->i2c_client->dev; 1248 int ret; 1249 1250 /* The unit is millibel (1 mB = 0.01 dB) */ 1251 ret = alvium_write_hshake(alvium, REG_BCRM_GAIN_RW, (u64)gain); 1252 if (ret) { 1253 dev_err(dev, "Fail to set gain value reg\n"); 1254 return ret; 1255 } 1256 1257 return 0; 1258 } 1259 1260 static int alvium_set_ctrl_auto_gain(struct alvium_dev *alvium, bool on) 1261 { 1262 struct device *dev = &alvium->i2c_client->dev; 1263 int ret; 1264 1265 ret = alvium_write_hshake(alvium, REG_BCRM_GAIN_AUTO_RW, 1266 on ? 0x02 : 0x00); 1267 if (ret) { 1268 dev_err(dev, "Fail to set autogain reg\n"); 1269 return ret; 1270 } 1271 1272 return 0; 1273 } 1274 1275 static int alvium_get_exposure(struct alvium_dev *alvium) 1276 { 1277 u64 exp; 1278 int ret; 1279 1280 /* Exposure time in ns */ 1281 ret = alvium_read(alvium, REG_BCRM_EXPOSURE_TIME_RW, &exp, NULL); 1282 if (ret) 1283 return ret; 1284 1285 return exp; 1286 } 1287 1288 static int alvium_set_ctrl_auto_exposure(struct alvium_dev *alvium, bool on) 1289 { 1290 struct device *dev = &alvium->i2c_client->dev; 1291 int ret; 1292 1293 ret = alvium_write_hshake(alvium, REG_BCRM_WHITE_BALANCE_AUTO_RW, 1294 on ? 0x02 : 0x00); 1295 if (ret) { 1296 dev_err(dev, "Fail to set autoexposure reg\n"); 1297 return ret; 1298 } 1299 1300 return 0; 1301 } 1302 1303 static int alvium_set_ctrl_exposure(struct alvium_dev *alvium, int exposure_ns) 1304 { 1305 struct device *dev = &alvium->i2c_client->dev; 1306 int ret; 1307 1308 ret = alvium_write_hshake(alvium, REG_BCRM_EXPOSURE_TIME_RW, 1309 (u64)exposure_ns); 1310 if (ret) { 1311 dev_err(dev, "Fail to set exposure value reg\n"); 1312 return ret; 1313 } 1314 1315 return 0; 1316 } 1317 1318 static int alvium_set_ctrl_blue_balance_ratio(struct alvium_dev *alvium, 1319 int blue) 1320 { 1321 struct device *dev = &alvium->i2c_client->dev; 1322 int ret; 1323 1324 ret = alvium_write_hshake(alvium, REG_BCRM_BLUE_BALANCE_RATIO_RW, 1325 (u64)blue); 1326 if (ret) { 1327 dev_err(dev, "Fail to set blue ratio value reg\n"); 1328 return ret; 1329 } 1330 1331 return 0; 1332 } 1333 1334 static int alvium_set_ctrl_red_balance_ratio(struct alvium_dev *alvium, int red) 1335 { 1336 struct device *dev = &alvium->i2c_client->dev; 1337 int ret; 1338 1339 ret = alvium_write_hshake(alvium, REG_BCRM_RED_BALANCE_RATIO_RW, 1340 (u64)red); 1341 if (ret) { 1342 dev_err(dev, "Fail to set red ratio value reg\n"); 1343 return ret; 1344 } 1345 1346 return 0; 1347 } 1348 1349 static int alvium_set_ctrl_awb(struct alvium_dev *alvium, bool on) 1350 { 1351 struct device *dev = &alvium->i2c_client->dev; 1352 int ret; 1353 1354 ret = alvium_write_hshake(alvium, REG_BCRM_WHITE_BALANCE_AUTO_RW, 1355 on ? 0x02 : 0x00); 1356 if (ret) { 1357 dev_err(dev, "Fail to set awb reg\n"); 1358 return ret; 1359 } 1360 1361 return 0; 1362 } 1363 1364 static int alvium_set_ctrl_hue(struct alvium_dev *alvium, int val) 1365 { 1366 struct device *dev = &alvium->i2c_client->dev; 1367 int ret; 1368 1369 ret = alvium_write_hshake(alvium, REG_BCRM_HUE_RW, (u64)val); 1370 if (ret) { 1371 dev_err(dev, "Fail to set hue value reg\n"); 1372 return ret; 1373 } 1374 1375 return 0; 1376 } 1377 1378 static int alvium_set_ctrl_contrast(struct alvium_dev *alvium, int val) 1379 { 1380 struct device *dev = &alvium->i2c_client->dev; 1381 int ret; 1382 1383 ret = alvium_write_hshake(alvium, REG_BCRM_CONTRAST_VALUE_RW, (u64)val); 1384 if (ret) { 1385 dev_err(dev, "Fail to set contrast value reg\n"); 1386 return ret; 1387 } 1388 1389 return 0; 1390 } 1391 1392 static int alvium_set_ctrl_saturation(struct alvium_dev *alvium, int val) 1393 { 1394 struct device *dev = &alvium->i2c_client->dev; 1395 int ret; 1396 1397 ret = alvium_write_hshake(alvium, REG_BCRM_SATURATION_RW, (u64)val); 1398 if (ret) { 1399 dev_err(dev, "Fail to set contrast value reg\n"); 1400 return ret; 1401 } 1402 1403 return 0; 1404 } 1405 1406 static int alvium_set_ctrl_gamma(struct alvium_dev *alvium, int val) 1407 { 1408 struct device *dev = &alvium->i2c_client->dev; 1409 int ret; 1410 1411 ret = alvium_write_hshake(alvium, REG_BCRM_GAMMA_RW, (u64)val); 1412 if (ret) { 1413 dev_err(dev, "Fail to set gamma value reg\n"); 1414 return ret; 1415 } 1416 1417 return 0; 1418 } 1419 1420 static int alvium_set_ctrl_sharpness(struct alvium_dev *alvium, int val) 1421 { 1422 struct device *dev = &alvium->i2c_client->dev; 1423 int ret; 1424 1425 ret = alvium_write_hshake(alvium, REG_BCRM_SHARPNESS_RW, (u64)val); 1426 if (ret) { 1427 dev_err(dev, "Fail to set sharpness value reg\n"); 1428 return ret; 1429 } 1430 1431 return 0; 1432 } 1433 1434 static int alvium_set_ctrl_hflip(struct alvium_dev *alvium, int val) 1435 { 1436 struct device *dev = &alvium->i2c_client->dev; 1437 int ret; 1438 1439 ret = alvium_write_hshake(alvium, REG_BCRM_IMG_REVERSE_X_RW, (u64)val); 1440 if (ret) { 1441 dev_err(dev, "Fail to set reverse_x value reg\n"); 1442 return ret; 1443 } 1444 1445 return 0; 1446 } 1447 1448 static int alvium_set_ctrl_vflip(struct alvium_dev *alvium, int val) 1449 { 1450 struct device *dev = &alvium->i2c_client->dev; 1451 int ret; 1452 1453 ret = alvium_write_hshake(alvium, REG_BCRM_IMG_REVERSE_Y_RW, (u64)val); 1454 if (ret) { 1455 dev_err(dev, "Fail to set reverse_y value reg\n"); 1456 return ret; 1457 } 1458 1459 return 0; 1460 } 1461 1462 static int alvium_get_hw_features_params(struct alvium_dev *alvium) 1463 { 1464 struct device *dev = &alvium->i2c_client->dev; 1465 int ret; 1466 1467 ret = alvium_get_csi_clk_params(alvium); 1468 if (ret) { 1469 dev_err(dev, "Fail to read min/max csi clock regs\n"); 1470 return ret; 1471 } 1472 1473 ret = alvium_get_img_width_params(alvium); 1474 if (ret) { 1475 dev_err(dev, "Fail to read img width regs\n"); 1476 return ret; 1477 } 1478 1479 ret = alvium_get_img_height_params(alvium); 1480 if (ret) { 1481 dev_err(dev, "Fail to read img height regs\n"); 1482 return ret; 1483 } 1484 1485 ret = alvium_get_offx_params(alvium); 1486 if (ret) { 1487 dev_err(dev, "Fail to read offx regs\n"); 1488 return ret; 1489 } 1490 1491 ret = alvium_get_offy_params(alvium); 1492 if (ret) { 1493 dev_err(dev, "Fail to read offy regs\n"); 1494 return ret; 1495 } 1496 1497 ret = alvium_get_gain_params(alvium); 1498 if (ret) { 1499 dev_err(dev, "Fail to read gain regs\n"); 1500 return ret; 1501 } 1502 1503 ret = alvium_get_exposure_params(alvium); 1504 if (ret) { 1505 dev_err(dev, "Fail to read min/max exp regs\n"); 1506 return ret; 1507 } 1508 1509 ret = alvium_get_red_balance_ratio_params(alvium); 1510 if (ret) { 1511 dev_err(dev, "Fail to read red balance ratio regs\n"); 1512 return ret; 1513 } 1514 1515 ret = alvium_get_blue_balance_ratio_params(alvium); 1516 if (ret) { 1517 dev_err(dev, "Fail to read blue balance ratio regs\n"); 1518 return ret; 1519 } 1520 1521 ret = alvium_get_hue_params(alvium); 1522 if (ret) { 1523 dev_err(dev, "Fail to read hue regs\n"); 1524 return ret; 1525 } 1526 1527 ret = alvium_get_contrast_params(alvium); 1528 if (ret) { 1529 dev_err(dev, "Fail to read contrast regs\n"); 1530 return ret; 1531 } 1532 1533 ret = alvium_get_saturation_params(alvium); 1534 if (ret) { 1535 dev_err(dev, "Fail to read saturation regs\n"); 1536 return ret; 1537 } 1538 1539 ret = alvium_get_black_lvl_params(alvium); 1540 if (ret) { 1541 dev_err(dev, "Fail to read black lvl regs\n"); 1542 return ret; 1543 } 1544 1545 ret = alvium_get_gamma_params(alvium); 1546 if (ret) { 1547 dev_err(dev, "Fail to read gamma regs\n"); 1548 return ret; 1549 } 1550 1551 ret = alvium_get_sharpness_params(alvium); 1552 if (ret) { 1553 dev_err(dev, "Fail to read sharpness regs\n"); 1554 return ret; 1555 } 1556 1557 return 0; 1558 } 1559 1560 static int alvium_get_hw_info(struct alvium_dev *alvium) 1561 { 1562 struct device *dev = &alvium->i2c_client->dev; 1563 int ret; 1564 1565 ret = alvium_get_bcrm_vers(alvium); 1566 if (ret) { 1567 dev_err(dev, "Fail to read bcrm version reg\n"); 1568 return ret; 1569 } 1570 1571 ret = alvium_get_bcrm_addr(alvium); 1572 if (ret) { 1573 dev_err(dev, "Fail to bcrm address reg\n"); 1574 return ret; 1575 } 1576 1577 ret = alvium_get_fw_version(alvium); 1578 if (ret) { 1579 dev_err(dev, "Fail to read fw version reg\n"); 1580 return ret; 1581 } 1582 1583 ret = alvium_get_host_supp_csi_lanes(alvium); 1584 if (ret) { 1585 dev_err(dev, "Fail to read host supported csi lanes reg\n"); 1586 return ret; 1587 } 1588 1589 ret = alvium_get_feat_inq(alvium); 1590 if (ret) { 1591 dev_err(dev, "Fail to read bcrm feature inquiry reg\n"); 1592 return ret; 1593 } 1594 1595 ret = alvium_get_hw_features_params(alvium); 1596 if (ret) { 1597 dev_err(dev, "Fail to read features params regs\n"); 1598 return ret; 1599 } 1600 1601 ret = alvium_get_avail_mipi_data_format(alvium); 1602 if (ret) { 1603 dev_err(dev, "Fail to read available mipi data formats reg\n"); 1604 return ret; 1605 } 1606 1607 ret = alvium_get_avail_bayer(alvium); 1608 if (ret) { 1609 dev_err(dev, "Fail to read available Bayer patterns reg\n"); 1610 return ret; 1611 } 1612 1613 ret = alvium_get_mode(alvium); 1614 if (ret) { 1615 dev_err(dev, "Fail to get current mode reg\n"); 1616 return ret; 1617 } 1618 1619 return 0; 1620 } 1621 1622 static int alvium_hw_init(struct alvium_dev *alvium) 1623 { 1624 struct device *dev = &alvium->i2c_client->dev; 1625 int ret; 1626 1627 /* Set Alvium BCM mode*/ 1628 ret = alvium_set_bcm_mode(alvium); 1629 if (ret) { 1630 dev_err(dev, "Fail to set BCM mode\n"); 1631 return ret; 1632 } 1633 1634 ret = alvium_set_csi_lanes(alvium); 1635 if (ret) { 1636 dev_err(dev, "Fail to set csi lanes\n"); 1637 return ret; 1638 } 1639 1640 ret = alvium_set_csi_clk(alvium); 1641 if (ret) { 1642 dev_err(dev, "Fail to set csi clk\n"); 1643 return ret; 1644 } 1645 1646 ret = alvium_set_lp2hs_delay(alvium); 1647 if (ret) { 1648 dev_err(dev, "Fail to set lp2hs reg\n"); 1649 return ret; 1650 } 1651 1652 return 0; 1653 } 1654 1655 /* --------------- Subdev Operations --------------- */ 1656 static int alvium_s_frame_interval(struct v4l2_subdev *sd, 1657 struct v4l2_subdev_state *sd_state, 1658 struct v4l2_subdev_frame_interval *fi) 1659 { 1660 struct alvium_dev *alvium = sd_to_alvium(sd); 1661 struct device *dev = &alvium->i2c_client->dev; 1662 u64 req_fr, min_fr, max_fr; 1663 struct v4l2_fract *interval; 1664 int ret; 1665 1666 if (alvium->streaming) 1667 return -EBUSY; 1668 1669 if (fi->interval.denominator == 0) 1670 return -EINVAL; 1671 1672 ret = alvium_get_frame_interval(alvium, &min_fr, &max_fr); 1673 if (ret) { 1674 dev_err(dev, "Fail to get frame interval\n"); 1675 return ret; 1676 } 1677 1678 dev_dbg(dev, "fi->interval.numerator = %d\n", 1679 fi->interval.numerator); 1680 dev_dbg(dev, "fi->interval.denominator = %d\n", 1681 fi->interval.denominator); 1682 1683 req_fr = (u64)((fi->interval.denominator * USEC_PER_SEC) / 1684 fi->interval.numerator); 1685 req_fr = clamp(req_fr, min_fr, max_fr); 1686 1687 interval = v4l2_subdev_state_get_interval(sd_state, 0); 1688 1689 interval->numerator = fi->interval.numerator; 1690 interval->denominator = fi->interval.denominator; 1691 1692 if (fi->which != V4L2_SUBDEV_FORMAT_ACTIVE) 1693 return 0; 1694 1695 return alvium_set_frame_rate(alvium, req_fr); 1696 } 1697 1698 static int alvium_enum_mbus_code(struct v4l2_subdev *sd, 1699 struct v4l2_subdev_state *sd_state, 1700 struct v4l2_subdev_mbus_code_enum *code) 1701 { 1702 struct alvium_dev *alvium = sd_to_alvium(sd); 1703 1704 if (code->index >= alvium->alvium_csi2_fmt_n) 1705 return -EINVAL; 1706 1707 code->code = alvium->alvium_csi2_fmt[code->index].code; 1708 1709 return 0; 1710 } 1711 1712 static const struct alvium_pixfmt * 1713 alvium_code_to_pixfmt(struct alvium_dev *alvium, u32 code) 1714 { 1715 unsigned int i; 1716 1717 for (i = 0; alvium->alvium_csi2_fmt[i].code; ++i) 1718 if (alvium->alvium_csi2_fmt[i].code == code) 1719 return &alvium->alvium_csi2_fmt[i]; 1720 1721 return &alvium->alvium_csi2_fmt[0]; 1722 } 1723 1724 static int alvium_enum_frame_size(struct v4l2_subdev *sd, 1725 struct v4l2_subdev_state *state, 1726 struct v4l2_subdev_frame_size_enum *fse) 1727 { 1728 struct alvium_dev *alvium = sd_to_alvium(sd); 1729 const struct alvium_pixfmt *alvium_csi2_fmt; 1730 1731 if (fse->index) 1732 return -EINVAL; 1733 1734 alvium_csi2_fmt = alvium_code_to_pixfmt(alvium, fse->code); 1735 if (fse->code != alvium_csi2_fmt->code) 1736 return -EINVAL; 1737 1738 fse->min_width = alvium->img_min_width; 1739 fse->max_width = alvium->img_max_width; 1740 fse->min_height = alvium->img_min_height; 1741 fse->max_height = alvium->img_max_height; 1742 return 0; 1743 } 1744 1745 static int alvium_set_mode(struct alvium_dev *alvium, 1746 struct v4l2_subdev_state *state) 1747 { 1748 struct v4l2_mbus_framefmt *fmt; 1749 struct v4l2_rect *crop; 1750 int ret; 1751 1752 crop = v4l2_subdev_state_get_crop(state, 0); 1753 fmt = v4l2_subdev_state_get_format(state, 0); 1754 1755 v4l_bound_align_image(&fmt->width, alvium->img_min_width, 1756 alvium->img_max_width, 0, 1757 &fmt->height, alvium->img_min_height, 1758 alvium->img_max_height, 0, 0); 1759 1760 /* alvium don't accept negative crop left/top */ 1761 crop->left = clamp((u32)max(0, crop->left), alvium->min_offx, 1762 (u32)(alvium->img_max_width - fmt->width)); 1763 crop->top = clamp((u32)max(0, crop->top), alvium->min_offy, 1764 (u32)(alvium->img_max_height - fmt->height)); 1765 1766 ret = alvium_set_img_width(alvium, fmt->width); 1767 if (ret) 1768 return ret; 1769 1770 ret = alvium_set_img_height(alvium, fmt->height); 1771 if (ret) 1772 return ret; 1773 1774 ret = alvium_set_img_offx(alvium, crop->left); 1775 if (ret) 1776 return ret; 1777 1778 ret = alvium_set_img_offy(alvium, crop->top); 1779 if (ret) 1780 return ret; 1781 1782 return 0; 1783 } 1784 1785 static int alvium_set_framefmt(struct alvium_dev *alvium, 1786 struct v4l2_mbus_framefmt *format) 1787 { 1788 struct device *dev = &alvium->i2c_client->dev; 1789 const struct alvium_pixfmt *alvium_csi2_fmt; 1790 int ret = 0; 1791 1792 alvium_csi2_fmt = alvium_code_to_pixfmt(alvium, format->code); 1793 1794 ret = alvium_set_mipi_fmt(alvium, alvium_csi2_fmt); 1795 if (ret) 1796 return ret; 1797 1798 if (alvium_csi2_fmt->is_raw) { 1799 ret = alvium_set_bayer_pattern(alvium, alvium_csi2_fmt); 1800 if (ret) 1801 return ret; 1802 } 1803 1804 dev_dbg(dev, "start: %s, mipi_fmt_regval regval = 0x%llx", 1805 __func__, alvium_csi2_fmt->mipi_fmt_regval); 1806 1807 return ret; 1808 } 1809 1810 static int alvium_s_stream(struct v4l2_subdev *sd, int enable) 1811 { 1812 struct alvium_dev *alvium = sd_to_alvium(sd); 1813 struct i2c_client *client = v4l2_get_subdevdata(&alvium->sd); 1814 struct v4l2_mbus_framefmt *fmt; 1815 struct v4l2_subdev_state *state; 1816 int ret = 0; 1817 1818 state = v4l2_subdev_lock_and_get_active_state(sd); 1819 1820 if (enable) { 1821 ret = pm_runtime_resume_and_get(&client->dev); 1822 if (ret < 0) 1823 goto out; 1824 1825 ret = __v4l2_ctrl_handler_setup(&alvium->ctrls.handler); 1826 if (ret) 1827 goto out; 1828 1829 ret = alvium_set_mode(alvium, state); 1830 if (ret) 1831 goto out; 1832 1833 fmt = v4l2_subdev_state_get_format(state, 0); 1834 ret = alvium_set_framefmt(alvium, fmt); 1835 if (ret) 1836 goto out; 1837 1838 ret = alvium_set_stream_mipi(alvium, enable); 1839 if (ret) 1840 goto out; 1841 1842 } else { 1843 alvium_set_stream_mipi(alvium, enable); 1844 pm_runtime_mark_last_busy(&client->dev); 1845 pm_runtime_put_autosuspend(&client->dev); 1846 } 1847 1848 alvium->streaming = !!enable; 1849 v4l2_subdev_unlock_state(state); 1850 1851 return 0; 1852 1853 out: 1854 pm_runtime_put(&client->dev); 1855 v4l2_subdev_unlock_state(state); 1856 return ret; 1857 } 1858 1859 static int alvium_init_state(struct v4l2_subdev *sd, 1860 struct v4l2_subdev_state *state) 1861 { 1862 struct alvium_dev *alvium = sd_to_alvium(sd); 1863 struct alvium_mode *mode = &alvium->mode; 1864 struct v4l2_fract *interval; 1865 struct v4l2_subdev_format sd_fmt = { 1866 .which = V4L2_SUBDEV_FORMAT_TRY, 1867 .format = alvium_csi2_default_fmt, 1868 }; 1869 struct v4l2_subdev_crop sd_crop = { 1870 .which = V4L2_SUBDEV_FORMAT_TRY, 1871 .rect = { 1872 .left = mode->crop.left, 1873 .top = mode->crop.top, 1874 .width = mode->crop.width, 1875 .height = mode->crop.height, 1876 }, 1877 }; 1878 1879 *v4l2_subdev_state_get_crop(state, 0) = sd_crop.rect; 1880 *v4l2_subdev_state_get_format(state, 0) = sd_fmt.format; 1881 1882 /* Setup initial frame interval*/ 1883 interval = v4l2_subdev_state_get_interval(state, 0); 1884 interval->numerator = 1; 1885 interval->denominator = ALVIUM_DEFAULT_FR_HZ; 1886 1887 return 0; 1888 } 1889 1890 static int alvium_set_fmt(struct v4l2_subdev *sd, 1891 struct v4l2_subdev_state *sd_state, 1892 struct v4l2_subdev_format *format) 1893 { 1894 struct alvium_dev *alvium = sd_to_alvium(sd); 1895 const struct alvium_pixfmt *alvium_csi2_fmt; 1896 struct v4l2_mbus_framefmt *fmt; 1897 struct v4l2_rect *crop; 1898 1899 fmt = v4l2_subdev_state_get_format(sd_state, 0); 1900 crop = v4l2_subdev_state_get_crop(sd_state, 0); 1901 1902 v4l_bound_align_image(&format->format.width, alvium->img_min_width, 1903 alvium->img_max_width, 0, 1904 &format->format.height, alvium->img_min_height, 1905 alvium->img_max_height, 0, 0); 1906 1907 /* Adjust left and top to prevent roll over sensor area */ 1908 crop->left = clamp((u32)crop->left, (u32)0, 1909 (alvium->img_max_width - fmt->width)); 1910 crop->top = clamp((u32)crop->top, (u32)0, 1911 (alvium->img_max_height - fmt->height)); 1912 1913 /* Set also the crop width and height when set a new fmt */ 1914 crop->width = fmt->width; 1915 crop->height = fmt->height; 1916 1917 alvium_csi2_fmt = alvium_code_to_pixfmt(alvium, format->format.code); 1918 fmt->code = alvium_csi2_fmt->code; 1919 1920 *fmt = format->format; 1921 1922 return 0; 1923 } 1924 1925 static int alvium_set_selection(struct v4l2_subdev *sd, 1926 struct v4l2_subdev_state *sd_state, 1927 struct v4l2_subdev_selection *sel) 1928 { 1929 struct alvium_dev *alvium = sd_to_alvium(sd); 1930 struct v4l2_mbus_framefmt *fmt; 1931 struct v4l2_rect *crop; 1932 1933 if (sel->target != V4L2_SEL_TGT_CROP) 1934 return -EINVAL; 1935 1936 crop = v4l2_subdev_state_get_crop(sd_state, 0); 1937 fmt = v4l2_subdev_state_get_format(sd_state, 0); 1938 1939 /* 1940 * Alvium can only shift the origin of the img 1941 * then we accept only value with the same value of the actual fmt 1942 */ 1943 if (sel->r.width != fmt->width) 1944 sel->r.width = fmt->width; 1945 1946 if (sel->r.height != fmt->height) 1947 sel->r.height = fmt->height; 1948 1949 /* alvium don't accept negative crop left/top */ 1950 crop->left = clamp((u32)max(0, sel->r.left), alvium->min_offx, 1951 alvium->img_max_width - sel->r.width); 1952 crop->top = clamp((u32)max(0, sel->r.top), alvium->min_offy, 1953 alvium->img_max_height - sel->r.height); 1954 1955 sel->r = *crop; 1956 1957 return 0; 1958 } 1959 1960 static int alvium_get_selection(struct v4l2_subdev *sd, 1961 struct v4l2_subdev_state *sd_state, 1962 struct v4l2_subdev_selection *sel) 1963 { 1964 struct alvium_dev *alvium = sd_to_alvium(sd); 1965 1966 switch (sel->target) { 1967 /* Current cropping area */ 1968 case V4L2_SEL_TGT_CROP: 1969 sel->r = *v4l2_subdev_state_get_crop(sd_state, 0); 1970 break; 1971 /* Cropping bounds */ 1972 case V4L2_SEL_TGT_NATIVE_SIZE: 1973 sel->r.top = 0; 1974 sel->r.left = 0; 1975 sel->r.width = alvium->img_max_width; 1976 sel->r.height = alvium->img_max_height; 1977 break; 1978 /* Default cropping area */ 1979 case V4L2_SEL_TGT_CROP_BOUNDS: 1980 case V4L2_SEL_TGT_CROP_DEFAULT: 1981 sel->r.top = alvium->min_offy; 1982 sel->r.left = alvium->min_offx; 1983 sel->r.width = alvium->img_max_width; 1984 sel->r.height = alvium->img_max_height; 1985 break; 1986 default: 1987 return -EINVAL; 1988 } 1989 1990 return 0; 1991 } 1992 1993 static int alvium_g_volatile_ctrl(struct v4l2_ctrl *ctrl) 1994 { 1995 struct v4l2_subdev *sd = ctrl_to_sd(ctrl); 1996 struct alvium_dev *alvium = sd_to_alvium(sd); 1997 int val; 1998 1999 switch (ctrl->id) { 2000 case V4L2_CID_ANALOGUE_GAIN: 2001 val = alvium_get_gain(alvium); 2002 if (val < 0) 2003 return val; 2004 alvium->ctrls.gain->val = val; 2005 break; 2006 case V4L2_CID_EXPOSURE: 2007 val = alvium_get_exposure(alvium); 2008 if (val < 0) 2009 return val; 2010 alvium->ctrls.exposure->val = val; 2011 break; 2012 } 2013 2014 return 0; 2015 } 2016 2017 static int alvium_s_ctrl(struct v4l2_ctrl *ctrl) 2018 { 2019 struct v4l2_subdev *sd = ctrl_to_sd(ctrl); 2020 struct alvium_dev *alvium = sd_to_alvium(sd); 2021 struct i2c_client *client = v4l2_get_subdevdata(&alvium->sd); 2022 int ret; 2023 2024 /* 2025 * Applying V4L2 control value only happens 2026 * when power is up for streaming 2027 */ 2028 if (!pm_runtime_get_if_in_use(&client->dev)) 2029 return 0; 2030 2031 switch (ctrl->id) { 2032 case V4L2_CID_ANALOGUE_GAIN: 2033 ret = alvium_set_ctrl_gain(alvium, ctrl->val); 2034 break; 2035 case V4L2_CID_AUTOGAIN: 2036 ret = alvium_set_ctrl_auto_gain(alvium, ctrl->val); 2037 break; 2038 case V4L2_CID_EXPOSURE: 2039 ret = alvium_set_ctrl_exposure(alvium, ctrl->val); 2040 break; 2041 case V4L2_CID_EXPOSURE_AUTO: 2042 ret = alvium_set_ctrl_auto_exposure(alvium, ctrl->val); 2043 break; 2044 case V4L2_CID_RED_BALANCE: 2045 ret = alvium_set_ctrl_red_balance_ratio(alvium, ctrl->val); 2046 break; 2047 case V4L2_CID_BLUE_BALANCE: 2048 ret = alvium_set_ctrl_blue_balance_ratio(alvium, ctrl->val); 2049 break; 2050 case V4L2_CID_AUTO_WHITE_BALANCE: 2051 ret = alvium_set_ctrl_awb(alvium, ctrl->val); 2052 break; 2053 case V4L2_CID_HUE: 2054 ret = alvium_set_ctrl_hue(alvium, ctrl->val); 2055 break; 2056 case V4L2_CID_CONTRAST: 2057 ret = alvium_set_ctrl_contrast(alvium, ctrl->val); 2058 break; 2059 case V4L2_CID_SATURATION: 2060 ret = alvium_set_ctrl_saturation(alvium, ctrl->val); 2061 break; 2062 case V4L2_CID_GAMMA: 2063 ret = alvium_set_ctrl_gamma(alvium, ctrl->val); 2064 break; 2065 case V4L2_CID_SHARPNESS: 2066 ret = alvium_set_ctrl_sharpness(alvium, ctrl->val); 2067 break; 2068 case V4L2_CID_HFLIP: 2069 ret = alvium_set_ctrl_hflip(alvium, ctrl->val); 2070 break; 2071 case V4L2_CID_VFLIP: 2072 ret = alvium_set_ctrl_vflip(alvium, ctrl->val); 2073 break; 2074 default: 2075 ret = -EINVAL; 2076 break; 2077 } 2078 2079 pm_runtime_put(&client->dev); 2080 2081 return ret; 2082 } 2083 2084 static const struct v4l2_ctrl_ops alvium_ctrl_ops = { 2085 .g_volatile_ctrl = alvium_g_volatile_ctrl, 2086 .s_ctrl = alvium_s_ctrl, 2087 }; 2088 2089 static int alvium_ctrl_init(struct alvium_dev *alvium) 2090 { 2091 const struct v4l2_ctrl_ops *ops = &alvium_ctrl_ops; 2092 struct alvium_ctrls *ctrls = &alvium->ctrls; 2093 struct v4l2_ctrl_handler *hdl = &ctrls->handler; 2094 struct v4l2_fwnode_device_properties props; 2095 int ret; 2096 2097 v4l2_ctrl_handler_init(hdl, 32); 2098 2099 /* Pixel rate is fixed */ 2100 ctrls->pixel_rate = v4l2_ctrl_new_std(hdl, ops, 2101 V4L2_CID_PIXEL_RATE, 0, 2102 ALVIUM_DEFAULT_PIXEL_RATE_MHZ, 1, 2103 ALVIUM_DEFAULT_PIXEL_RATE_MHZ); 2104 ctrls->pixel_rate->flags |= V4L2_CTRL_FLAG_READ_ONLY; 2105 2106 /* Link freq is fixed */ 2107 ctrls->link_freq = v4l2_ctrl_new_int_menu(hdl, ops, 2108 V4L2_CID_LINK_FREQ, 2109 0, 0, &alvium->link_freq); 2110 ctrls->link_freq->flags |= V4L2_CTRL_FLAG_READ_ONLY; 2111 2112 /* Auto/manual white balance */ 2113 if (alvium->avail_ft.auto_whiteb) { 2114 ctrls->auto_wb = v4l2_ctrl_new_std(hdl, ops, 2115 V4L2_CID_AUTO_WHITE_BALANCE, 2116 0, 1, 1, 1); 2117 v4l2_ctrl_auto_cluster(3, &ctrls->auto_wb, 0, false); 2118 } 2119 2120 ctrls->blue_balance = v4l2_ctrl_new_std(hdl, ops, 2121 V4L2_CID_BLUE_BALANCE, 2122 alvium->min_bbalance, 2123 alvium->max_bbalance, 2124 alvium->inc_bbalance, 2125 alvium->dft_bbalance); 2126 ctrls->red_balance = v4l2_ctrl_new_std(hdl, ops, 2127 V4L2_CID_RED_BALANCE, 2128 alvium->min_rbalance, 2129 alvium->max_rbalance, 2130 alvium->inc_rbalance, 2131 alvium->dft_rbalance); 2132 2133 /* Auto/manual exposure */ 2134 if (alvium->avail_ft.auto_exp) { 2135 ctrls->auto_exp = 2136 v4l2_ctrl_new_std_menu(hdl, ops, 2137 V4L2_CID_EXPOSURE_AUTO, 2138 V4L2_EXPOSURE_MANUAL, 0, 2139 V4L2_EXPOSURE_AUTO); 2140 v4l2_ctrl_auto_cluster(2, &ctrls->auto_exp, 1, true); 2141 } 2142 2143 ctrls->exposure = v4l2_ctrl_new_std(hdl, ops, 2144 V4L2_CID_EXPOSURE, 2145 alvium->min_exp, 2146 alvium->max_exp, 2147 alvium->inc_exp, 2148 alvium->dft_exp); 2149 ctrls->exposure->flags |= V4L2_CTRL_FLAG_VOLATILE; 2150 2151 /* Auto/manual gain */ 2152 if (alvium->avail_ft.auto_gain) { 2153 ctrls->auto_gain = v4l2_ctrl_new_std(hdl, ops, 2154 V4L2_CID_AUTOGAIN, 2155 0, 1, 1, 1); 2156 v4l2_ctrl_auto_cluster(2, &ctrls->auto_gain, 0, true); 2157 } 2158 2159 if (alvium->avail_ft.gain) { 2160 ctrls->gain = v4l2_ctrl_new_std(hdl, ops, 2161 V4L2_CID_ANALOGUE_GAIN, 2162 alvium->min_gain, 2163 alvium->max_gain, 2164 alvium->inc_gain, 2165 alvium->dft_gain); 2166 ctrls->gain->flags |= V4L2_CTRL_FLAG_VOLATILE; 2167 } 2168 2169 if (alvium->avail_ft.sat) 2170 ctrls->saturation = v4l2_ctrl_new_std(hdl, ops, 2171 V4L2_CID_SATURATION, 2172 alvium->min_sat, 2173 alvium->max_sat, 2174 alvium->inc_sat, 2175 alvium->dft_sat); 2176 2177 if (alvium->avail_ft.hue) 2178 ctrls->hue = v4l2_ctrl_new_std(hdl, ops, 2179 V4L2_CID_HUE, 2180 alvium->min_hue, 2181 alvium->max_hue, 2182 alvium->inc_hue, 2183 alvium->dft_hue); 2184 2185 if (alvium->avail_ft.contrast) 2186 ctrls->contrast = v4l2_ctrl_new_std(hdl, ops, 2187 V4L2_CID_CONTRAST, 2188 alvium->min_contrast, 2189 alvium->max_contrast, 2190 alvium->inc_contrast, 2191 alvium->dft_contrast); 2192 2193 if (alvium->avail_ft.gamma) 2194 ctrls->gamma = v4l2_ctrl_new_std(hdl, ops, 2195 V4L2_CID_GAMMA, 2196 alvium->min_gamma, 2197 alvium->max_gamma, 2198 alvium->inc_gamma, 2199 alvium->dft_gamma); 2200 2201 if (alvium->avail_ft.sharp) 2202 ctrls->sharpness = v4l2_ctrl_new_std(hdl, ops, 2203 V4L2_CID_SHARPNESS, 2204 alvium->min_sharp, 2205 alvium->max_sharp, 2206 alvium->inc_sharp, 2207 alvium->dft_sharp); 2208 2209 if (alvium->avail_ft.rev_x) 2210 ctrls->hflip = v4l2_ctrl_new_std(hdl, ops, 2211 V4L2_CID_HFLIP, 2212 0, 1, 1, 0); 2213 2214 if (alvium->avail_ft.rev_y) 2215 ctrls->vflip = v4l2_ctrl_new_std(hdl, ops, 2216 V4L2_CID_VFLIP, 2217 0, 1, 1, 0); 2218 2219 if (hdl->error) { 2220 ret = hdl->error; 2221 goto free_ctrls; 2222 } 2223 2224 ret = v4l2_fwnode_device_parse(&alvium->i2c_client->dev, &props); 2225 if (ret) 2226 goto free_ctrls; 2227 2228 ret = v4l2_ctrl_new_fwnode_properties(hdl, ops, &props); 2229 if (ret) 2230 goto free_ctrls; 2231 2232 alvium->sd.ctrl_handler = hdl; 2233 return 0; 2234 2235 free_ctrls: 2236 v4l2_ctrl_handler_free(hdl); 2237 return ret; 2238 } 2239 2240 static const struct v4l2_subdev_core_ops alvium_core_ops = { 2241 .log_status = v4l2_ctrl_subdev_log_status, 2242 }; 2243 2244 static const struct v4l2_subdev_video_ops alvium_video_ops = { 2245 .s_stream = alvium_s_stream, 2246 }; 2247 2248 static const struct v4l2_subdev_pad_ops alvium_pad_ops = { 2249 .enum_mbus_code = alvium_enum_mbus_code, 2250 .enum_frame_size = alvium_enum_frame_size, 2251 .get_fmt = v4l2_subdev_get_fmt, 2252 .set_fmt = alvium_set_fmt, 2253 .get_selection = alvium_get_selection, 2254 .set_selection = alvium_set_selection, 2255 .get_frame_interval = v4l2_subdev_get_frame_interval, 2256 .set_frame_interval = alvium_s_frame_interval, 2257 }; 2258 2259 static const struct v4l2_subdev_internal_ops alvium_internal_ops = { 2260 .init_state = alvium_init_state, 2261 }; 2262 2263 static const struct v4l2_subdev_ops alvium_subdev_ops = { 2264 .core = &alvium_core_ops, 2265 .pad = &alvium_pad_ops, 2266 .video = &alvium_video_ops, 2267 }; 2268 2269 static int alvium_subdev_init(struct alvium_dev *alvium) 2270 { 2271 struct i2c_client *client = alvium->i2c_client; 2272 struct device *dev = &alvium->i2c_client->dev; 2273 struct v4l2_subdev *sd = &alvium->sd; 2274 int ret; 2275 2276 /* Setup the initial mode */ 2277 alvium->mode.fmt = alvium_csi2_default_fmt; 2278 alvium->mode.width = alvium_csi2_default_fmt.width; 2279 alvium->mode.height = alvium_csi2_default_fmt.height; 2280 alvium->mode.crop.left = alvium->min_offx; 2281 alvium->mode.crop.top = alvium->min_offy; 2282 alvium->mode.crop.width = alvium_csi2_default_fmt.width; 2283 alvium->mode.crop.height = alvium_csi2_default_fmt.height; 2284 2285 /* init alvium sd */ 2286 v4l2_i2c_subdev_init(sd, client, &alvium_subdev_ops); 2287 2288 sd->internal_ops = &alvium_internal_ops; 2289 sd->flags |= V4L2_SUBDEV_FL_HAS_DEVNODE; 2290 alvium->pad.flags = MEDIA_PAD_FL_SOURCE; 2291 sd->entity.function = MEDIA_ENT_F_CAM_SENSOR; 2292 2293 ret = media_entity_pads_init(&sd->entity, 1, &alvium->pad); 2294 if (ret) { 2295 dev_err(dev, "Could not register media entity\n"); 2296 return ret; 2297 } 2298 2299 ret = alvium_ctrl_init(alvium); 2300 if (ret) { 2301 dev_err(dev, "Control initialization error %d\n", ret); 2302 goto entity_cleanup; 2303 } 2304 2305 alvium->sd.state_lock = alvium->ctrls.handler.lock; 2306 2307 ret = v4l2_subdev_init_finalize(sd); 2308 if (ret < 0) { 2309 dev_err(dev, "subdev initialization error %d\n", ret); 2310 goto err_ctrls; 2311 } 2312 2313 return 0; 2314 2315 err_ctrls: 2316 v4l2_ctrl_handler_free(&alvium->ctrls.handler); 2317 entity_cleanup: 2318 media_entity_cleanup(&alvium->sd.entity); 2319 return ret; 2320 } 2321 2322 static void alvium_subdev_cleanup(struct alvium_dev *alvium) 2323 { 2324 v4l2_fwnode_endpoint_free(&alvium->ep); 2325 v4l2_subdev_cleanup(&alvium->sd); 2326 media_entity_cleanup(&alvium->sd.entity); 2327 v4l2_ctrl_handler_free(&alvium->ctrls.handler); 2328 } 2329 2330 static int alvium_get_dt_data(struct alvium_dev *alvium) 2331 { 2332 struct device *dev = &alvium->i2c_client->dev; 2333 struct fwnode_handle *fwnode = dev_fwnode(dev); 2334 struct fwnode_handle *endpoint; 2335 2336 if (!fwnode) 2337 return -EINVAL; 2338 2339 /* Only CSI2 is supported for now: */ 2340 alvium->ep.bus_type = V4L2_MBUS_CSI2_DPHY; 2341 2342 endpoint = fwnode_graph_get_endpoint_by_id(fwnode, 0, 0, 0); 2343 if (!endpoint) { 2344 dev_err(dev, "endpoint node not found\n"); 2345 return -EINVAL; 2346 } 2347 2348 if (v4l2_fwnode_endpoint_alloc_parse(endpoint, &alvium->ep)) { 2349 dev_err(dev, "could not parse endpoint\n"); 2350 goto error_out; 2351 } 2352 2353 if (!alvium->ep.nr_of_link_frequencies) { 2354 dev_err(dev, "no link frequencies defined"); 2355 goto error_out; 2356 } 2357 2358 return 0; 2359 2360 error_out: 2361 v4l2_fwnode_endpoint_free(&alvium->ep); 2362 fwnode_handle_put(endpoint); 2363 2364 return -EINVAL; 2365 } 2366 2367 static int alvium_set_power(struct alvium_dev *alvium, bool on) 2368 { 2369 int ret; 2370 2371 if (!on) 2372 return regulator_disable(alvium->reg_vcc); 2373 2374 ret = regulator_enable(alvium->reg_vcc); 2375 if (ret) 2376 return ret; 2377 2378 /* alvium boot time 7s */ 2379 msleep(7000); 2380 return 0; 2381 } 2382 2383 static int alvium_runtime_resume(struct device *dev) 2384 { 2385 struct v4l2_subdev *sd = dev_get_drvdata(dev); 2386 struct alvium_dev *alvium = sd_to_alvium(sd); 2387 int ret; 2388 2389 ret = alvium_set_power(alvium, true); 2390 if (ret) 2391 return ret; 2392 2393 ret = alvium_hw_init(alvium); 2394 if (ret) { 2395 alvium_set_power(alvium, false); 2396 return ret; 2397 } 2398 2399 return 0; 2400 } 2401 2402 static int alvium_runtime_suspend(struct device *dev) 2403 { 2404 struct v4l2_subdev *sd = dev_get_drvdata(dev); 2405 struct alvium_dev *alvium = sd_to_alvium(sd); 2406 2407 alvium_set_power(alvium, false); 2408 2409 return 0; 2410 } 2411 2412 static const struct dev_pm_ops alvium_pm_ops = { 2413 RUNTIME_PM_OPS(alvium_runtime_suspend, alvium_runtime_resume, NULL) 2414 }; 2415 2416 static int alvium_probe(struct i2c_client *client) 2417 { 2418 struct device *dev = &client->dev; 2419 struct alvium_dev *alvium; 2420 int ret; 2421 2422 alvium = devm_kzalloc(dev, sizeof(*alvium), GFP_KERNEL); 2423 if (!alvium) 2424 return -ENOMEM; 2425 2426 alvium->i2c_client = client; 2427 2428 alvium->regmap = devm_cci_regmap_init_i2c(client, 16); 2429 if (IS_ERR(alvium->regmap)) 2430 return PTR_ERR(alvium->regmap); 2431 2432 ret = alvium_get_dt_data(alvium); 2433 if (ret) 2434 return ret; 2435 2436 alvium->reg_vcc = devm_regulator_get_optional(dev, "vcc-ext-in"); 2437 if (IS_ERR(alvium->reg_vcc)) 2438 return dev_err_probe(dev, PTR_ERR(alvium->reg_vcc), 2439 "no vcc-ext-in regulator provided\n"); 2440 2441 ret = alvium_set_power(alvium, true); 2442 if (ret) 2443 goto err_powerdown; 2444 2445 if (!alvium_is_alive(alvium)) { 2446 ret = -ENODEV; 2447 dev_err_probe(dev, ret, "Device detection failed\n"); 2448 goto err_powerdown; 2449 } 2450 2451 ret = alvium_get_hw_info(alvium); 2452 if (ret) { 2453 dev_err_probe(dev, ret, "get_hw_info fail\n"); 2454 goto err_powerdown; 2455 } 2456 2457 ret = alvium_hw_init(alvium); 2458 if (ret) { 2459 dev_err_probe(dev, ret, "hw_init fail\n"); 2460 goto err_powerdown; 2461 } 2462 2463 ret = alvium_setup_mipi_fmt(alvium); 2464 if (ret) { 2465 dev_err_probe(dev, ret, "setup_mipi_fmt fail\n"); 2466 goto err_powerdown; 2467 } 2468 2469 /* 2470 * Enable runtime PM without autosuspend: 2471 * 2472 * Don't use pm autosuspend (alvium have ~7s boot time). 2473 * Alvium has been powered manually: 2474 * - mark it as active 2475 * - increase the usage count without resuming the device. 2476 */ 2477 pm_runtime_set_active(dev); 2478 pm_runtime_get_noresume(dev); 2479 pm_runtime_enable(dev); 2480 2481 /* Initialize the V4L2 subdev. */ 2482 ret = alvium_subdev_init(alvium); 2483 if (ret) 2484 goto err_pm; 2485 2486 ret = v4l2_async_register_subdev(&alvium->sd); 2487 if (ret < 0) { 2488 dev_err_probe(dev, ret, "Could not register v4l2 device\n"); 2489 goto err_subdev; 2490 } 2491 2492 return 0; 2493 2494 err_subdev: 2495 alvium_subdev_cleanup(alvium); 2496 err_pm: 2497 pm_runtime_disable(dev); 2498 pm_runtime_put_noidle(dev); 2499 kfree(alvium->alvium_csi2_fmt); 2500 err_powerdown: 2501 alvium_set_power(alvium, false); 2502 2503 return ret; 2504 } 2505 2506 static void alvium_remove(struct i2c_client *client) 2507 { 2508 struct v4l2_subdev *sd = i2c_get_clientdata(client); 2509 struct alvium_dev *alvium = sd_to_alvium(sd); 2510 struct device *dev = &alvium->i2c_client->dev; 2511 2512 v4l2_async_unregister_subdev(sd); 2513 alvium_subdev_cleanup(alvium); 2514 kfree(alvium->alvium_csi2_fmt); 2515 /* 2516 * Disable runtime PM. In case runtime PM is disabled in the kernel, 2517 * make sure to turn power off manually. 2518 */ 2519 pm_runtime_disable(dev); 2520 if (!pm_runtime_status_suspended(dev)) 2521 alvium_set_power(alvium, false); 2522 pm_runtime_set_suspended(dev); 2523 } 2524 2525 static const struct of_device_id alvium_of_ids[] = { 2526 { .compatible = "alliedvision,alvium-csi2", }, 2527 { } 2528 }; 2529 MODULE_DEVICE_TABLE(of, alvium_of_ids); 2530 2531 static struct i2c_driver alvium_i2c_driver = { 2532 .driver = { 2533 .name = "alvium-csi2", 2534 .pm = pm_ptr(&alvium_pm_ops), 2535 .of_match_table = alvium_of_ids, 2536 }, 2537 .probe = alvium_probe, 2538 .remove = alvium_remove, 2539 }; 2540 2541 module_i2c_driver(alvium_i2c_driver); 2542 2543 MODULE_DESCRIPTION("Allied Vision's Alvium Camera Driver"); 2544 MODULE_AUTHOR("Tommaso Merciai <tomm.merciai@gmail.com>"); 2545 MODULE_AUTHOR("Martin Hecht <martin.hecht@avnet.eu>"); 2546 MODULE_AUTHOR("Avnet Silica Software & Services EMEA"); 2547 MODULE_LICENSE("GPL"); 2548