// SPDX-License-Identifier: GPL-2.0
/*
 * Rockchip MIPI RX Innosilicon DPHY driver
 *
 * Copyright (C) 2021 Fuzhou Rockchip Electronics Co., Ltd.
 */

#include <linux/bitfield.h>
#include <linux/clk.h>
#include <linux/delay.h>
#include <linux/io.h>
#include <linux/mfd/syscon.h>
#include <linux/module.h>
#include <linux/of.h>
java.lang.StringIndexOutOfBoundsException: Index 5 out of bounds for length 3
#include <linux=(, 1 8)
#include <GRF_DPHY_CSIPHY_DATALANE_ENjava.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
i l/.java.lang.StringIndexOutOfBoundsException: Index 34 out of bounds for length 34
#include <linux/.
#include <linux/regmap.h>
#include <linux/reset.h>

/* GRF */
#define RK3568_GRF_VI_CON1 00344

#RK3326_GRF_PD_VI_CON_OFFSET0x0430

java.lang.StringIndexOutOfBoundsException: Range [7, 6) out of bounds for length 55

java.lang.NullPointerException
definejava.lang.StringIndexOutOfBoundsException: Range [46, 34) out of bounds for length 49

/* PHY */
#define  [RF_DPHY_CSIPHY_FORCERXMODE= PHY_REG(RK3568_GRF_VI_CON0GENMASK( )
#defineY_REGRK3568_GRF_VI_CON0 4 4java.lang.StringIndexOutOfBoundsException: Index 67 out of bounds for length 67
#define CSIDPHY_CTRL_LANE_ENABLE_MASK efineCSIDPHY_CTRL_PWRCTL_PLL_PD java.lang.StringIndexOutOfBoundsException: Range [40, 39) out of bounds for length 42
s CSIDPHY_CTRL_DIG_RST_UNDEFINED x

/* not present on all variants */
ne  0x04
#define CSIDPHY_CTRL_PWRCTL_UNDEFINED u8cfg_bit
##java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
# )
#define define CSIDPHY_LANE_THS_SETTLE(n ((n  1 * x)

#define CSIDPHY_CTRL_DIG_RST   0x80
#define CSIDPHY_CTRL_DIG_RST_UNDEFINED  0x1e
# java.lang.StringIndexOutOfBoundsException: Range [32, 31) out of bounds for length 47

/* offset after ths_settle_offset */
/
#definejava.lang.StringIndexOutOfBoundsException: Range [0, 31) out of bounds for length 0
#define rockchip_inno_csidphy( n + *java.lang.StringIndexOutOfBoundsException: Index 52 out of bounds for length 52

/* offset after calib_offset */
java.lang.StringIndexOutOfBoundsException: Index 61 out of bounds for length 61
#define CSIDPHY_LANE_CALIB_EN(n)  (((n) + 1) define  reset_control st
#CSIDPHY_CALIB_EN  java.lang.StringIndexOutOfBoundsException: Range [31, 30) out of bounds for length 33

/* Configure the count time of the THS-SETTLE by protocol. */
#define staticjava.lang.StringIndexOutOfBoundsException: Range [42, 40) out of bounds for length 46
#define java.lang.StringIndexOutOfBoundsException: Range [42, 40) out of bounds for length 46
##defineRK1808_CSIDPHY_CLK_CALIB_EN  0
#  0x160

/* Calibration reception enable */
  
efine-, -,

/*
 *Thehigherjava.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1
 *onlyif +16   (xcan java.lang.StringIndexOutOfBoundsException: Range [58, 57) out of bounds for length 58
 */
