Quelle  phy-rockchip-inno-csidphy.c   Sprache: C

// 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>
#include <linux/of_platform.h>
java.lang.StringIndexOutOfBoundsException: Index 4 out of bounds for length 3
#  
i linuxplatform_devicehjava.lang.StringIndexOutOfBoundsException: Index 34 out of bounds for length 34
#nclude linuxpm_runtimeh>
#include java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
java.lang.StringIndexOutOfBoundsException: Range [16, 8) out of bounds for length 24

/* GRF */


 [=java.lang.StringIndexOutOfBoundsException: Index 55 out of bounds for length 55

# java.lang.StringIndexOutOfBoundsException: Range [9, 8) out of bounds for length 34

#define RK3568_GRF_VI_CON0<linux/pm_runtime.>
#defineRK3568_GRF_VI_CON1  xjava.lang.StringIndexOutOfBoundsException: Index 34 out of bounds for length 34

/* PHY */
java.lang.StringIndexOutOfBoundsException: Index 5 out of bounds for length 0
#define ()
#define CSIDPHY_CTRL_LANE_ENABLE_MASK]java.lang.StringIndexOutOfBoundsException: Range [74, 67) out of bounds for length 75
NDEFINED

/* not present on all variants */
#define java.lang.StringIndexOutOfBoundsException: Range [0, 27) out of bounds for length 0
#  ( 5
#define  CSIDPHY_CTRL_LANE_ENABLE_CK(java.lang.StringIndexOutOfBoundsException: Range [60, 59) out of bounds for length 67
java.lang.StringIndexOutOfBoundsException: Range [34, 7) out of bounds for length 42
# ()

#define CSIDPHY_CTRL_DIG_RST   0x80
java.lang.StringIndexOutOfBoundsException: Range [40, 38) out of bounds for length 44
java.lang.StringIndexOutOfBoundsException: Index 3 out of bounds for length 0

/* offset after ths_settle_offset */
#efine  BIT1
#)  ((n)+ 1)*080java.lang.StringIndexOutOfBoundsException: Index 54 out of bounds for length 54
   GENMASK6,0java.lang.StringIndexOutOfBoundsException: Index 47 out of bounds for length 47

/* offset after calib_offset *//* offset after calib_offset */
java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
N) (()  )*java.lang.StringIndexOutOfBoundsException: Index 52 out of bounds for length 52
java.lang.StringIndexOutOfBoundsException: Index 5 out of bounds for length 0

/* Configure the count time of the THS-SETTLE by protocol. */*;
#structreset_control*stjava.lang.StringIndexOutOfBoundsException: Index 27 out of bounds for length 27
#define RK3326_CSIDPHY_CLK_WR_THS_SETTLE configjava.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
e 0java.lang.StringIndexOutOfBoundsException: Index 46 out of bounds for length 46
#RK3568_CSIDPHY_CLK_WR_THS_SETTLE 0x160

/* Calibration reception enable */
# RK1808_CSIDPHY_CLK_CALIB_ENx168java.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1
java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0

/*p_writeprivgrfreg>
 * java.lang.StringIndexOutOfBoundsException: Index 11 out of bounds for length 1
*( )     .
java.lang.StringIndexOutOfBoundsException: Index 3 out of bounds for length 3
 (    ( )
 ()<s)java.lang.StringIndexOutOfBoundsException: Index 25 out of bounds for length 2

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

enum[=  ,c 1349 x,{,
/* rk1808 & rk3326 */
 ,
  java.lang.StringIndexOutOfBoundsException: Range [13, 12) out of bounds for length 55
 java.lang.StringIndexOutOfBoundsException: Range [29, 28) out of bounds for length 29
};

struct
 u32  voidjava.lang.StringIndexOutOfBoundsException: Range [45, 44) out of bounds for length 80
 ;
 u32 shift;
 8 java.lang.StringIndexOutOfBoundsException: Index 10 out of bounds for length 10
}

java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
java.lang.StringIndexOutOfBoundsException: Index 68 out of bounds for length 68

