1 // SPDX-License-Identifier: GPL-2.0-only 2 /* 3 * TC358746 - Parallel <-> CSI-2 Bridge 4 * 5 * Copyright 2022 Marco Felsch <kernel@pengutronix.de> 6 * 7 * Notes: 8 * - Currently only 'Parallel-in -> CSI-out' mode is supported! 9 */ 10 11 #include <linux/bitfield.h> 12 #include <linux/clk.h> 13 #include <linux/clk-provider.h> 14 #include <linux/delay.h> 15 #include <linux/i2c.h> 16 #include <linux/interrupt.h> 17 #include <linux/kernel.h> 18 #include <linux/module.h> 19 #include <linux/phy/phy-mipi-dphy.h> 20 #include <linux/property.h> 21 #include <linux/pm_runtime.h> 22 #include <linux/regmap.h> 23 #include <linux/units.h> 24 #include <media/v4l2-ctrls.h> 25 #include <media/v4l2-device.h> 26 #include <media/v4l2-fwnode.h> 27 #include <media/v4l2-mc.h> 28 29 /* 16-bit registers */ 30 #define CHIPID_REG 0x0000 31 #define CHIPID GENMASK(15, 8) 32 33 #define SYSCTL_REG 0x0002 34 #define SRESET BIT(0) 35 36 #define CONFCTL_REG 0x0004 37 #define PDATAF_MASK GENMASK(9, 8) 38 #define PDATAF_MODE0 0 39 #define PDATAF_MODE1 1 40 #define PDATAF_MODE2 2 41 #define PDATAF(val) FIELD_PREP(PDATAF_MASK, (val)) 42 #define PPEN BIT(6) 43 #define DATALANE_MASK GENMASK(1, 0) 44 45 #define FIFOCTL_REG 0x0006 46 #define DATAFMT_REG 0x0008 47 #define PDFMT(val) FIELD_PREP(GENMASK(7, 4), (val)) 48 49 #define MCLKCTL_REG 0x000c 50 #define MCLK_HIGH_MASK GENMASK(15, 8) 51 #define MCLK_LOW_MASK GENMASK(7, 0) 52 #define MCLK_HIGH(val) FIELD_PREP(MCLK_HIGH_MASK, (val)) 53 #define MCLK_LOW(val) FIELD_PREP(MCLK_LOW_MASK, (val)) 54 55 #define PLLCTL0_REG 0x0016 56 #define PLL_PRD_MASK GENMASK(15, 12) 57 #define PLL_PRD(val) FIELD_PREP(PLL_PRD_MASK, (val)) 58 #define PLL_FBD_MASK GENMASK(8, 0) 59 #define PLL_FBD(val) FIELD_PREP(PLL_FBD_MASK, (val)) 60 61 #define PLLCTL1_REG 0x0018 62 #define PLL_FRS_MASK GENMASK(11, 10) 63 #define PLL_FRS(val) FIELD_PREP(PLL_FRS_MASK, (val)) 64 #define CKEN BIT(4) 65 #define RESETB BIT(1) 66 #define PLL_EN BIT(0) 67 68 #define CLKCTL_REG 0x0020 69 #define MCLKDIV_MASK GENMASK(3, 2) 70 #define MCLKDIV(val) FIELD_PREP(MCLKDIV_MASK, (val)) 71 #define MCLKDIV_8 0 72 #define MCLKDIV_4 1 73 #define MCLKDIV_2 2 74 75 #define WORDCNT_REG 0x0022 76 #define PP_MISC_REG 0x0032 77 #define FRMSTOP BIT(15) 78 #define RSTPTR BIT(14) 79 80 /* 32-bit registers */ 81 #define CLW_DPHYCONTTX_REG 0x0100 82 #define CLW_CNTRL_REG 0x0140 83 #define D0W_CNTRL_REG 0x0144 84 #define LANEDISABLE BIT(0) 85 86 #define STARTCNTRL_REG 0x0204 87 #define START BIT(0) 88 89 #define LINEINITCNT_REG 0x0210 90 #define LPTXTIMECNT_REG 0x0214 91 #define TCLK_HEADERCNT_REG 0x0218 92 #define TCLK_ZEROCNT(val) FIELD_PREP(GENMASK(15, 8), (val)) 93 #define TCLK_PREPARECNT(val) FIELD_PREP(GENMASK(6, 0), (val)) 94 95 #define TCLK_TRAILCNT_REG 0x021C 96 #define THS_HEADERCNT_REG 0x0220 97 #define THS_ZEROCNT(val) FIELD_PREP(GENMASK(14, 8), (val)) 98 #define THS_PREPARECNT(val) FIELD_PREP(GENMASK(6, 0), (val)) 99 100 #define TWAKEUP_REG 0x0224 101 #define TCLK_POSTCNT_REG 0x0228 102 #define THS_TRAILCNT_REG 0x022C 103 #define HSTXVREGEN_REG 0x0234 104 #define TXOPTIONCNTRL_REG 0x0238 105 #define CSI_CONTROL_REG 0x040C 106 #define CSI_MODE BIT(15) 107 #define TXHSMD BIT(7) 108 #define NOL(val) FIELD_PREP(GENMASK(2, 1), (val)) 109 110 #define CSI_CONFW_REG 0x0500 111 #define MODE(val) FIELD_PREP(GENMASK(31, 29), (val)) 112 #define MODE_SET 0x5 113 #define ADDRESS(val) FIELD_PREP(GENMASK(28, 24), (val)) 114 #define CSI_CONTROL_ADDRESS 0x3 115 #define DATA(val) FIELD_PREP(GENMASK(15, 0), (val)) 116 117 #define CSI_START_REG 0x0518 118 #define STRT BIT(0) 119 120 static const struct v4l2_mbus_framefmt tc358746_def_fmt = { 121 .width = 640, 122 .height = 480, 123 .code = MEDIA_BUS_FMT_UYVY8_2X8, 124 .field = V4L2_FIELD_NONE, 125 .colorspace = V4L2_COLORSPACE_DEFAULT, 126 .ycbcr_enc = V4L2_YCBCR_ENC_DEFAULT, 127 .quantization = V4L2_QUANTIZATION_DEFAULT, 128 .xfer_func = V4L2_XFER_FUNC_DEFAULT, 129 }; 130 131 static const char * const tc358746_supplies[] = { 132 "vddc", "vddio", "vddmipi" 133 }; 134 135 enum { 136 TC358746_SINK, 137 TC358746_SOURCE, 138 TC358746_NR_PADS 139 }; 140 141 struct tc358746 { 142 struct v4l2_subdev sd; 143 struct media_pad pads[TC358746_NR_PADS]; 144 struct v4l2_async_notifier notifier; 145 struct v4l2_fwnode_endpoint csi_vep; 146 147 struct v4l2_ctrl_handler ctrl_hdl; 148 149 struct regmap *regmap; 150 struct clk *refclk; 151 struct gpio_desc *reset_gpio; 152 struct regulator_bulk_data supplies[ARRAY_SIZE(tc358746_supplies)]; 153 154 struct clk_hw mclk_hw; 155 unsigned long mclk_rate; 156 u8 mclk_prediv; 157 u16 mclk_postdiv; 158 159 unsigned long pll_rate; 160 u8 pll_post_div; 161 u16 pll_pre_div; 162 u16 pll_mul; 163 164 #define TC358746_VB_MAX_SIZE (511 * 32) 165 #define TC358746_VB_DEFAULT_SIZE (1 * 32) 166 unsigned int vb_size; /* Video buffer size in bits */ 167 168 struct phy_configure_opts_mipi_dphy dphy_cfg; 169 }; 170 171 static inline struct tc358746 *to_tc358746(struct v4l2_subdev *sd) 172 { 173 return container_of(sd, struct tc358746, sd); 174 } 175 176 static inline struct tc358746 *clk_hw_to_tc358746(struct clk_hw *hw) 177 { 178 return container_of(hw, struct tc358746, mclk_hw); 179 } 180 181 struct tc358746_format { 182 u32 code; 183 bool csi_format; 184 unsigned char bus_width; 185 unsigned char bpp; 186 /* Register values */ 187 u8 pdformat; /* Peripheral Data Format */ 188 u8 pdataf; /* Parallel Data Format Option */ 189 }; 190 191 enum { 192 PDFORMAT_RAW8 = 0, 193 PDFORMAT_RAW10, 194 PDFORMAT_RAW12, 195 PDFORMAT_RGB888, 196 PDFORMAT_RGB666, 197 PDFORMAT_RGB565, 198 PDFORMAT_YUV422_8BIT, 199 /* RESERVED = 7 */ 200 PDFORMAT_RAW14 = 8, 201 PDFORMAT_YUV422_10BIT, 202 PDFORMAT_YUV444, 203 }; 204 205 /* Check tc358746_src_mbus_code() if you add new formats */ 206 static const struct tc358746_format tc358746_formats[] = { 207 { 208 .code = MEDIA_BUS_FMT_UYVY8_2X8, 209 .bus_width = 8, 210 .bpp = 16, 211 .pdformat = PDFORMAT_YUV422_8BIT, 212 .pdataf = PDATAF_MODE0, 213 }, { 214 .code = MEDIA_BUS_FMT_UYVY8_1X16, 215 .csi_format = true, 216 .bus_width = 16, 217 .bpp = 16, 218 .pdformat = PDFORMAT_YUV422_8BIT, 219 .pdataf = PDATAF_MODE1, 220 }, { 221 .code = MEDIA_BUS_FMT_YUYV8_1X16, 222 .csi_format = true, 223 .bus_width = 16, 224 .bpp = 16, 225 .pdformat = PDFORMAT_YUV422_8BIT, 226 .pdataf = PDATAF_MODE2, 227 }, { 228 .code = MEDIA_BUS_FMT_UYVY10_2X10, 229 .bus_width = 10, 230 .bpp = 20, 231 .pdformat = PDFORMAT_YUV422_10BIT, 232 .pdataf = PDATAF_MODE0, /* don't care */ 233 } 234 }; 235 236 /* Get n-th format for pad */ 237 static const struct tc358746_format * 238 tc358746_get_format_by_idx(unsigned int pad, unsigned int index) 239 { 240 unsigned int idx = 0; 241 unsigned int i; 242 243 for (i = 0; i < ARRAY_SIZE(tc358746_formats); i++) { 244 const struct tc358746_format *fmt = &tc358746_formats[i]; 245 246 if ((pad == TC358746_SOURCE && fmt->csi_format) || 247 (pad == TC358746_SINK)) { 248 if (idx == index) 249 return fmt; 250 idx++; 251 } 252 } 253 254 return ERR_PTR(-EINVAL); 255 } 256 257 static const struct tc358746_format * 258 tc358746_get_format_by_code(unsigned int pad, u32 code) 259 { 260 unsigned int i; 261 262 for (i = 0; i < ARRAY_SIZE(tc358746_formats); i++) { 263 const struct tc358746_format *fmt = &tc358746_formats[i]; 264 265 if (pad == TC358746_SINK && fmt->code == code) 266 return fmt; 267 268 if (pad == TC358746_SOURCE && !fmt->csi_format) 269 continue; 270 271 if (fmt->code == code) 272 return fmt; 273 } 274 275 return ERR_PTR(-EINVAL); 276 } 277 278 static u32 tc358746_src_mbus_code(u32 code) 279 { 280 switch (code) { 281 case MEDIA_BUS_FMT_UYVY8_2X8: 282 return MEDIA_BUS_FMT_UYVY8_1X16; 283 case MEDIA_BUS_FMT_UYVY10_2X10: 284 return MEDIA_BUS_FMT_UYVY10_1X20; 285 default: 286 return code; 287 } 288 } 289 290 static bool tc358746_valid_reg(struct device *dev, unsigned int reg) 291 { 292 switch (reg) { 293 case CHIPID_REG ... CSI_START_REG: 294 return true; 295 default: 296 return false; 297 } 298 } 299 300 static const struct regmap_config tc358746_regmap_config = { 301 .name = "tc358746", 302 .reg_bits = 16, 303 .val_bits = 16, 304 .max_register = CSI_START_REG, 305 .writeable_reg = tc358746_valid_reg, 306 .readable_reg = tc358746_valid_reg, 307 .reg_format_endian = REGMAP_ENDIAN_BIG, 308 .val_format_endian = REGMAP_ENDIAN_BIG, 309 }; 310 311 static int tc358746_write(struct tc358746 *tc358746, u32 reg, u32 val) 312 { 313 size_t count; 314 int err; 315 316 /* 32-bit registers starting from CLW_DPHYCONTTX */ 317 count = reg < CLW_DPHYCONTTX_REG ? 1 : 2; 318 319 err = regmap_bulk_write(tc358746->regmap, reg, &val, count); 320 if (err) 321 dev_err(tc358746->sd.dev, 322 "Failed to write reg:0x%04x err:%d\n", reg, err); 323 324 return err; 325 } 326 327 static int tc358746_read(struct tc358746 *tc358746, u32 reg, u32 *val) 328 { 329 size_t count; 330 int err; 331 332 /* 32-bit registers starting from CLW_DPHYCONTTX */ 333 count = reg < CLW_DPHYCONTTX_REG ? 1 : 2; 334 *val = 0; 335 336 err = regmap_bulk_read(tc358746->regmap, reg, val, count); 337 if (err) 338 dev_err(tc358746->sd.dev, 339 "Failed to read reg:0x%04x err:%d\n", reg, err); 340 341 return err; 342 } 343 344 static int 345 tc358746_update_bits(struct tc358746 *tc358746, u32 reg, u32 mask, u32 val) 346 { 347 u32 tmp, orig; 348 int err; 349 350 err = tc358746_read(tc358746, reg, &orig); 351 if (err) 352 return err; 353 354 tmp = orig & ~mask; 355 tmp |= val & mask; 356 357 return tc358746_write(tc358746, reg, tmp); 358 } 359 360 static int tc358746_set_bits(struct tc358746 *tc358746, u32 reg, u32 bits) 361 { 362 return tc358746_update_bits(tc358746, reg, bits, bits); 363 } 364 365 static int tc358746_clear_bits(struct tc358746 *tc358746, u32 reg, u32 bits) 366 { 367 return tc358746_update_bits(tc358746, reg, bits, 0); 368 } 369 370 static int tc358746_sw_reset(struct tc358746 *tc358746) 371 { 372 int err; 373 374 err = tc358746_set_bits(tc358746, SYSCTL_REG, SRESET); 375 if (err) 376 return err; 377 378 fsleep(10); 379 380 return tc358746_clear_bits(tc358746, SYSCTL_REG, SRESET); 381 } 382 383 static int 384 tc358746_apply_pll_config(struct tc358746 *tc358746) 385 { 386 u8 post = tc358746->pll_post_div; 387 u16 pre = tc358746->pll_pre_div; 388 u16 mul = tc358746->pll_mul; 389 u32 val, mask; 390 int err; 391 392 err = tc358746_read(tc358746, PLLCTL1_REG, &val); 393 if (err) 394 return err; 395 396 /* Don't touch the PLL if running */ 397 if (FIELD_GET(PLL_EN, val) == 1) 398 return 0; 399 400 /* Pre-div and Multiplicator have a internal +1 logic */ 401 val = PLL_PRD(pre - 1) | PLL_FBD(mul - 1); 402 mask = PLL_PRD_MASK | PLL_FBD_MASK; 403 err = tc358746_update_bits(tc358746, PLLCTL0_REG, mask, val); 404 if (err) 405 return err; 406 407 val = PLL_FRS(ilog2(post)) | RESETB | PLL_EN; 408 mask = PLL_FRS_MASK | RESETB | PLL_EN; 409 err = tc358746_update_bits(tc358746, PLLCTL1_REG, mask, val); 410 if (err) 411 return err; 412 413 fsleep(1000); 414 415 return tc358746_set_bits(tc358746, PLLCTL1_REG, CKEN); 416 } 417 418 static int tc358746_apply_misc_config(struct tc358746 *tc358746) 419 { 420 const struct v4l2_mbus_framefmt *mbusfmt; 421 struct v4l2_subdev *sd = &tc358746->sd; 422 struct v4l2_subdev_state *sink_state; 423 const struct tc358746_format *fmt; 424 struct device *dev = sd->dev; 425 u32 val; 426 int err; 427 428 sink_state = v4l2_subdev_lock_and_get_active_state(sd); 429 430 mbusfmt = v4l2_subdev_state_get_format(sink_state, TC358746_SINK); 431 fmt = tc358746_get_format_by_code(TC358746_SINK, mbusfmt->code); 432 433 /* Self defined CSI user data type id's are not supported yet */ 434 val = PDFMT(fmt->pdformat); 435 dev_dbg(dev, "DATAFMT: 0x%x\n", val); 436 err = tc358746_write(tc358746, DATAFMT_REG, val); 437 if (err) 438 goto out; 439 440 val = PDATAF(fmt->pdataf); 441 dev_dbg(dev, "CONFCTL[PDATAF]: 0x%x\n", fmt->pdataf); 442 err = tc358746_update_bits(tc358746, CONFCTL_REG, PDATAF_MASK, val); 443 if (err) 444 goto out; 445 446 val = tc358746->vb_size / 32; 447 dev_dbg(dev, "FIFOCTL: %u (0x%x)\n", val, val); 448 err = tc358746_write(tc358746, FIFOCTL_REG, val); 449 if (err) 450 goto out; 451 452 /* Total number of bytes for each line/width */ 453 val = mbusfmt->width * fmt->bpp / 8; 454 dev_dbg(dev, "WORDCNT: %u (0x%x)\n", val, val); 455 err = tc358746_write(tc358746, WORDCNT_REG, val); 456 457 out: 458 v4l2_subdev_unlock_state(sink_state); 459 460 return err; 461 } 462 463 /* Use MHz as base so the div needs no u64 */ 464 static u32 tc358746_cfg_to_cnt(unsigned int cfg_val, 465 unsigned int clk_mhz, 466 unsigned int time_base) 467 { 468 return DIV_ROUND_UP(cfg_val * clk_mhz, time_base); 469 } 470 471 static u32 tc358746_ps_to_cnt(unsigned int cfg_val, 472 unsigned int clk_mhz) 473 { 474 return tc358746_cfg_to_cnt(cfg_val, clk_mhz, USEC_PER_SEC); 475 } 476 477 static u32 tc358746_us_to_cnt(unsigned int cfg_val, 478 unsigned int clk_mhz) 479 { 480 return tc358746_cfg_to_cnt(cfg_val, clk_mhz, 1); 481 } 482 483 static int tc358746_apply_dphy_config(struct tc358746 *tc358746) 484 { 485 struct phy_configure_opts_mipi_dphy *cfg = &tc358746->dphy_cfg; 486 bool non_cont_clk = !!(tc358746->csi_vep.bus.mipi_csi2.flags & 487 V4L2_MBUS_CSI2_NONCONTINUOUS_CLOCK); 488 struct device *dev = tc358746->sd.dev; 489 unsigned long hs_byte_clk, hf_clk; 490 u32 val, val2, lptxcnt; 491 int err; 492 493 /* The hs_byte_clk is also called SYSCLK in the excel sheet */ 494 hs_byte_clk = cfg->hs_clk_rate / 8; 495 hs_byte_clk /= HZ_PER_MHZ; 496 hf_clk = hs_byte_clk / 2; 497 498 val = tc358746_us_to_cnt(cfg->init, hf_clk) - 1; 499 dev_dbg(dev, "LINEINITCNT: %u (0x%x)\n", val, val); 500 err = tc358746_write(tc358746, LINEINITCNT_REG, val); 501 if (err) 502 return err; 503 504 val = tc358746_ps_to_cnt(cfg->lpx, hs_byte_clk) - 1; 505 lptxcnt = val; 506 dev_dbg(dev, "LPTXTIMECNT: %u (0x%x)\n", val, val); 507 err = tc358746_write(tc358746, LPTXTIMECNT_REG, val); 508 if (err) 509 return err; 510 511 val = tc358746_ps_to_cnt(cfg->clk_prepare, hs_byte_clk) - 1; 512 val2 = tc358746_ps_to_cnt(cfg->clk_zero, hs_byte_clk) - 1; 513 dev_dbg(dev, "TCLK_PREPARECNT: %u (0x%x)\n", val, val); 514 dev_dbg(dev, "TCLK_ZEROCNT: %u (0x%x)\n", val2, val2); 515 dev_dbg(dev, "TCLK_HEADERCNT: 0x%x\n", 516 (u32)(TCLK_PREPARECNT(val) | TCLK_ZEROCNT(val2))); 517 err = tc358746_write(tc358746, TCLK_HEADERCNT_REG, 518 TCLK_PREPARECNT(val) | TCLK_ZEROCNT(val2)); 519 if (err) 520 return err; 521 522 val = tc358746_ps_to_cnt(cfg->clk_trail, hs_byte_clk); 523 dev_dbg(dev, "TCLK_TRAILCNT: %u (0x%x)\n", val, val); 524 err = tc358746_write(tc358746, TCLK_TRAILCNT_REG, val); 525 if (err) 526 return err; 527 528 val = tc358746_ps_to_cnt(cfg->hs_prepare, hs_byte_clk) - 1; 529 val2 = tc358746_ps_to_cnt(cfg->hs_zero, hs_byte_clk) - 1; 530 dev_dbg(dev, "THS_PREPARECNT: %u (0x%x)\n", val, val); 531 dev_dbg(dev, "THS_ZEROCNT: %u (0x%x)\n", val2, val2); 532 dev_dbg(dev, "THS_HEADERCNT: 0x%x\n", 533 (u32)(THS_PREPARECNT(val) | THS_ZEROCNT(val2))); 534 err = tc358746_write(tc358746, THS_HEADERCNT_REG, 535 THS_PREPARECNT(val) | THS_ZEROCNT(val2)); 536 if (err) 537 return err; 538 539 /* TWAKEUP > 1ms in lptxcnt steps */ 540 val = tc358746_us_to_cnt(cfg->wakeup, hs_byte_clk); 541 val = val / (lptxcnt + 1) - 1; 542 dev_dbg(dev, "TWAKEUP: %u (0x%x)\n", val, val); 543 err = tc358746_write(tc358746, TWAKEUP_REG, val); 544 if (err) 545 return err; 546 547 val = tc358746_ps_to_cnt(cfg->clk_post, hs_byte_clk); 548 dev_dbg(dev, "TCLK_POSTCNT: %u (0x%x)\n", val, val); 549 err = tc358746_write(tc358746, TCLK_POSTCNT_REG, val); 550 if (err) 551 return err; 552 553 val = tc358746_ps_to_cnt(cfg->hs_trail, hs_byte_clk); 554 dev_dbg(dev, "THS_TRAILCNT: %u (0x%x)\n", val, val); 555 err = tc358746_write(tc358746, THS_TRAILCNT_REG, val); 556 if (err) 557 return err; 558 559 dev_dbg(dev, "CONTCLKMODE: %u", non_cont_clk ? 0 : 1); 560 561 return tc358746_write(tc358746, TXOPTIONCNTRL_REG, non_cont_clk ? 0 : 1); 562 } 563 564 #define MAX_DATA_LANES 4 565 566 static int tc358746_enable_csi_lanes(struct tc358746 *tc358746, int enable) 567 { 568 unsigned int lanes = tc358746->dphy_cfg.lanes; 569 unsigned int lane; 570 u32 reg, val; 571 int err; 572 573 err = tc358746_update_bits(tc358746, CONFCTL_REG, DATALANE_MASK, 574 lanes - 1); 575 if (err) 576 return err; 577 578 /* Clock lane */ 579 val = enable ? 0 : LANEDISABLE; 580 dev_dbg(tc358746->sd.dev, "CLW_CNTRL: 0x%x\n", val); 581 err = tc358746_write(tc358746, CLW_CNTRL_REG, val); 582 if (err) 583 return err; 584 585 for (lane = 0; lane < MAX_DATA_LANES; lane++) { 586 /* Data lanes */ 587 reg = D0W_CNTRL_REG + lane * 0x4; 588 val = (enable && lane < lanes) ? 0 : LANEDISABLE; 589 590 dev_dbg(tc358746->sd.dev, "D%uW_CNTRL: 0x%x\n", lane, val); 591 err = tc358746_write(tc358746, reg, val); 592 if (err) 593 return err; 594 } 595 596 val = 0; 597 if (enable) { 598 /* Clock lane */ 599 val |= BIT(0); 600 601 /* Data lanes */ 602 for (lane = 1; lane <= lanes; lane++) 603 val |= BIT(lane); 604 } 605 606 dev_dbg(tc358746->sd.dev, "HSTXVREGEN: 0x%x\n", val); 607 608 return tc358746_write(tc358746, HSTXVREGEN_REG, val); 609 } 610 611 static int tc358746_enable_csi_module(struct tc358746 *tc358746, int enable) 612 { 613 unsigned int lanes = tc358746->dphy_cfg.lanes; 614 int err; 615 616 /* 617 * START and STRT are only reseted/disabled by sw reset. This is 618 * required to put the lane state back into LP-11 state. The sw reset 619 * don't reset register values. 620 */ 621 if (!enable) 622 return tc358746_sw_reset(tc358746); 623 624 err = tc358746_write(tc358746, STARTCNTRL_REG, START); 625 if (err) 626 return err; 627 628 err = tc358746_write(tc358746, CSI_START_REG, STRT); 629 if (err) 630 return err; 631 632 /* CSI_CONTROL_REG is only indirect accessible */ 633 return tc358746_write(tc358746, CSI_CONFW_REG, 634 MODE(MODE_SET) | 635 ADDRESS(CSI_CONTROL_ADDRESS) | 636 DATA(CSI_MODE | TXHSMD | NOL(lanes - 1))); 637 } 638 639 static int tc358746_enable_parallel_port(struct tc358746 *tc358746, int enable) 640 { 641 int err; 642 643 if (enable) { 644 err = tc358746_write(tc358746, PP_MISC_REG, 0); 645 if (err) 646 return err; 647 648 return tc358746_set_bits(tc358746, CONFCTL_REG, PPEN); 649 } 650 651 err = tc358746_set_bits(tc358746, PP_MISC_REG, FRMSTOP); 652 if (err) 653 return err; 654 655 err = tc358746_clear_bits(tc358746, CONFCTL_REG, PPEN); 656 if (err) 657 return err; 658 659 return tc358746_set_bits(tc358746, PP_MISC_REG, RSTPTR); 660 } 661 662 static inline struct v4l2_subdev *tc358746_get_remote_sd(struct media_pad *pad) 663 { 664 pad = media_pad_remote_pad_first(pad); 665 if (!pad) 666 return NULL; 667 668 return media_entity_to_v4l2_subdev(pad->entity); 669 } 670 671 static int tc358746_s_stream(struct v4l2_subdev *sd, int enable) 672 { 673 struct tc358746 *tc358746 = to_tc358746(sd); 674 struct v4l2_subdev *src; 675 int err; 676 677 dev_dbg(sd->dev, "%sable\n", enable ? "en" : "dis"); 678 679 src = tc358746_get_remote_sd(&tc358746->pads[TC358746_SINK]); 680 if (!src) 681 return -EPIPE; 682 683 if (enable) { 684 err = pm_runtime_resume_and_get(sd->dev); 685 if (err) 686 return err; 687 688 err = tc358746_apply_dphy_config(tc358746); 689 if (err) 690 goto err_out; 691 692 err = tc358746_apply_misc_config(tc358746); 693 if (err) 694 goto err_out; 695 696 err = tc358746_enable_csi_lanes(tc358746, 1); 697 if (err) 698 goto err_out; 699 700 err = tc358746_enable_csi_module(tc358746, 1); 701 if (err) 702 goto err_out; 703 704 err = tc358746_enable_parallel_port(tc358746, 1); 705 if (err) 706 goto err_out; 707 708 err = v4l2_subdev_call(src, video, s_stream, 1); 709 if (err) 710 goto err_out; 711 712 return 0; 713 714 err_out: 715 pm_runtime_mark_last_busy(sd->dev); 716 pm_runtime_put_sync_autosuspend(sd->dev); 717 718 return err; 719 } 720 721 /* 722 * The lanes must be disabled first (before the csi module) so the 723 * LP-11 state is entered correctly. 724 */ 725 err = tc358746_enable_csi_lanes(tc358746, 0); 726 if (err) 727 return err; 728 729 err = tc358746_enable_csi_module(tc358746, 0); 730 if (err) 731 return err; 732 733 err = tc358746_enable_parallel_port(tc358746, 0); 734 if (err) 735 return err; 736 737 pm_runtime_mark_last_busy(sd->dev); 738 pm_runtime_put_sync_autosuspend(sd->dev); 739 740 return v4l2_subdev_call(src, video, s_stream, 0); 741 } 742 743 static int tc358746_init_state(struct v4l2_subdev *sd, 744 struct v4l2_subdev_state *state) 745 { 746 struct v4l2_mbus_framefmt *fmt; 747 748 fmt = v4l2_subdev_state_get_format(state, TC358746_SINK); 749 *fmt = tc358746_def_fmt; 750 751 fmt = v4l2_subdev_state_get_format(state, TC358746_SOURCE); 752 *fmt = tc358746_def_fmt; 753 fmt->code = tc358746_src_mbus_code(tc358746_def_fmt.code); 754 755 return 0; 756 } 757 758 static int tc358746_enum_mbus_code(struct v4l2_subdev *sd, 759 struct v4l2_subdev_state *sd_state, 760 struct v4l2_subdev_mbus_code_enum *code) 761 { 762 const struct tc358746_format *fmt; 763 764 fmt = tc358746_get_format_by_idx(code->pad, code->index); 765 if (IS_ERR(fmt)) 766 return PTR_ERR(fmt); 767 768 code->code = fmt->code; 769 770 return 0; 771 } 772 773 static int tc358746_set_fmt(struct v4l2_subdev *sd, 774 struct v4l2_subdev_state *sd_state, 775 struct v4l2_subdev_format *format) 776 { 777 struct v4l2_mbus_framefmt *src_fmt, *sink_fmt; 778 const struct tc358746_format *fmt; 779 780 /* Source follows the sink */ 781 if (format->pad == TC358746_SOURCE) 782 return v4l2_subdev_get_fmt(sd, sd_state, format); 783 784 sink_fmt = v4l2_subdev_state_get_format(sd_state, TC358746_SINK); 785 786 fmt = tc358746_get_format_by_code(format->pad, format->format.code); 787 if (IS_ERR(fmt)) { 788 fmt = tc358746_get_format_by_code(format->pad, tc358746_def_fmt.code); 789 // Can't happen, but just in case... 790 if (WARN_ON(IS_ERR(fmt))) 791 return -EINVAL; 792 } 793 794 format->format.code = fmt->code; 795 format->format.field = V4L2_FIELD_NONE; 796 797 dev_dbg(sd->dev, "Update format: %ux%u code:0x%x -> %ux%u code:0x%x", 798 sink_fmt->width, sink_fmt->height, sink_fmt->code, 799 format->format.width, format->format.height, format->format.code); 800 801 *sink_fmt = format->format; 802 803 src_fmt = v4l2_subdev_state_get_format(sd_state, TC358746_SOURCE); 804 *src_fmt = *sink_fmt; 805 src_fmt->code = tc358746_src_mbus_code(sink_fmt->code); 806 807 return 0; 808 } 809 810 static unsigned long tc358746_find_pll_settings(struct tc358746 *tc358746, 811 unsigned long refclk, 812 unsigned long fout) 813 814 { 815 struct device *dev = tc358746->sd.dev; 816 unsigned long best_freq = 0; 817 u32 min_delta = 0xffffffff; 818 u16 prediv_max = 17; 819 u16 prediv_min = 1; 820 u16 m_best = 0, mul; 821 u16 p_best = 1, p; 822 u8 postdiv; 823 824 if (fout > 1000 * HZ_PER_MHZ) { 825 dev_err(dev, "HS-Clock above 1 Ghz are not supported\n"); 826 return 0; 827 } 828 829 if (fout >= 500 * HZ_PER_MHZ) 830 postdiv = 1; 831 else if (fout >= 250 * HZ_PER_MHZ) 832 postdiv = 2; 833 else if (fout >= 125 * HZ_PER_MHZ) 834 postdiv = 4; 835 else 836 postdiv = 8; 837 838 for (p = prediv_min; p <= prediv_max; p++) { 839 unsigned long delta, fin; 840 u64 tmp; 841 842 fin = DIV_ROUND_CLOSEST(refclk, p); 843 if (fin < 4 * HZ_PER_MHZ || fin > 40 * HZ_PER_MHZ) 844 continue; 845 846 tmp = fout * postdiv; 847 mul = div64_ul(tmp, fin); 848 if (mul > 511) 849 continue; 850 851 tmp = mul * fin; 852 do_div(tmp, postdiv); 853 854 delta = abs(fout - tmp); 855 if (delta < min_delta) { 856 p_best = p; 857 m_best = mul; 858 min_delta = delta; 859 best_freq = tmp; 860 } 861 862 if (delta == 0) 863 break; 864 } 865 866 if (!best_freq) { 867 dev_err(dev, "Failed find PLL frequency\n"); 868 return 0; 869 } 870 871 tc358746->pll_post_div = postdiv; 872 tc358746->pll_pre_div = p_best; 873 tc358746->pll_mul = m_best; 874 875 if (best_freq != fout) 876 dev_warn(dev, "Request PLL freq:%lu, found PLL freq:%lu\n", 877 fout, best_freq); 878 879 dev_dbg(dev, "Found PLL settings: freq:%lu prediv:%u multi:%u postdiv:%u\n", 880 best_freq, p_best, m_best, postdiv); 881 882 return best_freq; 883 } 884 885 #define TC358746_PRECISION 10 886 887 static int 888 tc358746_link_validate(struct v4l2_subdev *sd, struct media_link *link, 889 struct v4l2_subdev_format *source_fmt, 890 struct v4l2_subdev_format *sink_fmt) 891 { 892 struct tc358746 *tc358746 = to_tc358746(sd); 893 unsigned long csi_bitrate, source_bitrate; 894 struct v4l2_subdev_state *sink_state; 895 struct v4l2_mbus_framefmt *mbusfmt; 896 const struct tc358746_format *fmt; 897 unsigned int fifo_sz, tmp, n; 898 struct v4l2_subdev *source; 899 s64 source_link_freq; 900 int err; 901 902 err = v4l2_subdev_link_validate_default(sd, link, source_fmt, sink_fmt); 903 if (err) 904 return err; 905 906 sink_state = v4l2_subdev_lock_and_get_active_state(sd); 907 mbusfmt = v4l2_subdev_state_get_format(sink_state, TC358746_SINK); 908 909 /* Check the FIFO settings */ 910 fmt = tc358746_get_format_by_code(TC358746_SINK, mbusfmt->code); 911 912 source = media_entity_to_v4l2_subdev(link->source->entity); 913 source_link_freq = v4l2_get_link_freq(source->ctrl_handler, 0, 0); 914 if (source_link_freq <= 0) { 915 dev_err(tc358746->sd.dev, 916 "Failed to query or invalid source link frequency\n"); 917 v4l2_subdev_unlock_state(sink_state); 918 /* Return -EINVAL in case of source_link_freq is 0 */ 919 return source_link_freq ? : -EINVAL; 920 } 921 source_bitrate = source_link_freq * fmt->bus_width; 922 923 csi_bitrate = tc358746->dphy_cfg.lanes * tc358746->pll_rate; 924 925 dev_dbg(tc358746->sd.dev, 926 "Fifo settings params: source-bitrate:%lu csi-bitrate:%lu", 927 source_bitrate, csi_bitrate); 928 929 /* Avoid possible FIFO overflows */ 930 if (csi_bitrate < source_bitrate) { 931 v4l2_subdev_unlock_state(sink_state); 932 return -EINVAL; 933 } 934 935 /* Best case */ 936 if (csi_bitrate == source_bitrate) { 937 fifo_sz = TC358746_VB_DEFAULT_SIZE; 938 tc358746->vb_size = TC358746_VB_DEFAULT_SIZE; 939 goto out; 940 } 941 942 /* 943 * Avoid possible FIFO underflow in case of 944 * csi_bitrate > source_bitrate. For such case the chip has a internal 945 * fifo which can be used to delay the line output. 946 * 947 * Fifo size calculation (excluding precision): 948 * 949 * fifo-sz, image-width - in bits 950 * sbr - source_bitrate in bits/s 951 * csir - csi_bitrate in bits/s 952 * 953 * image-width / csir >= (image-width - fifo-sz) / sbr 954 * image-width * sbr / csir >= image-width - fifo-sz 955 * fifo-sz >= image-width - image-width * sbr / csir; with n = csir/sbr 956 * fifo-sz >= image-width - image-width / n 957 */ 958 959 source_bitrate /= TC358746_PRECISION; 960 n = csi_bitrate / source_bitrate; 961 tmp = (mbusfmt->width * TC358746_PRECISION) / n; 962 fifo_sz = mbusfmt->width - tmp; 963 fifo_sz *= fmt->bpp; 964 tc358746->vb_size = round_up(fifo_sz, 32); 965 966 out: 967 dev_dbg(tc358746->sd.dev, 968 "Found FIFO size[bits]:%u -> aligned to size[bits]:%u\n", 969 fifo_sz, tc358746->vb_size); 970 971 v4l2_subdev_unlock_state(sink_state); 972 973 return tc358746->vb_size > TC358746_VB_MAX_SIZE ? -EINVAL : 0; 974 } 975 976 static int tc358746_get_mbus_config(struct v4l2_subdev *sd, unsigned int pad, 977 struct v4l2_mbus_config *config) 978 { 979 struct tc358746 *tc358746 = to_tc358746(sd); 980 981 if (pad != TC358746_SOURCE) 982 return -EINVAL; 983 984 config->type = V4L2_MBUS_CSI2_DPHY; 985 config->bus.mipi_csi2 = tc358746->csi_vep.bus.mipi_csi2; 986 987 return 0; 988 } 989 990 static int __maybe_unused 991 tc358746_g_register(struct v4l2_subdev *sd, struct v4l2_dbg_register *reg) 992 { 993 struct tc358746 *tc358746 = to_tc358746(sd); 994 u32 val; 995 int err; 996 997 /* 32-bit registers starting from CLW_DPHYCONTTX */ 998 reg->size = reg->reg < CLW_DPHYCONTTX_REG ? 2 : 4; 999 1000 if (!pm_runtime_get_if_in_use(sd->dev)) 1001 return 0; 1002 1003 err = tc358746_read(tc358746, reg->reg, &val); 1004 reg->val = val; 1005 1006 pm_runtime_mark_last_busy(sd->dev); 1007 pm_runtime_put_sync_autosuspend(sd->dev); 1008 1009 return err; 1010 } 1011 1012 static int __maybe_unused 1013 tc358746_s_register(struct v4l2_subdev *sd, const struct v4l2_dbg_register *reg) 1014 { 1015 struct tc358746 *tc358746 = to_tc358746(sd); 1016 1017 if (!pm_runtime_get_if_in_use(sd->dev)) 1018 return 0; 1019 1020 tc358746_write(tc358746, (u32)reg->reg, (u32)reg->val); 1021 1022 pm_runtime_mark_last_busy(sd->dev); 1023 pm_runtime_put_sync_autosuspend(sd->dev); 1024 1025 return 0; 1026 } 1027 1028 static const struct v4l2_subdev_core_ops tc358746_core_ops = { 1029 #ifdef CONFIG_VIDEO_ADV_DEBUG 1030 .g_register = tc358746_g_register, 1031 .s_register = tc358746_s_register, 1032 #endif 1033 }; 1034 1035 static const struct v4l2_subdev_video_ops tc358746_video_ops = { 1036 .s_stream = tc358746_s_stream, 1037 }; 1038 1039 static const struct v4l2_subdev_pad_ops tc358746_pad_ops = { 1040 .enum_mbus_code = tc358746_enum_mbus_code, 1041 .set_fmt = tc358746_set_fmt, 1042 .get_fmt = v4l2_subdev_get_fmt, 1043 .link_validate = tc358746_link_validate, 1044 .get_mbus_config = tc358746_get_mbus_config, 1045 }; 1046 1047 static const struct v4l2_subdev_ops tc358746_ops = { 1048 .core = &tc358746_core_ops, 1049 .video = &tc358746_video_ops, 1050 .pad = &tc358746_pad_ops, 1051 }; 1052 1053 static const struct v4l2_subdev_internal_ops tc358746_internal_ops = { 1054 .init_state = tc358746_init_state, 1055 }; 1056 1057 static const struct media_entity_operations tc358746_entity_ops = { 1058 .get_fwnode_pad = v4l2_subdev_get_fwnode_pad_1_to_1, 1059 .link_validate = v4l2_subdev_link_validate, 1060 }; 1061 1062 static int tc358746_mclk_enable(struct clk_hw *hw) 1063 { 1064 struct tc358746 *tc358746 = clk_hw_to_tc358746(hw); 1065 unsigned int div; 1066 u32 val; 1067 int err; 1068 1069 div = tc358746->mclk_postdiv / 2; 1070 val = MCLK_HIGH(div - 1) | MCLK_LOW(div - 1); 1071 dev_dbg(tc358746->sd.dev, "MCLKCTL: %u (0x%x)\n", val, val); 1072 err = tc358746_write(tc358746, MCLKCTL_REG, val); 1073 if (err) 1074 return err; 1075 1076 if (tc358746->mclk_prediv == 8) 1077 val = MCLKDIV(MCLKDIV_8); 1078 else if (tc358746->mclk_prediv == 4) 1079 val = MCLKDIV(MCLKDIV_4); 1080 else 1081 val = MCLKDIV(MCLKDIV_2); 1082 1083 dev_dbg(tc358746->sd.dev, "CLKCTL[MCLKDIV]: %u (0x%x)\n", val, val); 1084 1085 return tc358746_update_bits(tc358746, CLKCTL_REG, MCLKDIV_MASK, val); 1086 } 1087 1088 static void tc358746_mclk_disable(struct clk_hw *hw) 1089 { 1090 struct tc358746 *tc358746 = clk_hw_to_tc358746(hw); 1091 1092 tc358746_write(tc358746, MCLKCTL_REG, 0); 1093 } 1094 1095 static long 1096 tc358746_find_mclk_settings(struct tc358746 *tc358746, unsigned long mclk_rate) 1097 { 1098 unsigned long pll_rate = tc358746->pll_rate; 1099 const unsigned char prediv[] = { 2, 4, 8 }; 1100 unsigned int mclk_prediv, mclk_postdiv; 1101 struct device *dev = tc358746->sd.dev; 1102 unsigned int postdiv, mclkdiv; 1103 unsigned long best_mclk_rate; 1104 unsigned int i; 1105 1106 /* 1107 * MCLK-Div 1108 * -------------------´`--------------------- 1109 * ´ ` 1110 * +-------------+ +------------------------+ 1111 * | MCLK-PreDiv | | MCLK-PostDiv | 1112 * PLL --> | (2/4/8) | --> | (mclk_low + mclk_high) | --> MCLK 1113 * +-------------+ +------------------------+ 1114 * 1115 * The register value of mclk_low/high is mclk_low/high+1, i.e.: 1116 * mclk_low/high = 1 --> 2 MCLK-Ref Counts 1117 * mclk_low/high = 255 --> 256 MCLK-Ref Counts == max. 1118 * If mclk_low and mclk_high are 0 then MCLK is disabled. 1119 * 1120 * Keep it simple and support 50/50 duty cycles only for now, 1121 * so the calc will be: 1122 * 1123 * MCLK = PLL / (MCLK-PreDiv * 2 * MCLK-PostDiv) 1124 */ 1125 1126 if (mclk_rate == tc358746->mclk_rate) 1127 return mclk_rate; 1128 1129 /* Highest possible rate */ 1130 mclkdiv = pll_rate / mclk_rate; 1131 if (mclkdiv <= 8) { 1132 mclk_prediv = 2; 1133 mclk_postdiv = 4; 1134 best_mclk_rate = pll_rate / (2 * 4); 1135 goto out; 1136 } 1137 1138 /* First check the prediv */ 1139 for (i = 0; i < ARRAY_SIZE(prediv); i++) { 1140 postdiv = mclkdiv / prediv[i]; 1141 1142 if (postdiv % 2) 1143 continue; 1144 1145 if (postdiv >= 4 && postdiv <= 512) { 1146 mclk_prediv = prediv[i]; 1147 mclk_postdiv = postdiv; 1148 best_mclk_rate = pll_rate / (prediv[i] * postdiv); 1149 goto out; 1150 } 1151 } 1152 1153 /* No suitable prediv found, so try to adjust the postdiv */ 1154 for (postdiv = 4; postdiv <= 512; postdiv += 2) { 1155 unsigned int pre; 1156 1157 pre = mclkdiv / postdiv; 1158 if (pre == 2 || pre == 4 || pre == 8) { 1159 mclk_prediv = pre; 1160 mclk_postdiv = postdiv; 1161 best_mclk_rate = pll_rate / (pre * postdiv); 1162 goto out; 1163 } 1164 } 1165 1166 /* The MCLK <-> PLL gap is to high -> use largest possible div */ 1167 mclk_prediv = 8; 1168 mclk_postdiv = 512; 1169 best_mclk_rate = pll_rate / (8 * 512); 1170 1171 out: 1172 tc358746->mclk_prediv = mclk_prediv; 1173 tc358746->mclk_postdiv = mclk_postdiv; 1174 tc358746->mclk_rate = best_mclk_rate; 1175 1176 if (best_mclk_rate != mclk_rate) 1177 dev_warn(dev, "Request MCLK freq:%lu, found MCLK freq:%lu\n", 1178 mclk_rate, best_mclk_rate); 1179 1180 dev_dbg(dev, "Found MCLK settings: freq:%lu prediv:%u postdiv:%u\n", 1181 best_mclk_rate, mclk_prediv, mclk_postdiv); 1182 1183 return best_mclk_rate; 1184 } 1185 1186 static unsigned long 1187 tc358746_recalc_rate(struct clk_hw *hw, unsigned long parent_rate) 1188 { 1189 struct tc358746 *tc358746 = clk_hw_to_tc358746(hw); 1190 unsigned int prediv, postdiv; 1191 u32 val; 1192 int err; 1193 1194 err = tc358746_read(tc358746, MCLKCTL_REG, &val); 1195 if (err) 1196 return 0; 1197 1198 postdiv = FIELD_GET(MCLK_LOW_MASK, val) + 1; 1199 postdiv += FIELD_GET(MCLK_HIGH_MASK, val) + 1; 1200 1201 err = tc358746_read(tc358746, CLKCTL_REG, &val); 1202 if (err) 1203 return 0; 1204 1205 prediv = FIELD_GET(MCLKDIV_MASK, val); 1206 if (prediv == MCLKDIV_8) 1207 prediv = 8; 1208 else if (prediv == MCLKDIV_4) 1209 prediv = 4; 1210 else 1211 prediv = 2; 1212 1213 return tc358746->pll_rate / (prediv * postdiv); 1214 } 1215 1216 static long tc358746_mclk_round_rate(struct clk_hw *hw, unsigned long rate, 1217 unsigned long *parent_rate) 1218 { 1219 struct tc358746 *tc358746 = clk_hw_to_tc358746(hw); 1220 1221 *parent_rate = tc358746->pll_rate; 1222 1223 return tc358746_find_mclk_settings(tc358746, rate); 1224 } 1225 1226 static int tc358746_mclk_set_rate(struct clk_hw *hw, unsigned long rate, 1227 unsigned long parent_rate) 1228 { 1229 struct tc358746 *tc358746 = clk_hw_to_tc358746(hw); 1230 1231 tc358746_find_mclk_settings(tc358746, rate); 1232 1233 return tc358746_mclk_enable(hw); 1234 } 1235 1236 static const struct clk_ops tc358746_mclk_ops = { 1237 .enable = tc358746_mclk_enable, 1238 .disable = tc358746_mclk_disable, 1239 .recalc_rate = tc358746_recalc_rate, 1240 .round_rate = tc358746_mclk_round_rate, 1241 .set_rate = tc358746_mclk_set_rate, 1242 }; 1243 1244 static int tc358746_setup_mclk_provider(struct tc358746 *tc358746) 1245 { 1246 struct clk_init_data mclk_initdata = { }; 1247 struct device *dev = tc358746->sd.dev; 1248 const char *mclk_name; 1249 int err; 1250 1251 /* MCLK clk provider support is optional */ 1252 if (!device_property_present(dev, "#clock-cells")) 1253 return 0; 1254 1255 /* Init to highest possibel MCLK */ 1256 tc358746->mclk_postdiv = 512; 1257 tc358746->mclk_prediv = 8; 1258 1259 mclk_name = "tc358746-mclk"; 1260 device_property_read_string(dev, "clock-output-names", &mclk_name); 1261 1262 mclk_initdata.name = mclk_name; 1263 mclk_initdata.ops = &tc358746_mclk_ops; 1264 tc358746->mclk_hw.init = &mclk_initdata; 1265 1266 err = devm_clk_hw_register(dev, &tc358746->mclk_hw); 1267 if (err) { 1268 dev_err(dev, "Failed to register mclk provider\n"); 1269 return err; 1270 } 1271 1272 err = devm_of_clk_add_hw_provider(dev, of_clk_hw_simple_get, 1273 &tc358746->mclk_hw); 1274 if (err) 1275 dev_err(dev, "Failed to add mclk provider\n"); 1276 1277 return err; 1278 } 1279 1280 static int 1281 tc358746_init_subdev(struct tc358746 *tc358746, struct i2c_client *client) 1282 { 1283 struct v4l2_subdev *sd = &tc358746->sd; 1284 int err; 1285 1286 v4l2_i2c_subdev_init(sd, client, &tc358746_ops); 1287 sd->internal_ops = &tc358746_internal_ops; 1288 sd->flags |= V4L2_SUBDEV_FL_HAS_DEVNODE; 1289 sd->entity.function = MEDIA_ENT_F_VID_IF_BRIDGE; 1290 sd->entity.ops = &tc358746_entity_ops; 1291 1292 tc358746->pads[TC358746_SINK].flags = MEDIA_PAD_FL_SINK; 1293 tc358746->pads[TC358746_SOURCE].flags = MEDIA_PAD_FL_SOURCE; 1294 err = media_entity_pads_init(&sd->entity, TC358746_NR_PADS, 1295 tc358746->pads); 1296 if (err) 1297 return err; 1298 1299 err = v4l2_subdev_init_finalize(sd); 1300 if (err) 1301 media_entity_cleanup(&sd->entity); 1302 1303 return err; 1304 } 1305 1306 static int 1307 tc358746_init_output_port(struct tc358746 *tc358746, unsigned long refclk) 1308 { 1309 struct device *dev = tc358746->sd.dev; 1310 struct v4l2_fwnode_endpoint *vep; 1311 unsigned long csi_link_rate; 1312 struct fwnode_handle *ep; 1313 unsigned char csi_lanes; 1314 int err; 1315 1316 ep = fwnode_graph_get_endpoint_by_id(dev_fwnode(dev), TC358746_SOURCE, 1317 0, 0); 1318 if (!ep) { 1319 dev_err(dev, "Missing endpoint node\n"); 1320 return -EINVAL; 1321 } 1322 1323 /* Currently we only support 'parallel in' -> 'csi out' */ 1324 vep = &tc358746->csi_vep; 1325 vep->bus_type = V4L2_MBUS_CSI2_DPHY; 1326 err = v4l2_fwnode_endpoint_alloc_parse(ep, vep); 1327 fwnode_handle_put(ep); 1328 if (err) { 1329 dev_err(dev, "Failed to parse source endpoint\n"); 1330 return err; 1331 } 1332 1333 csi_lanes = vep->bus.mipi_csi2.num_data_lanes; 1334 if (csi_lanes == 0 || csi_lanes > 4 || 1335 vep->nr_of_link_frequencies == 0) { 1336 dev_err(dev, "error: Invalid CSI-2 settings\n"); 1337 err = -EINVAL; 1338 goto err; 1339 } 1340 1341 /* TODO: Add support to handle multiple link frequencies */ 1342 csi_link_rate = (unsigned long)vep->link_frequencies[0]; 1343 tc358746->pll_rate = tc358746_find_pll_settings(tc358746, refclk, 1344 csi_link_rate * 2); 1345 if (!tc358746->pll_rate) { 1346 err = -EINVAL; 1347 goto err; 1348 } 1349 1350 err = phy_mipi_dphy_get_default_config_for_hsclk(tc358746->pll_rate, 1351 csi_lanes, &tc358746->dphy_cfg); 1352 if (err) 1353 goto err; 1354 1355 tc358746->vb_size = TC358746_VB_DEFAULT_SIZE; 1356 1357 return 0; 1358 1359 err: 1360 v4l2_fwnode_endpoint_free(vep); 1361 1362 return err; 1363 } 1364 1365 static int tc358746_init_hw(struct tc358746 *tc358746) 1366 { 1367 struct device *dev = tc358746->sd.dev; 1368 unsigned int chipid; 1369 u32 val; 1370 int err; 1371 1372 err = pm_runtime_resume_and_get(dev); 1373 if (err < 0) { 1374 dev_err(dev, "Failed to resume the device\n"); 1375 return err; 1376 } 1377 1378 /* Ensure that CSI interface is put into LP-11 state */ 1379 err = tc358746_sw_reset(tc358746); 1380 if (err) { 1381 pm_runtime_put_sync(dev); 1382 dev_err(dev, "Failed to reset the device\n"); 1383 return err; 1384 } 1385 1386 err = tc358746_read(tc358746, CHIPID_REG, &val); 1387 pm_runtime_mark_last_busy(dev); 1388 pm_runtime_put_sync_autosuspend(dev); 1389 if (err) 1390 return -ENODEV; 1391 1392 chipid = FIELD_GET(CHIPID, val); 1393 if (chipid != 0x44) { 1394 dev_err(dev, "Invalid chipid 0x%02x\n", chipid); 1395 return -ENODEV; 1396 } 1397 1398 return 0; 1399 } 1400 1401 static int tc358746_init_controls(struct tc358746 *tc358746) 1402 { 1403 u64 *link_frequencies = tc358746->csi_vep.link_frequencies; 1404 struct v4l2_ctrl *ctrl; 1405 int err; 1406 1407 err = v4l2_ctrl_handler_init(&tc358746->ctrl_hdl, 1); 1408 if (err) 1409 return err; 1410 1411 /* 1412 * The driver currently supports only one link-frequency, regardless of 1413 * the input from the firmware, see: tc358746_init_output_port(). So 1414 * report only the first frequency from the array of possible given 1415 * frequencies. 1416 */ 1417 ctrl = v4l2_ctrl_new_int_menu(&tc358746->ctrl_hdl, NULL, 1418 V4L2_CID_LINK_FREQ, 0, 0, 1419 link_frequencies); 1420 if (ctrl) 1421 ctrl->flags |= V4L2_CTRL_FLAG_READ_ONLY; 1422 1423 err = tc358746->ctrl_hdl.error; 1424 if (err) { 1425 v4l2_ctrl_handler_free(&tc358746->ctrl_hdl); 1426 return err; 1427 } 1428 1429 tc358746->sd.ctrl_handler = &tc358746->ctrl_hdl; 1430 1431 return 0; 1432 } 1433 1434 static int tc358746_notify_bound(struct v4l2_async_notifier *notifier, 1435 struct v4l2_subdev *sd, 1436 struct v4l2_async_connection *asd) 1437 { 1438 struct tc358746 *tc358746 = 1439 container_of(notifier, struct tc358746, notifier); 1440 u32 flags = MEDIA_LNK_FL_ENABLED | MEDIA_LNK_FL_IMMUTABLE; 1441 struct media_pad *sink = &tc358746->pads[TC358746_SINK]; 1442 1443 return v4l2_create_fwnode_links_to_pad(sd, sink, flags); 1444 } 1445 1446 static const struct v4l2_async_notifier_operations tc358746_notify_ops = { 1447 .bound = tc358746_notify_bound, 1448 }; 1449 1450 static int tc358746_async_register(struct tc358746 *tc358746) 1451 { 1452 struct v4l2_fwnode_endpoint vep = { 1453 .bus_type = V4L2_MBUS_PARALLEL, 1454 }; 1455 struct v4l2_async_connection *asd; 1456 struct fwnode_handle *ep; 1457 int err; 1458 1459 ep = fwnode_graph_get_endpoint_by_id(dev_fwnode(tc358746->sd.dev), 1460 TC358746_SINK, 0, 0); 1461 if (!ep) 1462 return -ENOTCONN; 1463 1464 err = v4l2_fwnode_endpoint_parse(ep, &vep); 1465 if (err) { 1466 fwnode_handle_put(ep); 1467 return err; 1468 } 1469 1470 v4l2_async_subdev_nf_init(&tc358746->notifier, &tc358746->sd); 1471 asd = v4l2_async_nf_add_fwnode_remote(&tc358746->notifier, ep, 1472 struct v4l2_async_connection); 1473 fwnode_handle_put(ep); 1474 1475 if (IS_ERR(asd)) { 1476 err = PTR_ERR(asd); 1477 goto err_cleanup; 1478 } 1479 1480 tc358746->notifier.ops = &tc358746_notify_ops; 1481 1482 err = v4l2_async_nf_register(&tc358746->notifier); 1483 if (err) 1484 goto err_cleanup; 1485 1486 err = v4l2_async_register_subdev(&tc358746->sd); 1487 if (err) 1488 goto err_unregister; 1489 1490 return 0; 1491 1492 err_unregister: 1493 v4l2_async_nf_unregister(&tc358746->notifier); 1494 err_cleanup: 1495 v4l2_async_nf_cleanup(&tc358746->notifier); 1496 1497 return err; 1498 } 1499 1500 static int tc358746_probe(struct i2c_client *client) 1501 { 1502 struct device *dev = &client->dev; 1503 struct tc358746 *tc358746; 1504 unsigned long refclk; 1505 unsigned int i; 1506 int err; 1507 1508 tc358746 = devm_kzalloc(&client->dev, sizeof(*tc358746), GFP_KERNEL); 1509 if (!tc358746) 1510 return -ENOMEM; 1511 1512 tc358746->regmap = devm_regmap_init_i2c(client, &tc358746_regmap_config); 1513 if (IS_ERR(tc358746->regmap)) 1514 return dev_err_probe(dev, PTR_ERR(tc358746->regmap), 1515 "Failed to init regmap\n"); 1516 1517 tc358746->refclk = devm_clk_get(dev, "refclk"); 1518 if (IS_ERR(tc358746->refclk)) 1519 return dev_err_probe(dev, PTR_ERR(tc358746->refclk), 1520 "Failed to get refclk\n"); 1521 1522 err = clk_prepare_enable(tc358746->refclk); 1523 if (err) 1524 return dev_err_probe(dev, err, 1525 "Failed to enable refclk\n"); 1526 1527 refclk = clk_get_rate(tc358746->refclk); 1528 clk_disable_unprepare(tc358746->refclk); 1529 1530 if (refclk < 6 * HZ_PER_MHZ || refclk > 40 * HZ_PER_MHZ) 1531 return dev_err_probe(dev, -EINVAL, "Invalid refclk range\n"); 1532 1533 for (i = 0; i < ARRAY_SIZE(tc358746_supplies); i++) 1534 tc358746->supplies[i].supply = tc358746_supplies[i]; 1535 1536 err = devm_regulator_bulk_get(dev, ARRAY_SIZE(tc358746_supplies), 1537 tc358746->supplies); 1538 if (err) 1539 return dev_err_probe(dev, err, "Failed to get supplies\n"); 1540 1541 tc358746->reset_gpio = devm_gpiod_get_optional(dev, "reset", 1542 GPIOD_OUT_HIGH); 1543 if (IS_ERR(tc358746->reset_gpio)) 1544 return dev_err_probe(dev, PTR_ERR(tc358746->reset_gpio), 1545 "Failed to get reset-gpios\n"); 1546 1547 err = tc358746_init_subdev(tc358746, client); 1548 if (err) 1549 return dev_err_probe(dev, err, "Failed to init subdev\n"); 1550 1551 err = tc358746_init_output_port(tc358746, refclk); 1552 if (err) 1553 goto err_subdev; 1554 1555 /* 1556 * Keep this order since we need the output port link-frequencies 1557 * information. 1558 */ 1559 err = tc358746_init_controls(tc358746); 1560 if (err) 1561 goto err_fwnode; 1562 1563 dev_set_drvdata(dev, tc358746); 1564 1565 /* Set to 1sec to give the stream reconfiguration enough time */ 1566 pm_runtime_set_autosuspend_delay(dev, 1000); 1567 pm_runtime_use_autosuspend(dev); 1568 pm_runtime_enable(dev); 1569 1570 err = tc358746_init_hw(tc358746); 1571 if (err) 1572 goto err_pm; 1573 1574 err = tc358746_setup_mclk_provider(tc358746); 1575 if (err) 1576 goto err_pm; 1577 1578 err = tc358746_async_register(tc358746); 1579 if (err < 0) 1580 goto err_pm; 1581 1582 dev_dbg(dev, "%s found @ 0x%x (%s)\n", client->name, 1583 client->addr, client->adapter->name); 1584 1585 return 0; 1586 1587 err_pm: 1588 pm_runtime_disable(dev); 1589 pm_runtime_set_suspended(dev); 1590 pm_runtime_dont_use_autosuspend(dev); 1591 v4l2_ctrl_handler_free(&tc358746->ctrl_hdl); 1592 err_fwnode: 1593 v4l2_fwnode_endpoint_free(&tc358746->csi_vep); 1594 err_subdev: 1595 v4l2_subdev_cleanup(&tc358746->sd); 1596 media_entity_cleanup(&tc358746->sd.entity); 1597 1598 return err; 1599 } 1600 1601 static void tc358746_remove(struct i2c_client *client) 1602 { 1603 struct v4l2_subdev *sd = i2c_get_clientdata(client); 1604 struct tc358746 *tc358746 = to_tc358746(sd); 1605 1606 v4l2_subdev_cleanup(sd); 1607 v4l2_ctrl_handler_free(&tc358746->ctrl_hdl); 1608 v4l2_fwnode_endpoint_free(&tc358746->csi_vep); 1609 v4l2_async_nf_unregister(&tc358746->notifier); 1610 v4l2_async_nf_cleanup(&tc358746->notifier); 1611 v4l2_async_unregister_subdev(sd); 1612 media_entity_cleanup(&sd->entity); 1613 1614 pm_runtime_disable(sd->dev); 1615 pm_runtime_set_suspended(sd->dev); 1616 pm_runtime_dont_use_autosuspend(sd->dev); 1617 } 1618 1619 /* 1620 * This function has been created just to avoid a smatch warning, 1621 * please do not merge it into tc358746_suspend until you have 1622 * confirmed that it does not introduce a new warning. 1623 */ 1624 static void tc358746_clk_enable(struct tc358746 *tc358746) 1625 { 1626 clk_prepare_enable(tc358746->refclk); 1627 } 1628 1629 static int tc358746_suspend(struct device *dev) 1630 { 1631 struct tc358746 *tc358746 = dev_get_drvdata(dev); 1632 int err; 1633 1634 clk_disable_unprepare(tc358746->refclk); 1635 1636 err = regulator_bulk_disable(ARRAY_SIZE(tc358746_supplies), 1637 tc358746->supplies); 1638 if (err) 1639 tc358746_clk_enable(tc358746); 1640 1641 return err; 1642 } 1643 1644 static int tc358746_resume(struct device *dev) 1645 { 1646 struct tc358746 *tc358746 = dev_get_drvdata(dev); 1647 int err; 1648 1649 gpiod_set_value(tc358746->reset_gpio, 1); 1650 1651 err = regulator_bulk_enable(ARRAY_SIZE(tc358746_supplies), 1652 tc358746->supplies); 1653 if (err) 1654 return err; 1655 1656 /* min. 200ns */ 1657 usleep_range(10, 20); 1658 1659 gpiod_set_value(tc358746->reset_gpio, 0); 1660 1661 err = clk_prepare_enable(tc358746->refclk); 1662 if (err) 1663 goto err; 1664 1665 /* min. 700us ... 1ms */ 1666 usleep_range(1000, 1500); 1667 1668 /* 1669 * Enable the PLL here since it can be called by the clk-framework or by 1670 * the .s_stream() callback. So this is the common place for both. 1671 */ 1672 err = tc358746_apply_pll_config(tc358746); 1673 if (err) 1674 goto err_clk; 1675 1676 return 0; 1677 1678 err_clk: 1679 clk_disable_unprepare(tc358746->refclk); 1680 err: 1681 regulator_bulk_disable(ARRAY_SIZE(tc358746_supplies), 1682 tc358746->supplies); 1683 return err; 1684 } 1685 1686 static DEFINE_RUNTIME_DEV_PM_OPS(tc358746_pm_ops, tc358746_suspend, 1687 tc358746_resume, NULL); 1688 1689 static const struct of_device_id __maybe_unused tc358746_of_match[] = { 1690 { .compatible = "toshiba,tc358746" }, 1691 { }, 1692 }; 1693 MODULE_DEVICE_TABLE(of, tc358746_of_match); 1694 1695 static struct i2c_driver tc358746_driver = { 1696 .driver = { 1697 .name = "tc358746", 1698 .pm = pm_ptr(&tc358746_pm_ops), 1699 .of_match_table = tc358746_of_match, 1700 }, 1701 .probe = tc358746_probe, 1702 .remove = tc358746_remove, 1703 }; 1704 1705 module_i2c_driver(tc358746_driver); 1706 1707 MODULE_DESCRIPTION("Toshiba TC358746 Parallel to CSI-2 bridge driver"); 1708 MODULE_AUTHOR("Marco Felsch <kernel@pengutronix.de>"); 1709 MODULE_LICENSE("GPL"); 1710