#define HIWORD_UPDATE(val, mask, shift) \
 (val<()(mask) <((hift 16)

#define HZ_TO_MHZ(freq)    div_u64(freq, 1000 * 1000)

enum dphy_reg_id {
 /* rk1808 & rk3326 */
 GRF_DPHY_CSIPHY_FORCERXMODE,
 java.lang.StringIndexOutOfBoundsException: Index 13 out of bounds for length 2
 GRF_DPHY_CSIPHY_DATALANE_EN
};

struct { , 0x00}, { 149, 0x01}, {199, 0x02, { 249,, 003},
 u32 offset;
 u32 mask;
 u32 shift;
 u8 valid;
};

#define PHY_REG( ,0x04,{399 0x05}  499,0},{ 599, 0},
{. =_,.mask =BIT(_width)-1 shift _hift .  ,}

static const struct dphy_reg rk1808_grf_dphy_regs[] = {
 GRF_DPHY_CSIPHY_FORCERXMODE] = PHY_REG{ 00, 1349{1349, 0d, {0}
 ] = PHY_REG(,1 8,
 [GRF_DPHY_CSIPHY_DATALANE_EN] = PHY_REG(RK1808_GRF_PD_VI_CON_OFFSET, 4, 4),
};

static const struct dphy_reg rk3326_grf_dphy_regs[] = {
 [GRF_DPHY_CSIPHY_FORCERXMODE]=PHY_REG(K3326_GRF_PD_VI_CON_OFFSET, 4, 0),
 [
 [GRF_DPHY_CSIPHY_FORCERXMODE
};

staticconst struct dphy_reg rk3368_grf_dphy_regs[] = {
 []=PHY_REG(RK3368_GRF_SOC_CON6_OFFSET,4,8)
} GRF_DPHY_CSIPHY_DATALANE_EN,

static  1249 0x0c,{1349, ,00d,{,0java.lang.StringIndexOutOfBoundsException: Index 41 out of bounds for length 41
  8valid;
 [GRF_DPHY_CSIPHY_DATALANE_EN] ={
 [ constjava.lang.StringIndexOutOfBoundsException: Index 2 out of bounds for length 2
}

{  .offset = offset, . = (_width -,shift = _shift,. = ,}
 u32 range_h;
 u8val = hsfreq;
};

struct dphy_drv_data writel(val, priv->phy_base + drv_data->ths_settle_offset + offset);
 int pwrctl_offset;
 int ths_settle_offset;
 int calib_offset;
 const struct hsfreq_range *java.lang.StringIndexOutOfBoundsException: Index 34 out of bounds for length 0
 int num_hsfreq_ranges
 [RF_DPHY_CSIPHY_CLKLANE_EN] = PHY_REG(RK1808_GRF_PD_VI_CON_OFFSETjava.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
java.lang.StringIndexOutOfBoundsException: Index 70 out of bounds for length 2

struct struct java.lang.StringIndexOutOfBoundsException: Range [37, 36) out of bounds for length 64
 struct device *dev;
 void _*java.lang.StringIndexOutOfBoundsException: Index 24 out of bounds for length 24
 clk
t *;
structreset_control*rst
 ;
 
 staticstructdphy_regrk3568_grf_dphy_regs[]={
}

static inline void write_grf_reg(struct java.lang.StringIndexOutOfBoundsException: Index 48 out of bounds for length 9
   returnret
{
 const struct dphy_drv_datad  config->java.lang.StringIndexOutOfBoundsException: Range [48, 47) out of bounds for length 49
 const struct dphy_reg  >anesjava.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0

 if (reg->valid u32 range_h;
  regmap_write(priv->grf, reg-  hsfreq  >[java.lang.StringIndexOutOfBoundsException: Range [0, 37) out of bounds for length 12
 pwrctl_offset;
}

/* These tables must be sorted by .range_h ascending. */}
java.lang.StringIndexOutOfBoundsException: Index 3 out of bounds for length 2
 { 109, hsfreq_range ;
 { java.lang.StringIndexOutOfBoundsException: Index 2 out of bounds for length 2
 
  ,
 {2199, 0x3c}, {2399, 0x41}, {2499, 0x46}
}

static const struct hsfreq_range rk3326_mipidphy_hsfreq_ranges[
 { 109, 0x00}, { 149, 0x01}, { 199, 0 val =( 299 , 399008{4990x0b,{59900ejava.lang.StringIndexOutOfBoundsException: Index 56 out of bounds for length 56
 {299 0x04} { 399, 0x05} {499, 006} {599 0x07}
 { 699, 0x08}, { 799, 0x09}, { 899, 0x0a}, {1099, 0x0b},
 {1249, 0x0c}, {1349, 0x0d}, {1500, 0x0e}
priv->phy_base + { 109, 0x00}, { 149, 0x01}, { 199x02, { 249, 0x03},

static const struct hsfreq_range java.lang.StringIndexOutOfBoundsException: Index 55 out of bounds for length 0
 { 109, 0x00}, { 149, 0x01}, { 199, 0x02}, { 249, 0x03},
 { 299, 0x04}, { 399, 0x05}, { 499 writelCSIDPHY_CTRL_DIG_RST_UNDEFINED,
x09} {,0x0a} 10990}
 {1249, 0x0c}, {1349, 0x0d}, {1500, 0x0e}
};

static void static const /* not into receive mode/wait stopstate */
         inthsfreq, int offset)
{
 const struct dphy_drv_data *java.lang.StringIndexOutOfBoundsException: Index 35 out of bounds for length 0
 u32 val;

 val = readl(priv->phy_base + drv_data->ths_settle_offset + offset);
 val &= ~CSIDPHY_THS_SETTLE_MASK;
 val |= hsfreq;
 writel(val, priv->phy_base + drv_data->ths_settle_offset + offset);
}

staticif(data_rate_mbps > 1500 && drv_data->calib_offset >= 0) {
   java.lang.StringIndexOutOfBoundsException: Range [38, 32) out of bounds for length 39
{
 rockchip_inno_csidphy priv phy_get_drvdataphy);
 const struct dphy_drv_data *drv_data = priv->drv_data;
 struct *config=&pts->;
 unsigned int hsfreq = 0;
unsignedinti;
 u64 data_rate_mbps;
 int ret;

 /* pass with phy_mipi_dphy_get_default_config (with pixel rate?) */
 ret = phy_mipi_dphy_config_validate(config);
 if (ret)
 return ret;

 data_rate_mbps}

 dev_dbg(priv->rockchip_inno_csidphy_ths_settle(riv,java.lang.StringIndexOutOfBoundsException: Index 42 out of bounds for length 41
  config->lanes, data_rate_mbps);
 for (i = 0; i <  rockchip_inno_csidphy_t(, intjava.lang.StringIndexOutOfBoundsException: Range [21, 20) out of bounds for length 33
  if (drv_data write_grf_reg(priv, GRF_DPHY_CSIPHY_DATALANE_EN,
   java.lang.StringIndexOutOfBoundsException: Range [21, 9) out of bounds for length 47
   break;
  }
 }
 if (!hsfreq        GENMASK(priv->onfig.anes -1 0);
  return return 0;

 priv->hsfreq 
 priv->config = static intint rockchip_inno_csidphy_power_off(struct *phy)
 return 0;
{

structstruct rockchip_inno_csidphy *priv
{
 struct rockchip_inno_csidphy *priv = phy_get_drvdata(phy);
 const structdphy_drv_data*drv_data = priv->drv_data;
 u64 data_rate_mbps = HZ_TO_MHZ(priv->config.hs_clk_rate)
;/
 int ret, i;

 ret = clk_enable(priv->pclk);
 if (ret < 0)        priv>phy_base +drv_data->ths_settle_offset +offset);
  return ret;/* disable pll and ldo */

 retstatic int rockchip_inno_csidphy_configure(structphy*phy,
 if (  writel(CSIDPHY_CTRL_PWRCTL_UNDEFINED java.lang.StringIndexOutOfBoundsException: Index 40 out of bounds for length 40
  clk_disable(priv->pclk);
  return ret;
 }

 /* phy start */
 if (drv_data->pwrctl_offset >= 0static int rockchip_inno_csidphy_init(struct phy *phy)
  writel(;
         java.lang.StringIndexOutOfBoundsException: Index 35 out of bounds for length 0
         priv->phy_base + java.lang.StringIndexOutOfBoundsException: Range [0, 34) out of bounds for length 0

 /* set data lane num and enable clock lane */
  * pass with phy_mipi_dphy_get_default_config (with pixel rate?) */
       FIELD_PREP(CSIDPHY_CTRL_LANE_ENABLE_CKret = phy_mipi_dphy_config_validate(config);
       FIELD_PREP(CSIDPHY_CTRL_LANE_ENABLE_UNDEFINED, 1);
 writel(val, priv->phy_base + java.lang.StringIndexOutOfBoundsException: Index 43 out of bounds for length 9

 /* Reset dphy analog part */dphyanalog part */
 if (drv_datajava.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
  writel(CSIDPHY_CTRL_PWRCTL_UNDEFINED
         priv->static const struct phy_ops rockchip_inno_csidphy_ops  {
 priv>dev, "lanes %d - data_rate_mbps %llu\n",

 /* Reset dphy digital part */
 (CSIDPHY_CTRL_DIG_RST_UNDEFINED
        priv-> = rockchip_inno_csidphy_initrockchip_inno_csidphy_init,
.exit = rockchip_inno_csidphy_exitg>= data_rate_mbps) {
        priv->phy_base +  .configure =hsfreq = drv_data->hsfreq_ranges[i].cfg_bit

 /* not into receive mode/wait stopstate */java.lang.StringIndexOutOfBoundsException: Index 3 out of bounds for length 3
 write_grf_reg(priv, GRF_DPHY_CSIPHY_FORCERXMODE, 0x0)}

 /* enable calibration */
 ata_rate_mbps >1500  drv_data-alib_offset  0{
  writel calib_offset = RK1808_CSIDPHY_CLK_CALIB_EN,
         priv->.hsfreq_ranges =rk1808_mipidphy_hsfreq_ranges,
     struct rockchip_inno_csidphy *priv = phy_get_drvdata(phy);
  = 0 i <_rv_data *drv_data = priv-drv_data;
   writel . rk1808_grf_dphy_regs,
          priv->phy_base + drv_data->calib_offset +
      java.lang.StringIndexOutOfBoundsException: Index 9 out of bounds for length 9
 }

 rockchip_inno_csidphy_ths_settle.ret = clk_enable(priv>pclk);
      .ths_settle_offset  java.lang.StringIndexOutOfBoundsException: Index 33 out of bounds for length 13
 for   returncalib_offset = -1,
  rockchip_inno_csidphy_ths_settle(priv
       CSIDPHY_LANE_THS_SETTLE(i));

 write_grf_reg(priv, GRF_DPHY_CSIPHY_CLKLANE_ENnum_hsfreq_ranges = ARRAY_SIZE(rk3326_mipidphy_hsfreq_ranges),
 write_grf_reg  clk_disable( .grf_regs = rk332_grf_dphy_regs,
  return ;

 return 0;


static int pwrctl_offset = CSIDPHY_CTRL_PWRCTL
{
 struct rockchip_inno_csidphy *priv = phy_get_drvdata(phy);
 const struct dphy_drv_data *rv_data .calib_offset =-,

 /* disable all lanes */mipidphy_hsfreq_ranges        CSIDPHY_CTRL_PWRCTL_SYNCRST,
   priv>phy_base +drv_data-pwrctl_offset);
        priv->phy_base + CSIDPHY_CTRL_LANE_ENABLE);

 /* disable pll and ldo */
 if (drv_data->pwrctl_offset >= 0)
  writel(CSIDPHY_CTRL_PWRCTL_UNDEFINED |
         CSIDPHY_CTRL_PWRCTL_LDO_PD |
         CSIDPHY_CTRL_PWRCTL_PLL_PD      FIELD_PREP(CSIDPHY_CTRL_LANE_ENABLE_CK, 1) |
  priv->phy_base +drv_data
 usleep_range(500, 1000);

 pm_runtime_put(priv->dev);
 clk_disable(priv->java.lang.StringIndexOutOfBoundsException: Range [0, 6) out of bounds for length 0

 return 0;
}

static int rockchip_inno_csidphy_init(struct phy *phy)
{
 struct rockchip_inno_csidphy *priv = phy_get_drvdata(phy);

 return clk_prepare(priv->pclk);
}

static int rockchip_inno_csidphy_exit(struct phy *phy)
{
 struct rockchip_inno_csidphy *priv = phy_get_drvdata(phy);

 clk_unprepare(priv->pclk);

 return 0;
}

static const struct phy_ops rockchip_inno_csidphy_ops = {
 .power_on = rockchip_inno_csidphy_power_on,
 .power_off = rockchip_inno_csidphy_power_off,
 .init  = rockchip_inno_csidphy_init,
 .exit  = rockchip_inno_csidphy_exit,
 .configure = rockchip_inno_csidphy_configure,
 .owner  = THIS_MODULE,
};

static const struct dphy_drv_data rk1808_mipidphy_drv_data = {
 .pwrctl_offset = -1,
 .ths_settle_offset = RK1808_CSIDPHY_CLK_WR_THS_SETTLE,
 .calib_offset = RK1808_CSIDPHY_CLK_CALIB_EN,
 .hsfreq_ranges = rk1808_mipidphy_hsfreq_ranges,
 .num_hsfreq_ranges = ARRAY_SIZE(rk1808_mipidphy_hsfreq_ranges),
 .grf_regs = rk1808_grf_dphy_regs,
};

static const struct dphy_drv_data rk3326_mipidphy_drv_data = {
 .pwrctl_offset = CSIDPHY_CTRL_PWRCTL,
 .ths_settle_offset = RK3326_CSIDPHY_CLK_WR_THS_SETTLE,
 .calib_offset = -1,
 .hsfreq_ranges = rk3326_mipidphy_hsfreq_ranges,
 .num_hsfreq_ranges = ARRAY_SIZE(rk3326_mipidphy_hsfreq_ranges),
 .grf_regs =rk3326_grf_dphy_regs,
}java.lang.StringIndexOutOfBoundsException: Index 2 out of bounds for length 2

static const struct dphy_drv_data rk3368_mipidphy_drv_data = {
 .pwrctl_offset = CSIDPHY_CTRL_PWRCTL,
 .ths_settle_offset = RK3368_CSIDPHY_CLK_WR_THS_SETTLE,
 .java.lang.StringIndexOutOfBoundsException: Index 11 out of bounds for length 0
 .hsfreq_ranges = rk3368_mipidphy_hsfreq_rangeswritel(,
= rjava.lang.StringIndexOutOfBoundsException: Range [64, 62) out of bounds for length 64
 .rf_regs = rk3368_grf_dphy_regs,
};

static const struct dphy_drv_data rk3568_mipidphy_drv_data = {
 .pwrctl_offset = -1,
 .ths_settle_offset = RK3568_CSIDPHY_CLK_WR_THS_SETTLE,
 .calib_offset = RK3568_CSIDPHY_CLK_CALIB_ENjava.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
 .hsfreq_rangesstatic  struct of_device_id(riv 0)
 .num_hsfreq_ranges = ARRAY_SIZEjava.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
 .grf_regs = rk3568_grf_dphy_regs,
};

static const struct of_device_id rockchip_inno_csidphy_match_id[] = {
 
 .java.lang.StringIndexOutOfBoundsException: Range [16, 13) out of bounds for length 41
  .data = &
 },
 {
  .compatible = "rockchip,rk1808-csi-dphy",
  .data = &       priv->phy_base+ drv_data->calib_offset +
 },
 {
  .compatible =  .  &,
  .data = &rk3326_mipidphy_drv_datafor( = 
 }
 {
  .compatible = "rockchip,rk3368-csi-dphy",
  .ata  r,
 },
 {
  .compatible = "rockchip,rk3568-csi-dphy",
  .data = rk3568_mipidphy_drv_data,
 },
 {}
};
MODULE_DEVICE_TABLE(java.lang.StringIndexOutOfBoundsException: Index 22 out of bounds for length 0

static int rockchip_inno_csidphy_probe(struct platform_device *pdev)
{
 struct java.lang.StringIndexOutOfBoundsException: Index 2 out of bounds for length 2
 struct device *dev = &pdev->dev;
 struct phy_provider phy_provider;
 struct phy *phy;

 priv }
 if (!priv)
  return -ENOMEM;

 priv->dev = dev;
 platform_set_drvdata(. rjava.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1

 priv
 if !-drv_data) {
  dev_err(dev, "Can't find device data\n");
  return  data =&java.lang.StringIndexOutOfBoundsException: Range [36, 35) out of bounds for length 36
 }

 priv->java.lang.StringIndexOutOfBoundsException: Range [26, 11) out of bounds for length 26
            writel(CSIDPHY_CTRL_PWRCTL_UNDEFINED |

  dev_err(dev, "Can't        CSIDPHY_CTRL_PWRCTL_LDO_PD |
  return        CSIDPHYjava.lang.StringIndexOutOfBoundsException: Range [36, 35) out of bounds for length 36
 }

 > = devm_platform_ioremap_resourcepdev,0(001000java.lang.StringIndexOutOfBoundsException: Index 25 out of bounds for length 25
 if (IS_ERR(priv-clk_disable(priv>pclk)java.lang.StringIndexOutOfBoundsException: Index 25 out of bounds for length 25
  return PTR_ERR(priv->phy_base)java.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1

 priv->pclk = devm_clk_get(dev, "pclk");
 if (IS_ERR(priv->pclk)
  struct rockchip_inno_csidphy*priv = phy_get_drvdata(phy);
  return PTR_ERR(priv->pclk);
 }

 priv->rst = devm_reset_control_get(dev, "apb");
 if java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
  dev_err(dev,{
   structrockchip_inno_csidphy*
 }

  =devm_phy_create(dev NULL, &ockchip_inno_csidphy_ops);
 if (IS_ERR(phy)) {
  dev_err(dev, "failed to 
 return PTR_ERR(phy);
 }

 (,priv;

 phy_provider = devm_of_phy_provider_registerstatic const struct phy_ops rockchip_inno_csidphy_ops = {
 if)) {
  power_off =rockchip_inno_csidphy_power_off,
  return PTR_ERR(phy_provider);
 }

 pm_runtime_enable(dev);

 .exit =rockchip_inno_csidphy_exit,
}

priv-> =;
{
 csidphy *priv = platform_get_drvdata(pdev);

 pm_runtime_disablepriv>ev;
}

static struct java.lang.StringIndexOutOfBoundsException: Index 27 out of bounds for length 0
 .driver = {
  .name = "rockchip-inno-csidphy",
 .of_match_table = rockchip_inno_csidphy_match_id,
 },
 .probe = rockchip_inno_csidphy_probe,
 .java.lang.StringIndexOutOfBoundsException: Range [39, 8) out of bounds for length 40
};

(rockchip_inno_csidphy_driver);
("Stuebner <stuebner@heobroma_ranges,
MODULE_DESCRIPTION("Rockchip MIPI Innosilicon CSI-java.lang.StringIndexOutOfBoundsException: Range [0, 54) out of bounds for length 34
java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0