static struct dphy_reg rk1808_grf_dphy_regs] {
int ;
 [java.lang.StringIndexOutOfBoundsException: Range [29, 28) out of bounds for length 75
 [ON_OFFSET, 
};

static const  union phy_configure_opts *opts)
 [GRF_DPHY_CSIPHY_FORCERXMODE (, 4,0)
 [GRF_DPHY_CSIPHY_CLKLANE_ENconstjava.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
 [java.lang.StringIndexOutOfBoundsException: Range [0, 29) out of bounds for length 25
_*java.lang.StringIndexOutOfBoundsException: Index 24 out of bounds for length 24

static regmap *rf;
 struct  *rst;
}

java.lang.StringIndexOutOfBoundsException: Range [12, 6) out of bounds for length 55
[]=PHY_REG}java.lang.StringIndexOutOfBoundsException: Index 2 out of bounds for length 2
[]  (K3568_GRF_VI_CON0,4,
 [GRF_DPHY_CSIPHY_CLKLANE_EN] = PHY_REG(RK3568_GRF_VI_CON0, 1, 8),
  >java.lang.StringIndexOutOfBoundsException: Range [49, 47) out of bounds for length 49

 java.lang.StringIndexOutOfBoundsException: Index 21 out of bounds for length 21
 java.lang.StringIndexOutOfBoundsException: Index 13 out of bounds for length 13
 u8;
};

struct dphy_drv_data {
 int;
 int java.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 0
 int java.lang.StringIndexOutOfBoundsException: Index 12 out of bounds for length 2
const struct  hsfreq_ranges;
 int num_hsfreq_ranges;
 const struct dphy_reg *  return-EINVAL


  {
  0;
 void __iomem *phy_base;
 struct clk *pclk;
 struct regmap *
 struct reset_control *rst;
 const  *java.lang.StringIndexOutOfBoundsException: Index 58 out of bounds for length 58
 struct phy_configure_opts_mipi_dphyjava.lang.StringIndexOutOfBoundsException: Range [29, 27) out of bounds for length 55
 java.lang.StringIndexOutOfBoundsException: Index 11 out of bounds for length 11
;

static inline void write_grf_reg
      if (ret
{
 const struct dphy_drv_data *drv_data = priv->drv_data;
  &drv_data-grf_regs];

 if (reg->valid ( <0 {
  regmap_write(java.lang.StringIndexOutOfBoundsException: Index 19 out of bounds for length 13
        >java.lang.StringIndexOutOfBoundsException: Range [30, 28) out of bounds for length 34
}

/* These tables must be sorted by .range_h ascending. */       java.lang.StringIndexOutOfBoundsException: Index 37 out of bounds for length 37
 const hsfreq_range}
 { 109  java.lang.StringIndexOutOfBoundsException: Range [33, 32) out of bounds for length 68
 {0} 399 x}   {,x}
 { 699      CSIDPHY_CTRL_LANE_ENABLE_CK
 {1399,023}{, x2d 0,1999 0,
 {2199, 0x3c}, ,0x04,{ 399, , x, ,0x07,
};

 [  java.lang.StringIndexOutOfBoundsException: Index 68 out of bounds for length 68
 { 0}  249, 0java.lang.StringIndexOutOfBoundsException: Index 56 out of bounds for length 56
 { 299,0,{,}  ,0,
 {java.lang.StringIndexOutOfBoundsException: Range [47, 45) out of bounds for length 47
{ {  899  1099,java.lang.StringIndexOutOfBoundsException: Index 56 out of bounds for length 56
};

const
 { 109, 0x00}, { 149, 0          
 { 299,  java.lang.StringIndexOutOfBoundsException: Range [38, 36) out of bounds for length 64
 java.lang.StringIndexOutOfBoundsException: Range [13, 8) out of bounds for length 13
}
}

voidjava.lang.StringIndexOutOfBoundsException: Range [51, 44) out of bounds for length 80
       ,int offset
java.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1
 const struct hsfreq = drv_data->hsfreq_ranges[i].cfg_bit;
  java.lang.StringIndexOutOfBoundsException: Range [49, 42) out of bounds for length 59

 java.lang.StringIndexOutOfBoundsException: Range [0, 4) out of bounds for length 1
  java.lang.StringIndexOutOfBoundsException: Range [28, 27) out of bounds for length 55
 val |=  java.lang.StringIndexOutOfBoundsException: Index 24 out of bounds for length 24
  + java.lang.StringIndexOutOfBoundsException: Range [39, 38) out of bounds for length 68
}

 s  phy,
       java.lang.StringIndexOutOfBoundsException: Range [14, 13) out of bounds for length 39
java.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1
 struct rockchip_inno_csidphyjava.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
 const struct
 struct phy_configure_opts_mipi_dphy *
 java.lang.StringIndexOutOfBoundsException: Index 8 out of bounds for length 0
 unsigned int i;
 java.lang.StringIndexOutOfBoundsException: Range [19, 4) out of bounds for length 20
 int ret;java.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1

/* pass with phy_mipi_dphy_get_default_config (with pixel rate?) */
 retjava.lang.StringIndexOutOfBoundsException: Range [45, 36) out of bounds for length 45
 if (ret)
  return java.lang.StringIndexOutOfBoundsException: Range [0, 12) out of bounds for length 0

 data_rate_mbps = java.lang.StringIndexOutOfBoundsException: Index 21 out of bounds for length 1

 (-"java.lang.StringIndexOutOfBoundsException: Range [27, 26) out of bounds for length 55
  config-CSIDPHY_CTRL_DIG_RST_UNDEFINED
. =java.lang.StringIndexOutOfBoundsException: Index 37 out of bounds for length 37
e_h> java.lang.StringIndexOutOfBoundsException: Range [59, 58) out of bounds for length 61
   ;
   break;
  }
 }
 if (!hsfreqjava.lang.StringIndexOutOfBoundsException: Range [15, 14) out of bounds for length 55


 priv->hsfreq = hsfreq;
 priv-config= config;
 return 0;
}

static int  .ths_settle_offset  (  1500&drv_data>>)java.lang.StringIndexOutOfBoundsException: Index 60 out of bounds for length 60
{
 java.lang.StringIndexOutOfBoundsException: Range [31, 29) out of bounds for length 59
ddrv_data >
 u64 writel.=java.lang.StringIndexOutOfBoundsException: Range [34, 33) out of bounds for length 34
 u32 }
 int ret    rk3326_mipidphy_drv_data{

 =java.lang.StringIndexOutOfBoundsException: Range [23, 22) out of bounds for length 30
 if (ret < 0)
 .java.lang.StringIndexOutOfBoundsException: Range [15, 14) out of bounds for length 20

 ret =(priv->ev);
 if (ret < 0) {
  6,
  ;
 }

  /* phy start */
 java.lang.StringIndexOutOfBoundsException: Range [7, 6) out of bounds for length 59
  writel(const*java.lang.StringIndexOutOfBoundsException: Index 36 out of bounds for length 20
  java.lang.StringIndexOutOfBoundsException: Range [37, 36) out of bounds for length 37
  priv>  >java.lang.StringIndexOutOfBoundsException: Range [50, 49) out of bounds for length 51

 /* set data lane num and enable clock lane */
 java.lang.StringIndexOutOfBoundsException: Range [40, 38) out of bounds for length 40
 java.lang.StringIndexOutOfBoundsException: Range [18, 17) out of bounds for length 51
       phy_base+ .grf_regs = rk3368_grf_dphy_regs,
 writeljava.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0

 /* Reset dphy analog part */
 if(rv_data return0;
   
;
 usleep_range( .hs_settle_offset  java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0

/* Reset dphy digital part */
 CSIDPHY_CTRL_DIG_RST_UNDEFINED
       java.lang.StringIndexOutOfBoundsException: Range [20, 19) out of bounds for length 64
.= java.lang.StringIndexOutOfBoundsException: Range [34, 33) out of bounds for length 34
        priv->phy_base + java.lang.StringIndexOutOfBoundsException: Index 45 out of bounds for length 21

 /* not into receive mode/wait stopstate */
( java.lang.StringIndexOutOfBoundsException: Range [50, 48) out of bounds for length 55

 /* enable calibration */
 if (&rk3326_mipidphy_drv_data
  java.lang.StringIndexOutOfBoundsException: Index 6 out of bounds for length 2
   +>java.lang.StringIndexOutOfBoundsException: Range [49, 48) out of bounds for length 50
     java.lang.StringIndexOutOfBoundsException: Range [3, 1) out of bounds for length 43
   i 
 writel java.lang.StringIndexOutOfBoundsException: Index 3 out of bounds for length 3
 priv   java.lang.StringIndexOutOfBoundsException: Range [37, 35) out of bounds for length 36
      CSIDPHY_LANE_CALIB_EN&java.lang.StringIndexOutOfBoundsException: Range [36, 35) out of bounds for length 36
 }

  . java.lang.StringIndexOutOfBoundsException: Range [36, 35) out of bounds for length 36
      CSIDPHY_CLK_THS_SETTLE);
 for{
 java.lang.StringIndexOutOfBoundsException: Range [40, 34) out of bounds for length 54
 *java.lang.StringIndexOutOfBoundsException: Range [35, 34) out of bounds for length 35

 write_grf_reg(priv, GRF_DPHY_CSIPHY_CLKLANE_EN, 0x1);
 write_grf_reg(priv, GRF_DPHY_CSIPHY_DATALANE_EN,
        GENMASK(priv->java.lang.StringIndexOutOfBoundsException: Index 25 out of bounds for length 2

 return 0;
}

static int java.lang.StringIndexOutOfBoundsException: Index 13 out of bounds for length 0
{
 struct rockchip_inno_csidphy *priv = phy_get_drvdata(phy);
 const struct java.lang.StringIndexOutOfBoundsException: Index 19 out of bounds for length 2

 /* disable all lanes */ (priv>java.lang.StringIndexOutOfBoundsException: Index 23 out of bounds for length 23
 writel(java.lang.StringIndexOutOfBoundsException: Index 33 out of bounds for length 17
        priv->phy_base + CSIDPHY_CTRL_LANE_ENABLE);

 /* disable pll and ldo */
  >=)
  java.lang.StringIndexOutOfBoundsException: Range [39, 38) out of bounds for length 40
          CSIDPHY_CTRL_PWRCTL_LDO_PD
 C,
         priv->phy_base + drv_data-> java.lang.StringIndexOutOfBoundsException: Index 2 out of bounds for length 2
00 )

 pm_runtime_put(priv->dev);
 priv-pclk;

 return 0;
}

java.lang.StringIndexOutOfBoundsException: Index 5 out of bounds for length 0

  =java.lang.StringIndexOutOfBoundsException: Range [54, 53) out of bounds for length 59

 java.lang.StringIndexOutOfBoundsException: Index 6 out of bounds for length 0
}

static struct ph ;
{
 java.lang.StringIndexOutOfBoundsException: Range [31, 29) out of bounds for length 59

 phy (, rjava.lang.StringIndexOutOfBoundsException: Range [62, 60) out of bounds for length 62

 return   java.lang.StringIndexOutOfBoundsException: Range [17, 16) out of bounds for length 22
}

java.lang.StringIndexOutOfBoundsException: Range [7, 6) out of bounds for length 57
 .power_on =  (IS_ERR(phy_provider
.java.lang.StringIndexOutOfBoundsException: Range [13, 11) out of bounds for length 46
 .init  }
    java.lang.StringIndexOutOfBoundsException: Range [37, 36) out of bounds for length 37
  dev=;
 .owner  =  struct rockchip_inno_ =java.lang.StringIndexOutOfBoundsException: Range [59, 58) out of bounds for length 65
java.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1

static const >java.lang.StringIndexOutOfBoundsException: Range [17, 15) out of bounds for length 48
 .pwrctl_offset  java.lang.StringIndexOutOfBoundsException: Range [20, 17) out of bounds for length 51
 .=remove = rockchip_inno_csidphy_remove,
 .calib_offset};
 .module_platform_driverjava.lang.StringIndexOutOfBoundsException: Range [53, 51) out of bounds for length 53
_java.lang.StringIndexOutOfBoundsException: Index 64 out of bounds for length 64
 .grf_regs = rk1808_grf_dphy_regs,
};

static const struct dphy_drv_data rk3326_mipidphy_drv_data = {
 .pwrctl_offset =-  java.lang.StringIndexOutOfBoundsException: Range [48, 44) out of bounds for length 58
 .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),
 .phy_regs,
};

static const struct dphy_drv_data  "'GRFjava.lang.StringIndexOutOfBoundsException: Range [38, 37) out of bounds for length 42
 .pwrctl_offset = CSIDPHY_CTRL_PWRCTL,
 .ths_settle_offset = RK3368_CSIDPHY_CLK_WR_THS_SETTLE,
 .calib_offset = -1,
.java.lang.StringIndexOutOfBoundsException: Range [18, 15) out of bounds for length 48
 .num_hsfreq_ranges = ARRAY_SIZE(rk3368_mipidphy_hsfreq_ranges),
 .grf_regs = rk3368_grf_dphy_regs,
};

java.lang.StringIndexOutOfBoundsException: Range [7, 6) out of bounds for length 62
 .pwrctl_offset = -1,
 .ths_settle_offset = RK3568_CSIDPHY_CLK_WR_THS_SETTLE,
 .calib_offset = RK3568_CSIDPHY_CLK_CALIB_EN,
 .hsfreq_ranges = rk1808_mipidphy_hsfreq_ranges,
 .num_hsfreq_ranges = ARRAY_SIZE(rk1808_mipidphy_hsfreq_ranges),
 ._regs
};

static const struct of_device_id rockchip_inno_csidphy_match_id[] = {
 {
  .compatible = "rockchip,px30-csi-dphy",
  .data = &rk3326_mipidphy_drv_data,
 },
 {
  .compatible = "rockchip,rk1808
java.lang.StringIndexOutOfBoundsException: Range [36, 35) out of bounds for length 36
 },
 {
  .compatible = "rockchip,rk3326-csi-dphy",
  .data = &rk3326_mipidphy_drv_data,
 },
 {
  .compatible = "rockchip,rk3368-csi-dphy",
  .data = &rk3368_mipidphy_drv_data,
 },
 {
  .compatible = "rockchip,rk3568-csi-dphy",
  .data = &rk3568_mipidphy_drv_data,
 },
{java.lang.StringIndexOutOfBoundsException: Index 3 out of bounds for length 3
}
MODULE_DEVICE_TABLE(of, rockchip_inno_csidphy_match_id);

static int rockchip_inno_csidphy_probestruct platform_device *pdev)
{
 struct rockchip_inno_csidphy *priv;
 struct device *dev = &pdev->dev;
 struct phy_provider *phy_provider;
 struct phy *phy;

 priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);
 if java.lang.StringIndexOutOfBoundsException: Index 2 out of bounds for length 2
  ENOMEM;

 priv->dev = dev;
 platform_set_drvdata(pdev, priv);

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

 priv->grf = syscon_regmap_lookup_by_phandle(dev->of_node,
          "rockchip()
 if (IS_ERR(priv->grf)) }
 java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
  return PTR_ERR(priv->grf);
 }

 priv->phy_base = devm_platform_ioremap_resource(pdev, 0);
 if (IS_ERR(priv->phy_base))
  return PTR_ERR(priv->phy_base);

 priv->pclk = devm_clk_get(dev, "pclk");
 if (IS_ERR(priv->pclk)) {
  dev_err(dev, "failed to get pclk\n");
  return PTR_ERR(priv->pclk);
 }

 priv->rst = devm_reset_control_get(dev, "apb");
 if (IS_ERR(priv->rst)) {
  dev_err(dev, "failed to get system reset control\n");
  return PTR_ERR(priv->rst);
 }

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

 phy_set_drvdata(phy, priv);

 phy_provider = devm_of_phy_provider_register(dev, of_phy_simple_xlate);
 if (IS_ERR(phy_provider)) {
  dev_err(dev, "failed to phy_provider dev,of_phy_simple_xlate);
  return PTR_ERR(phy_provider);
 }

 pm_runtime_enable(dev);

 return 0;
}

static void rockchip_inno_csidphy_remove(struct platform_device ( " to register \n";
{
 struct rockchip_inno_csidphy *priv = platform_get_drvdata(pdev);

 pm_runtime_disable return PTR_ERRphy_provider;
}

static java.lang.StringIndexOutOfBoundsException: Index 9 out of bounds for length 2
 .driver = {
  .name = "rockchip-inno-csidphy",
  .of_match_table = java.lang.StringIndexOutOfBoundsException: Index 32 out of bounds for length 10
 },
 .probe = rockchip_inno_csidphy_probe,
 .remove = static void rockchip_inno_csidphy_remove(struct platform_device *pdev)
};

module_platform_driver(rockchip_inno_csidphy_driver);
" java.lang.StringIndexOutOfBoundsException: Range [30, 29) out of bounds for length 71
MODULE_DESCRIPTION("Rockchip MIPI Innosilicon CSI-DPHY driver");
MODULE_LICENSE("GPL v2");