16363db1cSTomi Valkeinen // SPDX-License-Identifier: GPL-2.0
26363db1cSTomi Valkeinen /*
36363db1cSTomi Valkeinen * Driver for the Texas Instruments DS90UB953 video serializer
46363db1cSTomi Valkeinen *
56363db1cSTomi Valkeinen * Based on a driver from Luca Ceresoli <luca@lucaceresoli.net>
66363db1cSTomi Valkeinen *
76363db1cSTomi Valkeinen * Copyright (c) 2019 Luca Ceresoli <luca@lucaceresoli.net>
86363db1cSTomi Valkeinen * Copyright (c) 2023 Tomi Valkeinen <tomi.valkeinen@ideasonboard.com>
96363db1cSTomi Valkeinen */
106363db1cSTomi Valkeinen
116363db1cSTomi Valkeinen #include <linux/clk-provider.h>
126363db1cSTomi Valkeinen #include <linux/clk.h>
136363db1cSTomi Valkeinen #include <linux/delay.h>
146363db1cSTomi Valkeinen #include <linux/fwnode.h>
156363db1cSTomi Valkeinen #include <linux/gpio/driver.h>
166363db1cSTomi Valkeinen #include <linux/i2c-atr.h>
176363db1cSTomi Valkeinen #include <linux/i2c.h>
186363db1cSTomi Valkeinen #include <linux/kernel.h>
196363db1cSTomi Valkeinen #include <linux/math64.h>
206363db1cSTomi Valkeinen #include <linux/module.h>
216363db1cSTomi Valkeinen #include <linux/property.h>
226363db1cSTomi Valkeinen #include <linux/rational.h>
236363db1cSTomi Valkeinen #include <linux/regmap.h>
246363db1cSTomi Valkeinen
256363db1cSTomi Valkeinen #include <media/i2c/ds90ub9xx.h>
266363db1cSTomi Valkeinen #include <media/v4l2-ctrls.h>
276363db1cSTomi Valkeinen #include <media/v4l2-event.h>
28255b959bSTomi Valkeinen #include <media/v4l2-fwnode.h>
29255b959bSTomi Valkeinen #include <media/v4l2-mediabus.h>
306363db1cSTomi Valkeinen #include <media/v4l2-subdev.h>
316363db1cSTomi Valkeinen
326363db1cSTomi Valkeinen #define UB953_PAD_SINK 0
336363db1cSTomi Valkeinen #define UB953_PAD_SOURCE 1
346363db1cSTomi Valkeinen
356363db1cSTomi Valkeinen #define UB953_NUM_GPIOS 4
366363db1cSTomi Valkeinen
37d7d7a9abSTomi Valkeinen #define UB953_DEFAULT_CLKOUT_RATE 25000000UL
38d7d7a9abSTomi Valkeinen
396363db1cSTomi Valkeinen #define UB953_REG_RESET_CTL 0x01
406363db1cSTomi Valkeinen #define UB953_REG_RESET_CTL_DIGITAL_RESET_1 BIT(1)
416363db1cSTomi Valkeinen #define UB953_REG_RESET_CTL_DIGITAL_RESET_0 BIT(0)
426363db1cSTomi Valkeinen
436363db1cSTomi Valkeinen #define UB953_REG_GENERAL_CFG 0x02
446363db1cSTomi Valkeinen #define UB953_REG_GENERAL_CFG_CONT_CLK BIT(6)
456363db1cSTomi Valkeinen #define UB953_REG_GENERAL_CFG_CSI_LANE_SEL_SHIFT 4
466363db1cSTomi Valkeinen #define UB953_REG_GENERAL_CFG_CSI_LANE_SEL_MASK GENMASK(5, 4)
476363db1cSTomi Valkeinen #define UB953_REG_GENERAL_CFG_CRC_TX_GEN_ENABLE BIT(1)
486363db1cSTomi Valkeinen #define UB953_REG_GENERAL_CFG_I2C_STRAP_MODE BIT(0)
496363db1cSTomi Valkeinen
506363db1cSTomi Valkeinen #define UB953_REG_MODE_SEL 0x03
516363db1cSTomi Valkeinen #define UB953_REG_MODE_SEL_MODE_DONE BIT(3)
526363db1cSTomi Valkeinen #define UB953_REG_MODE_SEL_MODE_OVERRIDE BIT(4)
536363db1cSTomi Valkeinen #define UB953_REG_MODE_SEL_MODE_MASK GENMASK(2, 0)
546363db1cSTomi Valkeinen
556363db1cSTomi Valkeinen #define UB953_REG_CLKOUT_CTRL0 0x06
566363db1cSTomi Valkeinen #define UB953_REG_CLKOUT_CTRL1 0x07
576363db1cSTomi Valkeinen
586363db1cSTomi Valkeinen #define UB953_REG_SCL_HIGH_TIME 0x0b
596363db1cSTomi Valkeinen #define UB953_REG_SCL_LOW_TIME 0x0c
606363db1cSTomi Valkeinen
616363db1cSTomi Valkeinen #define UB953_REG_LOCAL_GPIO_DATA 0x0d
626363db1cSTomi Valkeinen #define UB953_REG_LOCAL_GPIO_DATA_GPIO_RMTEN(n) BIT(4 + (n))
636363db1cSTomi Valkeinen #define UB953_REG_LOCAL_GPIO_DATA_GPIO_OUT_SRC(n) BIT(0 + (n))
646363db1cSTomi Valkeinen
656363db1cSTomi Valkeinen #define UB953_REG_GPIO_INPUT_CTRL 0x0e
666363db1cSTomi Valkeinen #define UB953_REG_GPIO_INPUT_CTRL_OUT_EN(n) BIT(4 + (n))
676363db1cSTomi Valkeinen #define UB953_REG_GPIO_INPUT_CTRL_INPUT_EN(n) BIT(0 + (n))
686363db1cSTomi Valkeinen
696363db1cSTomi Valkeinen #define UB953_REG_REV_MASK_ID 0x50
706363db1cSTomi Valkeinen #define UB953_REG_GENERAL_STATUS 0x52
716363db1cSTomi Valkeinen
726363db1cSTomi Valkeinen #define UB953_REG_GPIO_PIN_STS 0x53
736363db1cSTomi Valkeinen #define UB953_REG_GPIO_PIN_STS_GPIO_STS(n) BIT(0 + (n))
746363db1cSTomi Valkeinen
756363db1cSTomi Valkeinen #define UB953_REG_BIST_ERR_CNT 0x54
766363db1cSTomi Valkeinen #define UB953_REG_CRC_ERR_CNT1 0x55
776363db1cSTomi Valkeinen #define UB953_REG_CRC_ERR_CNT2 0x56
786363db1cSTomi Valkeinen
796363db1cSTomi Valkeinen #define UB953_REG_CSI_ERR_CNT 0x5c
806363db1cSTomi Valkeinen #define UB953_REG_CSI_ERR_STATUS 0x5d
816363db1cSTomi Valkeinen #define UB953_REG_CSI_ERR_DLANE01 0x5e
826363db1cSTomi Valkeinen #define UB953_REG_CSI_ERR_DLANE23 0x5f
836363db1cSTomi Valkeinen #define UB953_REG_CSI_ERR_CLK_LANE 0x60
846363db1cSTomi Valkeinen #define UB953_REG_CSI_PKT_HDR_VC_ID 0x61
856363db1cSTomi Valkeinen #define UB953_REG_PKT_HDR_WC_LSB 0x62
866363db1cSTomi Valkeinen #define UB953_REG_PKT_HDR_WC_MSB 0x63
876363db1cSTomi Valkeinen #define UB953_REG_CSI_ECC 0x64
886363db1cSTomi Valkeinen
896363db1cSTomi Valkeinen #define UB953_REG_IND_ACC_CTL 0xb0
906363db1cSTomi Valkeinen #define UB953_REG_IND_ACC_ADDR 0xb1
916363db1cSTomi Valkeinen #define UB953_REG_IND_ACC_DATA 0xb2
926363db1cSTomi Valkeinen
936363db1cSTomi Valkeinen #define UB953_REG_FPD3_RX_ID(n) (0xf0 + (n))
946363db1cSTomi Valkeinen #define UB953_REG_FPD3_RX_ID_LEN 6
956363db1cSTomi Valkeinen
966363db1cSTomi Valkeinen /* Indirect register blocks */
976363db1cSTomi Valkeinen #define UB953_IND_TARGET_PAT_GEN 0x00
986363db1cSTomi Valkeinen #define UB953_IND_TARGET_FPD3_TX 0x01
996363db1cSTomi Valkeinen #define UB953_IND_TARGET_DIE_ID 0x02
1006363db1cSTomi Valkeinen
1016363db1cSTomi Valkeinen #define UB953_IND_PGEN_CTL 0x01
1026363db1cSTomi Valkeinen #define UB953_IND_PGEN_CTL_PGEN_ENABLE BIT(0)
1036363db1cSTomi Valkeinen #define UB953_IND_PGEN_CFG 0x02
1046363db1cSTomi Valkeinen #define UB953_IND_PGEN_CSI_DI 0x03
1056363db1cSTomi Valkeinen #define UB953_IND_PGEN_LINE_SIZE1 0x04
1066363db1cSTomi Valkeinen #define UB953_IND_PGEN_LINE_SIZE0 0x05
1076363db1cSTomi Valkeinen #define UB953_IND_PGEN_BAR_SIZE1 0x06
1086363db1cSTomi Valkeinen #define UB953_IND_PGEN_BAR_SIZE0 0x07
1096363db1cSTomi Valkeinen #define UB953_IND_PGEN_ACT_LPF1 0x08
1106363db1cSTomi Valkeinen #define UB953_IND_PGEN_ACT_LPF0 0x09
1116363db1cSTomi Valkeinen #define UB953_IND_PGEN_TOT_LPF1 0x0a
1126363db1cSTomi Valkeinen #define UB953_IND_PGEN_TOT_LPF0 0x0b
1136363db1cSTomi Valkeinen #define UB953_IND_PGEN_LINE_PD1 0x0c
1146363db1cSTomi Valkeinen #define UB953_IND_PGEN_LINE_PD0 0x0d
1156363db1cSTomi Valkeinen #define UB953_IND_PGEN_VBP 0x0e
1166363db1cSTomi Valkeinen #define UB953_IND_PGEN_VFP 0x0f
1176363db1cSTomi Valkeinen #define UB953_IND_PGEN_COLOR(n) (0x10 + (n)) /* n <= 15 */
1186363db1cSTomi Valkeinen
1196363db1cSTomi Valkeinen /* Note: Only sync mode supported for now */
1206363db1cSTomi Valkeinen enum ub953_mode {
1216363db1cSTomi Valkeinen /* FPD-Link III CSI-2 synchronous mode */
1226363db1cSTomi Valkeinen UB953_MODE_SYNC,
1236363db1cSTomi Valkeinen /* FPD-Link III CSI-2 non-synchronous mode, external ref clock */
1246363db1cSTomi Valkeinen UB953_MODE_NONSYNC_EXT,
1256363db1cSTomi Valkeinen /* FPD-Link III CSI-2 non-synchronous mode, internal ref clock */
1266363db1cSTomi Valkeinen UB953_MODE_NONSYNC_INT,
1276363db1cSTomi Valkeinen /* FPD-Link III DVP mode */
1286363db1cSTomi Valkeinen UB953_MODE_DVP,
1296363db1cSTomi Valkeinen };
1306363db1cSTomi Valkeinen
1316363db1cSTomi Valkeinen struct ub953_hw_data {
1326363db1cSTomi Valkeinen const char *model;
1336363db1cSTomi Valkeinen bool is_ub971;
1346363db1cSTomi Valkeinen };
1356363db1cSTomi Valkeinen
136d7d7a9abSTomi Valkeinen struct ub953_clkout_data {
137d7d7a9abSTomi Valkeinen u32 hs_div;
138d7d7a9abSTomi Valkeinen u32 m;
139d7d7a9abSTomi Valkeinen u32 n;
140d7d7a9abSTomi Valkeinen unsigned long rate;
141d7d7a9abSTomi Valkeinen };
142d7d7a9abSTomi Valkeinen
1436363db1cSTomi Valkeinen struct ub953_data {
1446363db1cSTomi Valkeinen const struct ub953_hw_data *hw_data;
1456363db1cSTomi Valkeinen
1466363db1cSTomi Valkeinen struct i2c_client *client;
1476363db1cSTomi Valkeinen struct regmap *regmap;
148618aba51STomi Valkeinen struct clk *clkin;
1496363db1cSTomi Valkeinen
1506363db1cSTomi Valkeinen u32 num_data_lanes;
151c7a52ae0STomi Valkeinen bool non_continous_clk;
1526363db1cSTomi Valkeinen
1536363db1cSTomi Valkeinen struct gpio_chip gpio_chip;
1546363db1cSTomi Valkeinen
1556363db1cSTomi Valkeinen struct v4l2_subdev sd;
1566363db1cSTomi Valkeinen struct media_pad pads[2];
1576363db1cSTomi Valkeinen
1586363db1cSTomi Valkeinen struct v4l2_async_notifier notifier;
1596363db1cSTomi Valkeinen
1606363db1cSTomi Valkeinen struct v4l2_subdev *source_sd;
1616363db1cSTomi Valkeinen u16 source_sd_pad;
1626363db1cSTomi Valkeinen
1636363db1cSTomi Valkeinen u64 enabled_source_streams;
1646363db1cSTomi Valkeinen
1656363db1cSTomi Valkeinen /* lock for register access */
1666363db1cSTomi Valkeinen struct mutex reg_lock;
1676363db1cSTomi Valkeinen
1686363db1cSTomi Valkeinen u8 current_indirect_target;
1696363db1cSTomi Valkeinen
1706363db1cSTomi Valkeinen struct clk_hw clkout_clk_hw;
1716363db1cSTomi Valkeinen
1726363db1cSTomi Valkeinen enum ub953_mode mode;
1736363db1cSTomi Valkeinen
1746363db1cSTomi Valkeinen const struct ds90ub9xx_platform_data *plat_data;
1756363db1cSTomi Valkeinen };
1766363db1cSTomi Valkeinen
sd_to_ub953(struct v4l2_subdev * sd)1776363db1cSTomi Valkeinen static inline struct ub953_data *sd_to_ub953(struct v4l2_subdev *sd)
1786363db1cSTomi Valkeinen {
1796363db1cSTomi Valkeinen return container_of(sd, struct ub953_data, sd);
1806363db1cSTomi Valkeinen }
1816363db1cSTomi Valkeinen
1826363db1cSTomi Valkeinen /*
1836363db1cSTomi Valkeinen * HW Access
1846363db1cSTomi Valkeinen */
1856363db1cSTomi Valkeinen
ub953_read(struct ub953_data * priv,u8 reg,u8 * val)1866363db1cSTomi Valkeinen static int ub953_read(struct ub953_data *priv, u8 reg, u8 *val)
1876363db1cSTomi Valkeinen {
1886363db1cSTomi Valkeinen unsigned int v;
1896363db1cSTomi Valkeinen int ret;
1906363db1cSTomi Valkeinen
1916363db1cSTomi Valkeinen mutex_lock(&priv->reg_lock);
1926363db1cSTomi Valkeinen
1936363db1cSTomi Valkeinen ret = regmap_read(priv->regmap, reg, &v);
1946363db1cSTomi Valkeinen if (ret) {
1956363db1cSTomi Valkeinen dev_err(&priv->client->dev, "Cannot read register 0x%02x: %d\n",
1966363db1cSTomi Valkeinen reg, ret);
1976363db1cSTomi Valkeinen goto out_unlock;
1986363db1cSTomi Valkeinen }
1996363db1cSTomi Valkeinen
2006363db1cSTomi Valkeinen *val = v;
2016363db1cSTomi Valkeinen
2026363db1cSTomi Valkeinen out_unlock:
2036363db1cSTomi Valkeinen mutex_unlock(&priv->reg_lock);
2046363db1cSTomi Valkeinen
2056363db1cSTomi Valkeinen return ret;
2066363db1cSTomi Valkeinen }
2076363db1cSTomi Valkeinen
ub953_write(struct ub953_data * priv,u8 reg,u8 val)2086363db1cSTomi Valkeinen static int ub953_write(struct ub953_data *priv, u8 reg, u8 val)
2096363db1cSTomi Valkeinen {
2106363db1cSTomi Valkeinen int ret;
2116363db1cSTomi Valkeinen
2126363db1cSTomi Valkeinen mutex_lock(&priv->reg_lock);
2136363db1cSTomi Valkeinen
2146363db1cSTomi Valkeinen ret = regmap_write(priv->regmap, reg, val);
2156363db1cSTomi Valkeinen if (ret)
2166363db1cSTomi Valkeinen dev_err(&priv->client->dev,
2176363db1cSTomi Valkeinen "Cannot write register 0x%02x: %d\n", reg, ret);
2186363db1cSTomi Valkeinen
2196363db1cSTomi Valkeinen mutex_unlock(&priv->reg_lock);
2206363db1cSTomi Valkeinen
2216363db1cSTomi Valkeinen return ret;
2226363db1cSTomi Valkeinen }
2236363db1cSTomi Valkeinen
ub953_select_ind_reg_block(struct ub953_data * priv,u8 block)2246363db1cSTomi Valkeinen static int ub953_select_ind_reg_block(struct ub953_data *priv, u8 block)
2256363db1cSTomi Valkeinen {
2266363db1cSTomi Valkeinen struct device *dev = &priv->client->dev;
2276363db1cSTomi Valkeinen int ret;
2286363db1cSTomi Valkeinen
2296363db1cSTomi Valkeinen if (priv->current_indirect_target == block)
2306363db1cSTomi Valkeinen return 0;
2316363db1cSTomi Valkeinen
2326363db1cSTomi Valkeinen ret = regmap_write(priv->regmap, UB953_REG_IND_ACC_CTL, block << 2);
2336363db1cSTomi Valkeinen if (ret) {
2346363db1cSTomi Valkeinen dev_err(dev, "%s: cannot select indirect target %u (%d)\n",
2356363db1cSTomi Valkeinen __func__, block, ret);
2366363db1cSTomi Valkeinen return ret;
2376363db1cSTomi Valkeinen }
2386363db1cSTomi Valkeinen
2396363db1cSTomi Valkeinen priv->current_indirect_target = block;
2406363db1cSTomi Valkeinen
2416363db1cSTomi Valkeinen return 0;
2426363db1cSTomi Valkeinen }
2436363db1cSTomi Valkeinen
2446363db1cSTomi Valkeinen __maybe_unused
ub953_read_ind(struct ub953_data * priv,u8 block,u8 reg,u8 * val)2456363db1cSTomi Valkeinen static int ub953_read_ind(struct ub953_data *priv, u8 block, u8 reg, u8 *val)
2466363db1cSTomi Valkeinen {
2476363db1cSTomi Valkeinen unsigned int v;
2486363db1cSTomi Valkeinen int ret;
2496363db1cSTomi Valkeinen
2506363db1cSTomi Valkeinen mutex_lock(&priv->reg_lock);
2516363db1cSTomi Valkeinen
2526363db1cSTomi Valkeinen ret = ub953_select_ind_reg_block(priv, block);
2536363db1cSTomi Valkeinen if (ret)
2546363db1cSTomi Valkeinen goto out_unlock;
2556363db1cSTomi Valkeinen
2566363db1cSTomi Valkeinen ret = regmap_write(priv->regmap, UB953_REG_IND_ACC_ADDR, reg);
2576363db1cSTomi Valkeinen if (ret) {
2586363db1cSTomi Valkeinen dev_err(&priv->client->dev,
2596363db1cSTomi Valkeinen "Write to IND_ACC_ADDR failed when reading %u:%x02x: %d\n",
2606363db1cSTomi Valkeinen block, reg, ret);
2616363db1cSTomi Valkeinen goto out_unlock;
2626363db1cSTomi Valkeinen }
2636363db1cSTomi Valkeinen
2646363db1cSTomi Valkeinen ret = regmap_read(priv->regmap, UB953_REG_IND_ACC_DATA, &v);
2656363db1cSTomi Valkeinen if (ret) {
2666363db1cSTomi Valkeinen dev_err(&priv->client->dev,
2676363db1cSTomi Valkeinen "Write to IND_ACC_DATA failed when reading %u:%x02x: %d\n",
2686363db1cSTomi Valkeinen block, reg, ret);
2696363db1cSTomi Valkeinen goto out_unlock;
2706363db1cSTomi Valkeinen }
2716363db1cSTomi Valkeinen
2726363db1cSTomi Valkeinen *val = v;
2736363db1cSTomi Valkeinen
2746363db1cSTomi Valkeinen out_unlock:
2756363db1cSTomi Valkeinen mutex_unlock(&priv->reg_lock);
2766363db1cSTomi Valkeinen
2776363db1cSTomi Valkeinen return ret;
2786363db1cSTomi Valkeinen }
2796363db1cSTomi Valkeinen
2806363db1cSTomi Valkeinen __maybe_unused
ub953_write_ind(struct ub953_data * priv,u8 block,u8 reg,u8 val)2816363db1cSTomi Valkeinen static int ub953_write_ind(struct ub953_data *priv, u8 block, u8 reg, u8 val)
2826363db1cSTomi Valkeinen {
2836363db1cSTomi Valkeinen int ret;
2846363db1cSTomi Valkeinen
2856363db1cSTomi Valkeinen mutex_lock(&priv->reg_lock);
2866363db1cSTomi Valkeinen
2876363db1cSTomi Valkeinen ret = ub953_select_ind_reg_block(priv, block);
2886363db1cSTomi Valkeinen if (ret)
2896363db1cSTomi Valkeinen goto out_unlock;
2906363db1cSTomi Valkeinen
2916363db1cSTomi Valkeinen ret = regmap_write(priv->regmap, UB953_REG_IND_ACC_ADDR, reg);
2926363db1cSTomi Valkeinen if (ret) {
2936363db1cSTomi Valkeinen dev_err(&priv->client->dev,
2946363db1cSTomi Valkeinen "Write to IND_ACC_ADDR failed when writing %u:%x02x: %d\n",
2956363db1cSTomi Valkeinen block, reg, ret);
2966363db1cSTomi Valkeinen goto out_unlock;
2976363db1cSTomi Valkeinen }
2986363db1cSTomi Valkeinen
2996363db1cSTomi Valkeinen ret = regmap_write(priv->regmap, UB953_REG_IND_ACC_DATA, val);
3006363db1cSTomi Valkeinen if (ret) {
3016363db1cSTomi Valkeinen dev_err(&priv->client->dev,
3026363db1cSTomi Valkeinen "Write to IND_ACC_DATA failed when writing %u:%x02x\n: %d\n",
3036363db1cSTomi Valkeinen block, reg, ret);
3046363db1cSTomi Valkeinen }
3056363db1cSTomi Valkeinen
3066363db1cSTomi Valkeinen out_unlock:
3076363db1cSTomi Valkeinen mutex_unlock(&priv->reg_lock);
3086363db1cSTomi Valkeinen
3096363db1cSTomi Valkeinen return ret;
3106363db1cSTomi Valkeinen }
3116363db1cSTomi Valkeinen
3126363db1cSTomi Valkeinen /*
3136363db1cSTomi Valkeinen * GPIO chip
3146363db1cSTomi Valkeinen */
ub953_gpio_get_direction(struct gpio_chip * gc,unsigned int offset)3156363db1cSTomi Valkeinen static int ub953_gpio_get_direction(struct gpio_chip *gc, unsigned int offset)
3166363db1cSTomi Valkeinen {
3176363db1cSTomi Valkeinen struct ub953_data *priv = gpiochip_get_data(gc);
3186363db1cSTomi Valkeinen int ret;
3196363db1cSTomi Valkeinen u8 v;
3206363db1cSTomi Valkeinen
3216363db1cSTomi Valkeinen ret = ub953_read(priv, UB953_REG_GPIO_INPUT_CTRL, &v);
3226363db1cSTomi Valkeinen if (ret)
3236363db1cSTomi Valkeinen return ret;
3246363db1cSTomi Valkeinen
3256363db1cSTomi Valkeinen if (v & UB953_REG_GPIO_INPUT_CTRL_INPUT_EN(offset))
3266363db1cSTomi Valkeinen return GPIO_LINE_DIRECTION_IN;
3276363db1cSTomi Valkeinen else
3286363db1cSTomi Valkeinen return GPIO_LINE_DIRECTION_OUT;
3296363db1cSTomi Valkeinen }
3306363db1cSTomi Valkeinen
ub953_gpio_direction_in(struct gpio_chip * gc,unsigned int offset)3316363db1cSTomi Valkeinen static int ub953_gpio_direction_in(struct gpio_chip *gc, unsigned int offset)
3326363db1cSTomi Valkeinen {
3336363db1cSTomi Valkeinen struct ub953_data *priv = gpiochip_get_data(gc);
3346363db1cSTomi Valkeinen
3356363db1cSTomi Valkeinen return regmap_update_bits(priv->regmap, UB953_REG_GPIO_INPUT_CTRL,
3366363db1cSTomi Valkeinen UB953_REG_GPIO_INPUT_CTRL_INPUT_EN(offset) |
3376363db1cSTomi Valkeinen UB953_REG_GPIO_INPUT_CTRL_OUT_EN(offset),
3386363db1cSTomi Valkeinen UB953_REG_GPIO_INPUT_CTRL_INPUT_EN(offset));
3396363db1cSTomi Valkeinen }
3406363db1cSTomi Valkeinen
ub953_gpio_direction_out(struct gpio_chip * gc,unsigned int offset,int value)3416363db1cSTomi Valkeinen static int ub953_gpio_direction_out(struct gpio_chip *gc, unsigned int offset,
3426363db1cSTomi Valkeinen int value)
3436363db1cSTomi Valkeinen {
3446363db1cSTomi Valkeinen struct ub953_data *priv = gpiochip_get_data(gc);
3456363db1cSTomi Valkeinen int ret;
3466363db1cSTomi Valkeinen
3476363db1cSTomi Valkeinen ret = regmap_update_bits(priv->regmap, UB953_REG_LOCAL_GPIO_DATA,
3486363db1cSTomi Valkeinen UB953_REG_LOCAL_GPIO_DATA_GPIO_OUT_SRC(offset),
3496363db1cSTomi Valkeinen value ? UB953_REG_LOCAL_GPIO_DATA_GPIO_OUT_SRC(offset) :
3506363db1cSTomi Valkeinen 0);
3516363db1cSTomi Valkeinen
3526363db1cSTomi Valkeinen if (ret)
3536363db1cSTomi Valkeinen return ret;
3546363db1cSTomi Valkeinen
3556363db1cSTomi Valkeinen return regmap_update_bits(priv->regmap, UB953_REG_GPIO_INPUT_CTRL,
3566363db1cSTomi Valkeinen UB953_REG_GPIO_INPUT_CTRL_INPUT_EN(offset) |
3576363db1cSTomi Valkeinen UB953_REG_GPIO_INPUT_CTRL_OUT_EN(offset),
3586363db1cSTomi Valkeinen UB953_REG_GPIO_INPUT_CTRL_OUT_EN(offset));
3596363db1cSTomi Valkeinen }
3606363db1cSTomi Valkeinen
ub953_gpio_get(struct gpio_chip * gc,unsigned int offset)3616363db1cSTomi Valkeinen static int ub953_gpio_get(struct gpio_chip *gc, unsigned int offset)
3626363db1cSTomi Valkeinen {
3636363db1cSTomi Valkeinen struct ub953_data *priv = gpiochip_get_data(gc);
3646363db1cSTomi Valkeinen int ret;
3656363db1cSTomi Valkeinen u8 v;
3666363db1cSTomi Valkeinen
3676363db1cSTomi Valkeinen ret = ub953_read(priv, UB953_REG_GPIO_PIN_STS, &v);
3686363db1cSTomi Valkeinen if (ret)
3696363db1cSTomi Valkeinen return ret;
3706363db1cSTomi Valkeinen
3716363db1cSTomi Valkeinen return !!(v & UB953_REG_GPIO_PIN_STS_GPIO_STS(offset));
3726363db1cSTomi Valkeinen }
3736363db1cSTomi Valkeinen
ub953_gpio_set(struct gpio_chip * gc,unsigned int offset,int value)3746363db1cSTomi Valkeinen static void ub953_gpio_set(struct gpio_chip *gc, unsigned int offset, int value)
3756363db1cSTomi Valkeinen {
3766363db1cSTomi Valkeinen struct ub953_data *priv = gpiochip_get_data(gc);
3776363db1cSTomi Valkeinen
3786363db1cSTomi Valkeinen regmap_update_bits(priv->regmap, UB953_REG_LOCAL_GPIO_DATA,
3796363db1cSTomi Valkeinen UB953_REG_LOCAL_GPIO_DATA_GPIO_OUT_SRC(offset),
3806363db1cSTomi Valkeinen value ? UB953_REG_LOCAL_GPIO_DATA_GPIO_OUT_SRC(offset) :
3816363db1cSTomi Valkeinen 0);
3826363db1cSTomi Valkeinen }
3836363db1cSTomi Valkeinen
ub953_gpio_of_xlate(struct gpio_chip * gc,const struct of_phandle_args * gpiospec,u32 * flags)3846363db1cSTomi Valkeinen static int ub953_gpio_of_xlate(struct gpio_chip *gc,
3856363db1cSTomi Valkeinen const struct of_phandle_args *gpiospec,
3866363db1cSTomi Valkeinen u32 *flags)
3876363db1cSTomi Valkeinen {
3886363db1cSTomi Valkeinen if (flags)
3896363db1cSTomi Valkeinen *flags = gpiospec->args[1];
3906363db1cSTomi Valkeinen
3916363db1cSTomi Valkeinen return gpiospec->args[0];
3926363db1cSTomi Valkeinen }
3936363db1cSTomi Valkeinen
ub953_gpiochip_probe(struct ub953_data * priv)3946363db1cSTomi Valkeinen static int ub953_gpiochip_probe(struct ub953_data *priv)
3956363db1cSTomi Valkeinen {
3966363db1cSTomi Valkeinen struct device *dev = &priv->client->dev;
3976363db1cSTomi Valkeinen struct gpio_chip *gc = &priv->gpio_chip;
3986363db1cSTomi Valkeinen int ret;
3996363db1cSTomi Valkeinen
4006363db1cSTomi Valkeinen /* Set all GPIOs to local input mode */
4016363db1cSTomi Valkeinen ub953_write(priv, UB953_REG_LOCAL_GPIO_DATA, 0);
4026363db1cSTomi Valkeinen ub953_write(priv, UB953_REG_GPIO_INPUT_CTRL, 0xf);
4036363db1cSTomi Valkeinen
4046363db1cSTomi Valkeinen gc->label = dev_name(dev);
4056363db1cSTomi Valkeinen gc->parent = dev;
4066363db1cSTomi Valkeinen gc->owner = THIS_MODULE;
4076363db1cSTomi Valkeinen gc->base = -1;
4086363db1cSTomi Valkeinen gc->can_sleep = true;
4096363db1cSTomi Valkeinen gc->ngpio = UB953_NUM_GPIOS;
4106363db1cSTomi Valkeinen gc->get_direction = ub953_gpio_get_direction;
4116363db1cSTomi Valkeinen gc->direction_input = ub953_gpio_direction_in;
4126363db1cSTomi Valkeinen gc->direction_output = ub953_gpio_direction_out;
4136363db1cSTomi Valkeinen gc->get = ub953_gpio_get;
4146363db1cSTomi Valkeinen gc->set = ub953_gpio_set;
4156363db1cSTomi Valkeinen gc->of_xlate = ub953_gpio_of_xlate;
4166363db1cSTomi Valkeinen gc->of_gpio_n_cells = 2;
4176363db1cSTomi Valkeinen
4186363db1cSTomi Valkeinen ret = gpiochip_add_data(gc, priv);
4196363db1cSTomi Valkeinen if (ret) {
4206363db1cSTomi Valkeinen dev_err(dev, "Failed to add GPIOs: %d\n", ret);
4216363db1cSTomi Valkeinen return ret;
4226363db1cSTomi Valkeinen }
4236363db1cSTomi Valkeinen
4246363db1cSTomi Valkeinen return 0;
4256363db1cSTomi Valkeinen }
4266363db1cSTomi Valkeinen
ub953_gpiochip_remove(struct ub953_data * priv)4276363db1cSTomi Valkeinen static void ub953_gpiochip_remove(struct ub953_data *priv)
4286363db1cSTomi Valkeinen {
4296363db1cSTomi Valkeinen gpiochip_remove(&priv->gpio_chip);
4306363db1cSTomi Valkeinen }
4316363db1cSTomi Valkeinen
4326363db1cSTomi Valkeinen /*
4336363db1cSTomi Valkeinen * V4L2
4346363db1cSTomi Valkeinen */
4356363db1cSTomi Valkeinen
_ub953_set_routing(struct v4l2_subdev * sd,struct v4l2_subdev_state * state,struct v4l2_subdev_krouting * routing)4366363db1cSTomi Valkeinen static int _ub953_set_routing(struct v4l2_subdev *sd,
4376363db1cSTomi Valkeinen struct v4l2_subdev_state *state,
4386363db1cSTomi Valkeinen struct v4l2_subdev_krouting *routing)
4396363db1cSTomi Valkeinen {
4406363db1cSTomi Valkeinen static const struct v4l2_mbus_framefmt format = {
4416363db1cSTomi Valkeinen .width = 640,
4426363db1cSTomi Valkeinen .height = 480,
4436363db1cSTomi Valkeinen .code = MEDIA_BUS_FMT_UYVY8_1X16,
4446363db1cSTomi Valkeinen .field = V4L2_FIELD_NONE,
4456363db1cSTomi Valkeinen .colorspace = V4L2_COLORSPACE_SRGB,
4466363db1cSTomi Valkeinen .ycbcr_enc = V4L2_YCBCR_ENC_601,
4476363db1cSTomi Valkeinen .quantization = V4L2_QUANTIZATION_LIM_RANGE,
4486363db1cSTomi Valkeinen .xfer_func = V4L2_XFER_FUNC_SRGB,
4496363db1cSTomi Valkeinen };
4506363db1cSTomi Valkeinen int ret;
4516363db1cSTomi Valkeinen
4526363db1cSTomi Valkeinen /*
4536363db1cSTomi Valkeinen * Note: we can only support up to V4L2_FRAME_DESC_ENTRY_MAX, until
4546363db1cSTomi Valkeinen * frame desc is made dynamically allocated.
4556363db1cSTomi Valkeinen */
4566363db1cSTomi Valkeinen
4576363db1cSTomi Valkeinen if (routing->num_routes > V4L2_FRAME_DESC_ENTRY_MAX)
4586363db1cSTomi Valkeinen return -EINVAL;
4596363db1cSTomi Valkeinen
4606363db1cSTomi Valkeinen ret = v4l2_subdev_routing_validate(sd, routing,
4616363db1cSTomi Valkeinen V4L2_SUBDEV_ROUTING_ONLY_1_TO_1);
4626363db1cSTomi Valkeinen if (ret)
4636363db1cSTomi Valkeinen return ret;
4646363db1cSTomi Valkeinen
4656363db1cSTomi Valkeinen ret = v4l2_subdev_set_routing_with_fmt(sd, state, routing, &format);
4666363db1cSTomi Valkeinen if (ret)
4676363db1cSTomi Valkeinen return ret;
4686363db1cSTomi Valkeinen
4696363db1cSTomi Valkeinen return 0;
4706363db1cSTomi Valkeinen }
4716363db1cSTomi Valkeinen
ub953_set_routing(struct v4l2_subdev * sd,struct v4l2_subdev_state * state,enum v4l2_subdev_format_whence which,struct v4l2_subdev_krouting * routing)4726363db1cSTomi Valkeinen static int ub953_set_routing(struct v4l2_subdev *sd,
4736363db1cSTomi Valkeinen struct v4l2_subdev_state *state,
4746363db1cSTomi Valkeinen enum v4l2_subdev_format_whence which,
4756363db1cSTomi Valkeinen struct v4l2_subdev_krouting *routing)
4766363db1cSTomi Valkeinen {
4776363db1cSTomi Valkeinen struct ub953_data *priv = sd_to_ub953(sd);
4786363db1cSTomi Valkeinen
4796363db1cSTomi Valkeinen if (which == V4L2_SUBDEV_FORMAT_ACTIVE && priv->enabled_source_streams)
4806363db1cSTomi Valkeinen return -EBUSY;
4816363db1cSTomi Valkeinen
4826363db1cSTomi Valkeinen return _ub953_set_routing(sd, state, routing);
4836363db1cSTomi Valkeinen }
4846363db1cSTomi Valkeinen
ub953_get_frame_desc(struct v4l2_subdev * sd,unsigned int pad,struct v4l2_mbus_frame_desc * fd)4856363db1cSTomi Valkeinen static int ub953_get_frame_desc(struct v4l2_subdev *sd, unsigned int pad,
4866363db1cSTomi Valkeinen struct v4l2_mbus_frame_desc *fd)
4876363db1cSTomi Valkeinen {
4886363db1cSTomi Valkeinen struct ub953_data *priv = sd_to_ub953(sd);
4896363db1cSTomi Valkeinen struct v4l2_mbus_frame_desc source_fd;
4906363db1cSTomi Valkeinen struct v4l2_subdev_route *route;
4916363db1cSTomi Valkeinen struct v4l2_subdev_state *state;
4926363db1cSTomi Valkeinen int ret;
4936363db1cSTomi Valkeinen
4946363db1cSTomi Valkeinen if (pad != UB953_PAD_SOURCE)
4956363db1cSTomi Valkeinen return -EINVAL;
4966363db1cSTomi Valkeinen
4976363db1cSTomi Valkeinen ret = v4l2_subdev_call(priv->source_sd, pad, get_frame_desc,
4986363db1cSTomi Valkeinen priv->source_sd_pad, &source_fd);
4996363db1cSTomi Valkeinen if (ret)
5006363db1cSTomi Valkeinen return ret;
5016363db1cSTomi Valkeinen
5026363db1cSTomi Valkeinen memset(fd, 0, sizeof(*fd));
5036363db1cSTomi Valkeinen
5046363db1cSTomi Valkeinen fd->type = V4L2_MBUS_FRAME_DESC_TYPE_CSI2;
5056363db1cSTomi Valkeinen
5066363db1cSTomi Valkeinen state = v4l2_subdev_lock_and_get_active_state(sd);
5076363db1cSTomi Valkeinen
5086363db1cSTomi Valkeinen for_each_active_route(&state->routing, route) {
5096363db1cSTomi Valkeinen struct v4l2_mbus_frame_desc_entry *source_entry = NULL;
5106363db1cSTomi Valkeinen unsigned int i;
5116363db1cSTomi Valkeinen
5126363db1cSTomi Valkeinen if (route->source_pad != pad)
5136363db1cSTomi Valkeinen continue;
5146363db1cSTomi Valkeinen
5156363db1cSTomi Valkeinen for (i = 0; i < source_fd.num_entries; i++) {
5166363db1cSTomi Valkeinen if (source_fd.entry[i].stream == route->sink_stream) {
5176363db1cSTomi Valkeinen source_entry = &source_fd.entry[i];
5186363db1cSTomi Valkeinen break;
5196363db1cSTomi Valkeinen }
5206363db1cSTomi Valkeinen }
5216363db1cSTomi Valkeinen
5226363db1cSTomi Valkeinen if (!source_entry) {
5236363db1cSTomi Valkeinen dev_err(&priv->client->dev,
5246363db1cSTomi Valkeinen "Failed to find stream from source frame desc\n");
5256363db1cSTomi Valkeinen ret = -EPIPE;
5266363db1cSTomi Valkeinen goto out_unlock;
5276363db1cSTomi Valkeinen }
5286363db1cSTomi Valkeinen
5296363db1cSTomi Valkeinen fd->entry[fd->num_entries].stream = route->source_stream;
5306363db1cSTomi Valkeinen fd->entry[fd->num_entries].flags = source_entry->flags;
5316363db1cSTomi Valkeinen fd->entry[fd->num_entries].length = source_entry->length;
5326363db1cSTomi Valkeinen fd->entry[fd->num_entries].pixelcode = source_entry->pixelcode;
5336363db1cSTomi Valkeinen fd->entry[fd->num_entries].bus.csi2.vc =
5346363db1cSTomi Valkeinen source_entry->bus.csi2.vc;
5356363db1cSTomi Valkeinen fd->entry[fd->num_entries].bus.csi2.dt =
5366363db1cSTomi Valkeinen source_entry->bus.csi2.dt;
5376363db1cSTomi Valkeinen
5386363db1cSTomi Valkeinen fd->num_entries++;
5396363db1cSTomi Valkeinen }
5406363db1cSTomi Valkeinen
5416363db1cSTomi Valkeinen out_unlock:
5426363db1cSTomi Valkeinen v4l2_subdev_unlock_state(state);
5436363db1cSTomi Valkeinen
5446363db1cSTomi Valkeinen return ret;
5456363db1cSTomi Valkeinen }
5466363db1cSTomi Valkeinen
ub953_set_fmt(struct v4l2_subdev * sd,struct v4l2_subdev_state * state,struct v4l2_subdev_format * format)5476363db1cSTomi Valkeinen static int ub953_set_fmt(struct v4l2_subdev *sd,
5486363db1cSTomi Valkeinen struct v4l2_subdev_state *state,
5496363db1cSTomi Valkeinen struct v4l2_subdev_format *format)
5506363db1cSTomi Valkeinen {
5516363db1cSTomi Valkeinen struct ub953_data *priv = sd_to_ub953(sd);
5526363db1cSTomi Valkeinen struct v4l2_mbus_framefmt *fmt;
5536363db1cSTomi Valkeinen
5546363db1cSTomi Valkeinen if (format->which == V4L2_SUBDEV_FORMAT_ACTIVE &&
5556363db1cSTomi Valkeinen priv->enabled_source_streams)
5566363db1cSTomi Valkeinen return -EBUSY;
5576363db1cSTomi Valkeinen
5586363db1cSTomi Valkeinen /* No transcoding, source and sink formats must match. */
5596363db1cSTomi Valkeinen if (format->pad == UB953_PAD_SOURCE)
5606363db1cSTomi Valkeinen return v4l2_subdev_get_fmt(sd, state, format);
5616363db1cSTomi Valkeinen
5626363db1cSTomi Valkeinen /* Set sink format */
5636363db1cSTomi Valkeinen fmt = v4l2_subdev_state_get_stream_format(state, format->pad,
5646363db1cSTomi Valkeinen format->stream);
5656363db1cSTomi Valkeinen if (!fmt)
5666363db1cSTomi Valkeinen return -EINVAL;
5676363db1cSTomi Valkeinen
5686363db1cSTomi Valkeinen *fmt = format->format;
5696363db1cSTomi Valkeinen
5706363db1cSTomi Valkeinen /* Propagate to source format */
5716363db1cSTomi Valkeinen fmt = v4l2_subdev_state_get_opposite_stream_format(state, format->pad,
5726363db1cSTomi Valkeinen format->stream);
5736363db1cSTomi Valkeinen if (!fmt)
5746363db1cSTomi Valkeinen return -EINVAL;
5756363db1cSTomi Valkeinen
5766363db1cSTomi Valkeinen *fmt = format->format;
5776363db1cSTomi Valkeinen
5786363db1cSTomi Valkeinen return 0;
5796363db1cSTomi Valkeinen }
5806363db1cSTomi Valkeinen
ub953_init_cfg(struct v4l2_subdev * sd,struct v4l2_subdev_state * state)5816363db1cSTomi Valkeinen static int ub953_init_cfg(struct v4l2_subdev *sd,
5826363db1cSTomi Valkeinen struct v4l2_subdev_state *state)
5836363db1cSTomi Valkeinen {
5846363db1cSTomi Valkeinen struct v4l2_subdev_route routes[] = {
5856363db1cSTomi Valkeinen {
5866363db1cSTomi Valkeinen .sink_pad = UB953_PAD_SINK,
5876363db1cSTomi Valkeinen .sink_stream = 0,
5886363db1cSTomi Valkeinen .source_pad = UB953_PAD_SOURCE,
5896363db1cSTomi Valkeinen .source_stream = 0,
5906363db1cSTomi Valkeinen .flags = V4L2_SUBDEV_ROUTE_FL_ACTIVE,
5916363db1cSTomi Valkeinen },
5926363db1cSTomi Valkeinen };
5936363db1cSTomi Valkeinen
5946363db1cSTomi Valkeinen struct v4l2_subdev_krouting routing = {
5956363db1cSTomi Valkeinen .num_routes = ARRAY_SIZE(routes),
5966363db1cSTomi Valkeinen .routes = routes,
5976363db1cSTomi Valkeinen };
5986363db1cSTomi Valkeinen
5996363db1cSTomi Valkeinen return _ub953_set_routing(sd, state, &routing);
6006363db1cSTomi Valkeinen }
6016363db1cSTomi Valkeinen
ub953_log_status(struct v4l2_subdev * sd)6026363db1cSTomi Valkeinen static int ub953_log_status(struct v4l2_subdev *sd)
6036363db1cSTomi Valkeinen {
6046363db1cSTomi Valkeinen struct ub953_data *priv = sd_to_ub953(sd);
6056363db1cSTomi Valkeinen struct device *dev = &priv->client->dev;
6066363db1cSTomi Valkeinen u8 v = 0, v1 = 0, v2 = 0;
6076363db1cSTomi Valkeinen unsigned int i;
6086363db1cSTomi Valkeinen char id[UB953_REG_FPD3_RX_ID_LEN];
609*1cf8ddccSTomi Valkeinen u8 gpio_local_data = 0;
610*1cf8ddccSTomi Valkeinen u8 gpio_input_ctrl = 0;
611*1cf8ddccSTomi Valkeinen u8 gpio_pin_sts = 0;
6126363db1cSTomi Valkeinen
6136363db1cSTomi Valkeinen for (i = 0; i < sizeof(id); i++)
6146363db1cSTomi Valkeinen ub953_read(priv, UB953_REG_FPD3_RX_ID(i), &id[i]);
6156363db1cSTomi Valkeinen
6166363db1cSTomi Valkeinen dev_info(dev, "ID '%.*s'\n", (int)sizeof(id), id);
6176363db1cSTomi Valkeinen
6186363db1cSTomi Valkeinen ub953_read(priv, UB953_REG_GENERAL_STATUS, &v);
6196363db1cSTomi Valkeinen dev_info(dev, "GENERAL_STATUS %#02x\n", v);
6206363db1cSTomi Valkeinen
6216363db1cSTomi Valkeinen ub953_read(priv, UB953_REG_CRC_ERR_CNT1, &v1);
6226363db1cSTomi Valkeinen ub953_read(priv, UB953_REG_CRC_ERR_CNT2, &v2);
6236363db1cSTomi Valkeinen dev_info(dev, "CRC error count %u\n", v1 | (v2 << 8));
6246363db1cSTomi Valkeinen
6256363db1cSTomi Valkeinen ub953_read(priv, UB953_REG_CSI_ERR_CNT, &v);
6266363db1cSTomi Valkeinen dev_info(dev, "CSI error count %u\n", v);
6276363db1cSTomi Valkeinen
6286363db1cSTomi Valkeinen ub953_read(priv, UB953_REG_CSI_ERR_STATUS, &v);
6296363db1cSTomi Valkeinen dev_info(dev, "CSI_ERR_STATUS %#02x\n", v);
6306363db1cSTomi Valkeinen
6316363db1cSTomi Valkeinen ub953_read(priv, UB953_REG_CSI_ERR_DLANE01, &v);
6326363db1cSTomi Valkeinen dev_info(dev, "CSI_ERR_DLANE01 %#02x\n", v);
6336363db1cSTomi Valkeinen
6346363db1cSTomi Valkeinen ub953_read(priv, UB953_REG_CSI_ERR_DLANE23, &v);
6356363db1cSTomi Valkeinen dev_info(dev, "CSI_ERR_DLANE23 %#02x\n", v);
6366363db1cSTomi Valkeinen
6376363db1cSTomi Valkeinen ub953_read(priv, UB953_REG_CSI_ERR_CLK_LANE, &v);
6386363db1cSTomi Valkeinen dev_info(dev, "CSI_ERR_CLK_LANE %#02x\n", v);
6396363db1cSTomi Valkeinen
6406363db1cSTomi Valkeinen ub953_read(priv, UB953_REG_CSI_PKT_HDR_VC_ID, &v);
6416363db1cSTomi Valkeinen dev_info(dev, "CSI packet header VC %u ID %u\n", v >> 6, v & 0x3f);
6426363db1cSTomi Valkeinen
6436363db1cSTomi Valkeinen ub953_read(priv, UB953_REG_PKT_HDR_WC_LSB, &v1);
6446363db1cSTomi Valkeinen ub953_read(priv, UB953_REG_PKT_HDR_WC_MSB, &v2);
6456363db1cSTomi Valkeinen dev_info(dev, "CSI packet header WC %u\n", (v2 << 8) | v1);
6466363db1cSTomi Valkeinen
6476363db1cSTomi Valkeinen ub953_read(priv, UB953_REG_CSI_ECC, &v);
6486363db1cSTomi Valkeinen dev_info(dev, "CSI ECC %#02x\n", v);
6496363db1cSTomi Valkeinen
6506363db1cSTomi Valkeinen ub953_read(priv, UB953_REG_LOCAL_GPIO_DATA, &gpio_local_data);
6516363db1cSTomi Valkeinen ub953_read(priv, UB953_REG_GPIO_INPUT_CTRL, &gpio_input_ctrl);
6526363db1cSTomi Valkeinen ub953_read(priv, UB953_REG_GPIO_PIN_STS, &gpio_pin_sts);
6536363db1cSTomi Valkeinen
6546363db1cSTomi Valkeinen for (i = 0; i < UB953_NUM_GPIOS; i++) {
6556363db1cSTomi Valkeinen dev_info(dev,
6566363db1cSTomi Valkeinen "GPIO%u: remote: %u is_input: %u is_output: %u val: %u sts: %u\n",
6576363db1cSTomi Valkeinen i,
6586363db1cSTomi Valkeinen !!(gpio_local_data & UB953_REG_LOCAL_GPIO_DATA_GPIO_RMTEN(i)),
6596363db1cSTomi Valkeinen !!(gpio_input_ctrl & UB953_REG_GPIO_INPUT_CTRL_INPUT_EN(i)),
6606363db1cSTomi Valkeinen !!(gpio_input_ctrl & UB953_REG_GPIO_INPUT_CTRL_OUT_EN(i)),
6616363db1cSTomi Valkeinen !!(gpio_local_data & UB953_REG_LOCAL_GPIO_DATA_GPIO_OUT_SRC(i)),
6626363db1cSTomi Valkeinen !!(gpio_pin_sts & UB953_REG_GPIO_PIN_STS_GPIO_STS(i)));
6636363db1cSTomi Valkeinen }
6646363db1cSTomi Valkeinen
6656363db1cSTomi Valkeinen return 0;
6666363db1cSTomi Valkeinen }
6676363db1cSTomi Valkeinen
ub953_enable_streams(struct v4l2_subdev * sd,struct v4l2_subdev_state * state,u32 pad,u64 streams_mask)6686363db1cSTomi Valkeinen static int ub953_enable_streams(struct v4l2_subdev *sd,
6696363db1cSTomi Valkeinen struct v4l2_subdev_state *state, u32 pad,
6706363db1cSTomi Valkeinen u64 streams_mask)
6716363db1cSTomi Valkeinen {
6726363db1cSTomi Valkeinen struct ub953_data *priv = sd_to_ub953(sd);
6736363db1cSTomi Valkeinen u64 sink_streams;
6746363db1cSTomi Valkeinen int ret;
6756363db1cSTomi Valkeinen
6766363db1cSTomi Valkeinen sink_streams = v4l2_subdev_state_xlate_streams(state, UB953_PAD_SOURCE,
6776363db1cSTomi Valkeinen UB953_PAD_SINK,
6786363db1cSTomi Valkeinen &streams_mask);
6796363db1cSTomi Valkeinen
6806363db1cSTomi Valkeinen ret = v4l2_subdev_enable_streams(priv->source_sd, priv->source_sd_pad,
6816363db1cSTomi Valkeinen sink_streams);
6826363db1cSTomi Valkeinen if (ret)
6836363db1cSTomi Valkeinen return ret;
6846363db1cSTomi Valkeinen
6856363db1cSTomi Valkeinen priv->enabled_source_streams |= streams_mask;
6866363db1cSTomi Valkeinen
6876363db1cSTomi Valkeinen return 0;
6886363db1cSTomi Valkeinen }
6896363db1cSTomi Valkeinen
ub953_disable_streams(struct v4l2_subdev * sd,struct v4l2_subdev_state * state,u32 pad,u64 streams_mask)6906363db1cSTomi Valkeinen static int ub953_disable_streams(struct v4l2_subdev *sd,
6916363db1cSTomi Valkeinen struct v4l2_subdev_state *state, u32 pad,
6926363db1cSTomi Valkeinen u64 streams_mask)
6936363db1cSTomi Valkeinen {
6946363db1cSTomi Valkeinen struct ub953_data *priv = sd_to_ub953(sd);
6956363db1cSTomi Valkeinen u64 sink_streams;
6966363db1cSTomi Valkeinen int ret;
6976363db1cSTomi Valkeinen
6986363db1cSTomi Valkeinen sink_streams = v4l2_subdev_state_xlate_streams(state, UB953_PAD_SOURCE,
6996363db1cSTomi Valkeinen UB953_PAD_SINK,
7006363db1cSTomi Valkeinen &streams_mask);
7016363db1cSTomi Valkeinen
7026363db1cSTomi Valkeinen ret = v4l2_subdev_disable_streams(priv->source_sd, priv->source_sd_pad,
7036363db1cSTomi Valkeinen sink_streams);
7046363db1cSTomi Valkeinen if (ret)
7056363db1cSTomi Valkeinen return ret;
7066363db1cSTomi Valkeinen
7076363db1cSTomi Valkeinen priv->enabled_source_streams &= ~streams_mask;
7086363db1cSTomi Valkeinen
7096363db1cSTomi Valkeinen return 0;
7106363db1cSTomi Valkeinen }
7116363db1cSTomi Valkeinen
7126363db1cSTomi Valkeinen static const struct v4l2_subdev_pad_ops ub953_pad_ops = {
7136363db1cSTomi Valkeinen .enable_streams = ub953_enable_streams,
7146363db1cSTomi Valkeinen .disable_streams = ub953_disable_streams,
7156363db1cSTomi Valkeinen .set_routing = ub953_set_routing,
7166363db1cSTomi Valkeinen .get_frame_desc = ub953_get_frame_desc,
7176363db1cSTomi Valkeinen .get_fmt = v4l2_subdev_get_fmt,
7186363db1cSTomi Valkeinen .set_fmt = ub953_set_fmt,
7196363db1cSTomi Valkeinen .init_cfg = ub953_init_cfg,
7206363db1cSTomi Valkeinen };
7216363db1cSTomi Valkeinen
7226363db1cSTomi Valkeinen static const struct v4l2_subdev_core_ops ub953_subdev_core_ops = {
7236363db1cSTomi Valkeinen .log_status = ub953_log_status,
7246363db1cSTomi Valkeinen .subscribe_event = v4l2_ctrl_subdev_subscribe_event,
7256363db1cSTomi Valkeinen .unsubscribe_event = v4l2_event_subdev_unsubscribe,
7266363db1cSTomi Valkeinen };
7276363db1cSTomi Valkeinen
7286363db1cSTomi Valkeinen static const struct v4l2_subdev_ops ub953_subdev_ops = {
7296363db1cSTomi Valkeinen .core = &ub953_subdev_core_ops,
7306363db1cSTomi Valkeinen .pad = &ub953_pad_ops,
7316363db1cSTomi Valkeinen };
7326363db1cSTomi Valkeinen
7336363db1cSTomi Valkeinen static const struct media_entity_operations ub953_entity_ops = {
7346363db1cSTomi Valkeinen .link_validate = v4l2_subdev_link_validate,
7356363db1cSTomi Valkeinen };
7366363db1cSTomi Valkeinen
ub953_notify_bound(struct v4l2_async_notifier * notifier,struct v4l2_subdev * source_subdev,struct v4l2_async_connection * asd)7376363db1cSTomi Valkeinen static int ub953_notify_bound(struct v4l2_async_notifier *notifier,
7386363db1cSTomi Valkeinen struct v4l2_subdev *source_subdev,
739adb2dcd5SSakari Ailus struct v4l2_async_connection *asd)
7406363db1cSTomi Valkeinen {
7416363db1cSTomi Valkeinen struct ub953_data *priv = sd_to_ub953(notifier->sd);
7426363db1cSTomi Valkeinen struct device *dev = &priv->client->dev;
7436363db1cSTomi Valkeinen int ret;
7446363db1cSTomi Valkeinen
7456363db1cSTomi Valkeinen ret = media_entity_get_fwnode_pad(&source_subdev->entity,
7466363db1cSTomi Valkeinen source_subdev->fwnode,
7476363db1cSTomi Valkeinen MEDIA_PAD_FL_SOURCE);
7486363db1cSTomi Valkeinen if (ret < 0) {
7496363db1cSTomi Valkeinen dev_err(dev, "Failed to find pad for %s\n",
7506363db1cSTomi Valkeinen source_subdev->name);
7516363db1cSTomi Valkeinen return ret;
7526363db1cSTomi Valkeinen }
7536363db1cSTomi Valkeinen
7546363db1cSTomi Valkeinen priv->source_sd = source_subdev;
7556363db1cSTomi Valkeinen priv->source_sd_pad = ret;
7566363db1cSTomi Valkeinen
7576363db1cSTomi Valkeinen ret = media_create_pad_link(&source_subdev->entity, priv->source_sd_pad,
7586363db1cSTomi Valkeinen &priv->sd.entity, 0,
7596363db1cSTomi Valkeinen MEDIA_LNK_FL_ENABLED |
7606363db1cSTomi Valkeinen MEDIA_LNK_FL_IMMUTABLE);
7616363db1cSTomi Valkeinen if (ret) {
7626363db1cSTomi Valkeinen dev_err(dev, "Unable to link %s:%u -> %s:0\n",
7636363db1cSTomi Valkeinen source_subdev->name, priv->source_sd_pad,
7646363db1cSTomi Valkeinen priv->sd.name);
7656363db1cSTomi Valkeinen return ret;
7666363db1cSTomi Valkeinen }
7676363db1cSTomi Valkeinen
7686363db1cSTomi Valkeinen return 0;
7696363db1cSTomi Valkeinen }
7706363db1cSTomi Valkeinen
7716363db1cSTomi Valkeinen static const struct v4l2_async_notifier_operations ub953_notify_ops = {
7726363db1cSTomi Valkeinen .bound = ub953_notify_bound,
7736363db1cSTomi Valkeinen };
7746363db1cSTomi Valkeinen
ub953_v4l2_notifier_register(struct ub953_data * priv)7756363db1cSTomi Valkeinen static int ub953_v4l2_notifier_register(struct ub953_data *priv)
7766363db1cSTomi Valkeinen {
7776363db1cSTomi Valkeinen struct device *dev = &priv->client->dev;
778adb2dcd5SSakari Ailus struct v4l2_async_connection *asd;
7796363db1cSTomi Valkeinen struct fwnode_handle *ep_fwnode;
7806363db1cSTomi Valkeinen int ret;
7816363db1cSTomi Valkeinen
7826363db1cSTomi Valkeinen ep_fwnode = fwnode_graph_get_endpoint_by_id(dev_fwnode(dev),
7836363db1cSTomi Valkeinen UB953_PAD_SINK, 0, 0);
7846363db1cSTomi Valkeinen if (!ep_fwnode) {
7856363db1cSTomi Valkeinen dev_err(dev, "No graph endpoint\n");
7866363db1cSTomi Valkeinen return -ENODEV;
7876363db1cSTomi Valkeinen }
7886363db1cSTomi Valkeinen
789b8ec754aSSakari Ailus v4l2_async_subdev_nf_init(&priv->notifier, &priv->sd);
7906363db1cSTomi Valkeinen
7916363db1cSTomi Valkeinen asd = v4l2_async_nf_add_fwnode_remote(&priv->notifier, ep_fwnode,
792adb2dcd5SSakari Ailus struct v4l2_async_connection);
7936363db1cSTomi Valkeinen
7946363db1cSTomi Valkeinen fwnode_handle_put(ep_fwnode);
7956363db1cSTomi Valkeinen
7966363db1cSTomi Valkeinen if (IS_ERR(asd)) {
7976363db1cSTomi Valkeinen dev_err(dev, "Failed to add subdev: %ld", PTR_ERR(asd));
7986363db1cSTomi Valkeinen v4l2_async_nf_cleanup(&priv->notifier);
7996363db1cSTomi Valkeinen return PTR_ERR(asd);
8006363db1cSTomi Valkeinen }
8016363db1cSTomi Valkeinen
8026363db1cSTomi Valkeinen priv->notifier.ops = &ub953_notify_ops;
8036363db1cSTomi Valkeinen
804b8ec754aSSakari Ailus ret = v4l2_async_nf_register(&priv->notifier);
8056363db1cSTomi Valkeinen if (ret) {
8066363db1cSTomi Valkeinen dev_err(dev, "Failed to register subdev_notifier");
8076363db1cSTomi Valkeinen v4l2_async_nf_cleanup(&priv->notifier);
8086363db1cSTomi Valkeinen return ret;
8096363db1cSTomi Valkeinen }
8106363db1cSTomi Valkeinen
8116363db1cSTomi Valkeinen return 0;
8126363db1cSTomi Valkeinen }
8136363db1cSTomi Valkeinen
ub953_v4l2_notifier_unregister(struct ub953_data * priv)8146363db1cSTomi Valkeinen static void ub953_v4l2_notifier_unregister(struct ub953_data *priv)
8156363db1cSTomi Valkeinen {
8166363db1cSTomi Valkeinen v4l2_async_nf_unregister(&priv->notifier);
8176363db1cSTomi Valkeinen v4l2_async_nf_cleanup(&priv->notifier);
8186363db1cSTomi Valkeinen }
8196363db1cSTomi Valkeinen
8206363db1cSTomi Valkeinen /*
8216363db1cSTomi Valkeinen * Probing
8226363db1cSTomi Valkeinen */
8236363db1cSTomi Valkeinen
ub953_i2c_master_init(struct ub953_data * priv)8246363db1cSTomi Valkeinen static int ub953_i2c_master_init(struct ub953_data *priv)
8256363db1cSTomi Valkeinen {
8266363db1cSTomi Valkeinen /* i2c fast mode */
8276363db1cSTomi Valkeinen u32 ref = 26250000;
8286363db1cSTomi Valkeinen u32 scl_high = 915; /* ns */
8296363db1cSTomi Valkeinen u32 scl_low = 1641; /* ns */
8306363db1cSTomi Valkeinen int ret;
8316363db1cSTomi Valkeinen
8326363db1cSTomi Valkeinen scl_high = div64_u64((u64)scl_high * ref, 1000000000) - 5;
8336363db1cSTomi Valkeinen scl_low = div64_u64((u64)scl_low * ref, 1000000000) - 5;
8346363db1cSTomi Valkeinen
8356363db1cSTomi Valkeinen ret = ub953_write(priv, UB953_REG_SCL_HIGH_TIME, scl_high);
8366363db1cSTomi Valkeinen if (ret)
8376363db1cSTomi Valkeinen return ret;
8386363db1cSTomi Valkeinen
8396363db1cSTomi Valkeinen ret = ub953_write(priv, UB953_REG_SCL_LOW_TIME, scl_low);
8406363db1cSTomi Valkeinen if (ret)
8416363db1cSTomi Valkeinen return ret;
8426363db1cSTomi Valkeinen
8436363db1cSTomi Valkeinen return 0;
8446363db1cSTomi Valkeinen }
8456363db1cSTomi Valkeinen
ub953_get_fc_rate(struct ub953_data * priv)8466363db1cSTomi Valkeinen static u64 ub953_get_fc_rate(struct ub953_data *priv)
8476363db1cSTomi Valkeinen {
848618aba51STomi Valkeinen switch (priv->mode) {
849618aba51STomi Valkeinen case UB953_MODE_SYNC:
8506363db1cSTomi Valkeinen if (priv->hw_data->is_ub971)
8516363db1cSTomi Valkeinen return priv->plat_data->bc_rate * 160ull;
8526363db1cSTomi Valkeinen else
8536363db1cSTomi Valkeinen return priv->plat_data->bc_rate / 2 * 160ull;
854618aba51STomi Valkeinen
855618aba51STomi Valkeinen case UB953_MODE_NONSYNC_EXT:
856618aba51STomi Valkeinen /* CLKIN_DIV = 1 always */
857618aba51STomi Valkeinen return clk_get_rate(priv->clkin) * 80ull;
858618aba51STomi Valkeinen
859618aba51STomi Valkeinen default:
860618aba51STomi Valkeinen /* Not supported */
861618aba51STomi Valkeinen return 0;
862618aba51STomi Valkeinen }
8636363db1cSTomi Valkeinen }
8646363db1cSTomi Valkeinen
ub953_calc_clkout_ub953(struct ub953_data * priv,unsigned long target,u64 fc,u8 * hs_div,u8 * m,u8 * n)8656363db1cSTomi Valkeinen static unsigned long ub953_calc_clkout_ub953(struct ub953_data *priv,
8666363db1cSTomi Valkeinen unsigned long target, u64 fc,
8676363db1cSTomi Valkeinen u8 *hs_div, u8 *m, u8 *n)
8686363db1cSTomi Valkeinen {
8696363db1cSTomi Valkeinen /*
8706363db1cSTomi Valkeinen * We always use 4 as a pre-divider (HS_CLK_DIV = 2).
8716363db1cSTomi Valkeinen *
8726363db1cSTomi Valkeinen * According to the datasheet:
8736363db1cSTomi Valkeinen * - "HS_CLK_DIV typically should be set to either 16, 8, or 4 (default)."
8746363db1cSTomi Valkeinen * - "if it is not possible to have an integer ratio of N/M, it is best to
8756363db1cSTomi Valkeinen * select a smaller value for HS_CLK_DIV.
8766363db1cSTomi Valkeinen *
8776363db1cSTomi Valkeinen * For above reasons the default HS_CLK_DIV seems the best in the average
8786363db1cSTomi Valkeinen * case. Use always that value to keep the code simple.
8796363db1cSTomi Valkeinen */
8806363db1cSTomi Valkeinen static const unsigned long hs_clk_div = 4;
8816363db1cSTomi Valkeinen
8826363db1cSTomi Valkeinen u64 fc_divided;
8836363db1cSTomi Valkeinen unsigned long mul, div;
8846363db1cSTomi Valkeinen unsigned long res;
8856363db1cSTomi Valkeinen
8866363db1cSTomi Valkeinen /* clkout = fc / hs_clk_div * m / n */
8876363db1cSTomi Valkeinen
8886363db1cSTomi Valkeinen fc_divided = div_u64(fc, hs_clk_div);
8896363db1cSTomi Valkeinen
8906363db1cSTomi Valkeinen rational_best_approximation(target, fc_divided, (1 << 5) - 1,
8916363db1cSTomi Valkeinen (1 << 8) - 1, &mul, &div);
8926363db1cSTomi Valkeinen
8936363db1cSTomi Valkeinen res = div_u64(fc_divided * mul, div);
8946363db1cSTomi Valkeinen
8956363db1cSTomi Valkeinen *hs_div = hs_clk_div;
8966363db1cSTomi Valkeinen *m = mul;
8976363db1cSTomi Valkeinen *n = div;
8986363db1cSTomi Valkeinen
8996363db1cSTomi Valkeinen return res;
9006363db1cSTomi Valkeinen }
9016363db1cSTomi Valkeinen
ub953_calc_clkout_ub971(struct ub953_data * priv,unsigned long target,u64 fc,u8 * m,u8 * n)9026363db1cSTomi Valkeinen static unsigned long ub953_calc_clkout_ub971(struct ub953_data *priv,
9036363db1cSTomi Valkeinen unsigned long target, u64 fc,
9046363db1cSTomi Valkeinen u8 *m, u8 *n)
9056363db1cSTomi Valkeinen {
9066363db1cSTomi Valkeinen u64 fc_divided;
9076363db1cSTomi Valkeinen unsigned long mul, div;
9086363db1cSTomi Valkeinen unsigned long res;
9096363db1cSTomi Valkeinen
9106363db1cSTomi Valkeinen /* clkout = fc * m / (8 * n) */
9116363db1cSTomi Valkeinen
9126363db1cSTomi Valkeinen fc_divided = div_u64(fc, 8);
9136363db1cSTomi Valkeinen
9146363db1cSTomi Valkeinen rational_best_approximation(target, fc_divided, (1 << 5) - 1,
9156363db1cSTomi Valkeinen (1 << 8) - 1, &mul, &div);
9166363db1cSTomi Valkeinen
9176363db1cSTomi Valkeinen res = div_u64(fc_divided * mul, div);
9186363db1cSTomi Valkeinen
9196363db1cSTomi Valkeinen *m = mul;
9206363db1cSTomi Valkeinen *n = div;
9216363db1cSTomi Valkeinen
9226363db1cSTomi Valkeinen return res;
9236363db1cSTomi Valkeinen }
9246363db1cSTomi Valkeinen
ub953_calc_clkout_params(struct ub953_data * priv,unsigned long target_rate,struct ub953_clkout_data * clkout_data)925d7d7a9abSTomi Valkeinen static void ub953_calc_clkout_params(struct ub953_data *priv,
926d7d7a9abSTomi Valkeinen unsigned long target_rate,
927d7d7a9abSTomi Valkeinen struct ub953_clkout_data *clkout_data)
928d7d7a9abSTomi Valkeinen {
929d7d7a9abSTomi Valkeinen struct device *dev = &priv->client->dev;
930d7d7a9abSTomi Valkeinen unsigned long clkout_rate;
931d7d7a9abSTomi Valkeinen u64 fc_rate;
932d7d7a9abSTomi Valkeinen
933d7d7a9abSTomi Valkeinen fc_rate = ub953_get_fc_rate(priv);
934d7d7a9abSTomi Valkeinen
935d7d7a9abSTomi Valkeinen if (priv->hw_data->is_ub971) {
936d7d7a9abSTomi Valkeinen u8 m, n;
937d7d7a9abSTomi Valkeinen
938d7d7a9abSTomi Valkeinen clkout_rate = ub953_calc_clkout_ub971(priv, target_rate,
939d7d7a9abSTomi Valkeinen fc_rate, &m, &n);
940d7d7a9abSTomi Valkeinen
941d7d7a9abSTomi Valkeinen clkout_data->m = m;
942d7d7a9abSTomi Valkeinen clkout_data->n = n;
943d7d7a9abSTomi Valkeinen
944d7d7a9abSTomi Valkeinen dev_dbg(dev, "%s %llu * %u / (8 * %u) = %lu (requested %lu)",
945d7d7a9abSTomi Valkeinen __func__, fc_rate, m, n, clkout_rate, target_rate);
946d7d7a9abSTomi Valkeinen } else {
947d7d7a9abSTomi Valkeinen u8 hs_div, m, n;
948d7d7a9abSTomi Valkeinen
949d7d7a9abSTomi Valkeinen clkout_rate = ub953_calc_clkout_ub953(priv, target_rate,
950d7d7a9abSTomi Valkeinen fc_rate, &hs_div, &m, &n);
951d7d7a9abSTomi Valkeinen
952d7d7a9abSTomi Valkeinen clkout_data->hs_div = hs_div;
953d7d7a9abSTomi Valkeinen clkout_data->m = m;
954d7d7a9abSTomi Valkeinen clkout_data->n = n;
955d7d7a9abSTomi Valkeinen
956d7d7a9abSTomi Valkeinen dev_dbg(dev, "%s %llu / %u * %u / %u = %lu (requested %lu)",
957d7d7a9abSTomi Valkeinen __func__, fc_rate, hs_div, m, n, clkout_rate,
958d7d7a9abSTomi Valkeinen target_rate);
959d7d7a9abSTomi Valkeinen }
960d7d7a9abSTomi Valkeinen
961d7d7a9abSTomi Valkeinen clkout_data->rate = clkout_rate;
962d7d7a9abSTomi Valkeinen }
963d7d7a9abSTomi Valkeinen
ub953_write_clkout_regs(struct ub953_data * priv,const struct ub953_clkout_data * clkout_data)964d7d7a9abSTomi Valkeinen static void ub953_write_clkout_regs(struct ub953_data *priv,
965d7d7a9abSTomi Valkeinen const struct ub953_clkout_data *clkout_data)
966d7d7a9abSTomi Valkeinen {
967d7d7a9abSTomi Valkeinen u8 clkout_ctrl0, clkout_ctrl1;
968d7d7a9abSTomi Valkeinen
969d7d7a9abSTomi Valkeinen if (priv->hw_data->is_ub971)
970d7d7a9abSTomi Valkeinen clkout_ctrl0 = clkout_data->m;
971d7d7a9abSTomi Valkeinen else
972d7d7a9abSTomi Valkeinen clkout_ctrl0 = (__ffs(clkout_data->hs_div) << 5) |
973d7d7a9abSTomi Valkeinen clkout_data->m;
974d7d7a9abSTomi Valkeinen
975d7d7a9abSTomi Valkeinen clkout_ctrl1 = clkout_data->n;
976d7d7a9abSTomi Valkeinen
977d7d7a9abSTomi Valkeinen ub953_write(priv, UB953_REG_CLKOUT_CTRL0, clkout_ctrl0);
978d7d7a9abSTomi Valkeinen ub953_write(priv, UB953_REG_CLKOUT_CTRL1, clkout_ctrl1);
979d7d7a9abSTomi Valkeinen }
980d7d7a9abSTomi Valkeinen
ub953_clkout_recalc_rate(struct clk_hw * hw,unsigned long parent_rate)9816363db1cSTomi Valkeinen static unsigned long ub953_clkout_recalc_rate(struct clk_hw *hw,
9826363db1cSTomi Valkeinen unsigned long parent_rate)
9836363db1cSTomi Valkeinen {
9846363db1cSTomi Valkeinen struct ub953_data *priv = container_of(hw, struct ub953_data, clkout_clk_hw);
9856363db1cSTomi Valkeinen struct device *dev = &priv->client->dev;
9866363db1cSTomi Valkeinen u8 ctrl0, ctrl1;
9876363db1cSTomi Valkeinen u32 mul, div;
9886363db1cSTomi Valkeinen u64 fc_rate;
9896363db1cSTomi Valkeinen u32 hs_clk_div;
9906363db1cSTomi Valkeinen u64 rate;
9916363db1cSTomi Valkeinen int ret;
9926363db1cSTomi Valkeinen
9936363db1cSTomi Valkeinen ret = ub953_read(priv, UB953_REG_CLKOUT_CTRL0, &ctrl0);
9946363db1cSTomi Valkeinen if (ret) {
9956363db1cSTomi Valkeinen dev_err(dev, "Failed to read CLKOUT_CTRL0: %d\n", ret);
9966363db1cSTomi Valkeinen return 0;
9976363db1cSTomi Valkeinen }
9986363db1cSTomi Valkeinen
9996363db1cSTomi Valkeinen ret = ub953_read(priv, UB953_REG_CLKOUT_CTRL1, &ctrl1);
10006363db1cSTomi Valkeinen if (ret) {
10016363db1cSTomi Valkeinen dev_err(dev, "Failed to read CLKOUT_CTRL1: %d\n", ret);
10026363db1cSTomi Valkeinen return 0;
10036363db1cSTomi Valkeinen }
10046363db1cSTomi Valkeinen
10056363db1cSTomi Valkeinen fc_rate = ub953_get_fc_rate(priv);
10066363db1cSTomi Valkeinen
10076363db1cSTomi Valkeinen if (priv->hw_data->is_ub971) {
10086363db1cSTomi Valkeinen mul = ctrl0 & 0x1f;
10096363db1cSTomi Valkeinen div = ctrl1;
10106363db1cSTomi Valkeinen
10116363db1cSTomi Valkeinen if (div == 0)
10126363db1cSTomi Valkeinen return 0;
10136363db1cSTomi Valkeinen
10146363db1cSTomi Valkeinen rate = div_u64(fc_rate * mul, 8 * div);
10156363db1cSTomi Valkeinen
10166363db1cSTomi Valkeinen dev_dbg(dev, "clkout: fc rate %llu, mul %u, div %u = %llu\n",
10176363db1cSTomi Valkeinen fc_rate, mul, div, rate);
10186363db1cSTomi Valkeinen } else {
10196363db1cSTomi Valkeinen mul = ctrl0 & 0x1f;
10206363db1cSTomi Valkeinen hs_clk_div = 1 << (ctrl0 >> 5);
10216363db1cSTomi Valkeinen div = ctrl1;
10226363db1cSTomi Valkeinen
10236363db1cSTomi Valkeinen if (div == 0)
10246363db1cSTomi Valkeinen return 0;
10256363db1cSTomi Valkeinen
10266363db1cSTomi Valkeinen rate = div_u64(div_u64(fc_rate, hs_clk_div) * mul, div);
10276363db1cSTomi Valkeinen
10286363db1cSTomi Valkeinen dev_dbg(dev,
10296363db1cSTomi Valkeinen "clkout: fc rate %llu, hs_clk_div %u, mul %u, div %u = %llu\n",
10306363db1cSTomi Valkeinen fc_rate, hs_clk_div, mul, div, rate);
10316363db1cSTomi Valkeinen }
10326363db1cSTomi Valkeinen
10336363db1cSTomi Valkeinen return rate;
10346363db1cSTomi Valkeinen }
10356363db1cSTomi Valkeinen
ub953_clkout_round_rate(struct clk_hw * hw,unsigned long rate,unsigned long * parent_rate)10366363db1cSTomi Valkeinen static long ub953_clkout_round_rate(struct clk_hw *hw, unsigned long rate,
10376363db1cSTomi Valkeinen unsigned long *parent_rate)
10386363db1cSTomi Valkeinen {
10396363db1cSTomi Valkeinen struct ub953_data *priv = container_of(hw, struct ub953_data, clkout_clk_hw);
1040d7d7a9abSTomi Valkeinen struct ub953_clkout_data clkout_data;
10416363db1cSTomi Valkeinen
1042d7d7a9abSTomi Valkeinen ub953_calc_clkout_params(priv, rate, &clkout_data);
10436363db1cSTomi Valkeinen
1044d7d7a9abSTomi Valkeinen return clkout_data.rate;
10456363db1cSTomi Valkeinen }
10466363db1cSTomi Valkeinen
ub953_clkout_set_rate(struct clk_hw * hw,unsigned long rate,unsigned long parent_rate)10476363db1cSTomi Valkeinen static int ub953_clkout_set_rate(struct clk_hw *hw, unsigned long rate,
10486363db1cSTomi Valkeinen unsigned long parent_rate)
10496363db1cSTomi Valkeinen {
10506363db1cSTomi Valkeinen struct ub953_data *priv = container_of(hw, struct ub953_data, clkout_clk_hw);
1051d7d7a9abSTomi Valkeinen struct ub953_clkout_data clkout_data;
10526363db1cSTomi Valkeinen
1053d7d7a9abSTomi Valkeinen ub953_calc_clkout_params(priv, rate, &clkout_data);
10546363db1cSTomi Valkeinen
1055d7d7a9abSTomi Valkeinen dev_dbg(&priv->client->dev, "%s %lu (requested %lu)\n", __func__,
1056d7d7a9abSTomi Valkeinen clkout_data.rate, rate);
10576363db1cSTomi Valkeinen
1058d7d7a9abSTomi Valkeinen ub953_write_clkout_regs(priv, &clkout_data);
10596363db1cSTomi Valkeinen
10606363db1cSTomi Valkeinen return 0;
10616363db1cSTomi Valkeinen }
10626363db1cSTomi Valkeinen
10636363db1cSTomi Valkeinen static const struct clk_ops ub953_clkout_ops = {
10646363db1cSTomi Valkeinen .recalc_rate = ub953_clkout_recalc_rate,
10656363db1cSTomi Valkeinen .round_rate = ub953_clkout_round_rate,
10666363db1cSTomi Valkeinen .set_rate = ub953_clkout_set_rate,
10676363db1cSTomi Valkeinen };
10686363db1cSTomi Valkeinen
ub953_register_clkout(struct ub953_data * priv)10696363db1cSTomi Valkeinen static int ub953_register_clkout(struct ub953_data *priv)
10706363db1cSTomi Valkeinen {
10716363db1cSTomi Valkeinen struct device *dev = &priv->client->dev;
10726363db1cSTomi Valkeinen const struct clk_init_data init = {
10736363db1cSTomi Valkeinen .name = kasprintf(GFP_KERNEL, "ds90%s.%s.clk_out",
10746363db1cSTomi Valkeinen priv->hw_data->model, dev_name(dev)),
10756363db1cSTomi Valkeinen .ops = &ub953_clkout_ops,
10766363db1cSTomi Valkeinen };
1077d7d7a9abSTomi Valkeinen struct ub953_clkout_data clkout_data;
10786363db1cSTomi Valkeinen int ret;
10796363db1cSTomi Valkeinen
10806363db1cSTomi Valkeinen if (!init.name)
10816363db1cSTomi Valkeinen return -ENOMEM;
10826363db1cSTomi Valkeinen
10836363db1cSTomi Valkeinen /* Initialize clkout to 25MHz by default */
1084d7d7a9abSTomi Valkeinen ub953_calc_clkout_params(priv, UB953_DEFAULT_CLKOUT_RATE, &clkout_data);
1085d7d7a9abSTomi Valkeinen ub953_write_clkout_regs(priv, &clkout_data);
10866363db1cSTomi Valkeinen
10876363db1cSTomi Valkeinen priv->clkout_clk_hw.init = &init;
10886363db1cSTomi Valkeinen
10896363db1cSTomi Valkeinen ret = devm_clk_hw_register(dev, &priv->clkout_clk_hw);
10906363db1cSTomi Valkeinen kfree(init.name);
10916363db1cSTomi Valkeinen if (ret)
10926363db1cSTomi Valkeinen return dev_err_probe(dev, ret, "Cannot register clock HW\n");
10936363db1cSTomi Valkeinen
10946363db1cSTomi Valkeinen ret = devm_of_clk_add_hw_provider(dev, of_clk_hw_simple_get,
10956363db1cSTomi Valkeinen &priv->clkout_clk_hw);
10966363db1cSTomi Valkeinen if (ret)
10976363db1cSTomi Valkeinen return dev_err_probe(dev, ret,
10986363db1cSTomi Valkeinen "Cannot add OF clock provider\n");
10996363db1cSTomi Valkeinen
11006363db1cSTomi Valkeinen return 0;
11016363db1cSTomi Valkeinen }
11026363db1cSTomi Valkeinen
ub953_add_i2c_adapter(struct ub953_data * priv)11036363db1cSTomi Valkeinen static int ub953_add_i2c_adapter(struct ub953_data *priv)
11046363db1cSTomi Valkeinen {
11056363db1cSTomi Valkeinen struct device *dev = &priv->client->dev;
11066363db1cSTomi Valkeinen struct fwnode_handle *i2c_handle;
11076363db1cSTomi Valkeinen int ret;
11086363db1cSTomi Valkeinen
11096363db1cSTomi Valkeinen i2c_handle = device_get_named_child_node(dev, "i2c");
11106363db1cSTomi Valkeinen if (!i2c_handle)
11116363db1cSTomi Valkeinen return 0;
11126363db1cSTomi Valkeinen
11136363db1cSTomi Valkeinen ret = i2c_atr_add_adapter(priv->plat_data->atr, priv->plat_data->port,
11146363db1cSTomi Valkeinen dev, i2c_handle);
11156363db1cSTomi Valkeinen
11166363db1cSTomi Valkeinen fwnode_handle_put(i2c_handle);
11176363db1cSTomi Valkeinen
11186363db1cSTomi Valkeinen if (ret)
11196363db1cSTomi Valkeinen return ret;
11206363db1cSTomi Valkeinen
11216363db1cSTomi Valkeinen return 0;
11226363db1cSTomi Valkeinen }
11236363db1cSTomi Valkeinen
11246363db1cSTomi Valkeinen static const struct regmap_config ub953_regmap_config = {
11256363db1cSTomi Valkeinen .name = "ds90ub953",
11266363db1cSTomi Valkeinen .reg_bits = 8,
11276363db1cSTomi Valkeinen .val_bits = 8,
11286363db1cSTomi Valkeinen .reg_format_endian = REGMAP_ENDIAN_DEFAULT,
11296363db1cSTomi Valkeinen .val_format_endian = REGMAP_ENDIAN_DEFAULT,
11306363db1cSTomi Valkeinen };
11316363db1cSTomi Valkeinen
ub953_parse_dt(struct ub953_data * priv)11326363db1cSTomi Valkeinen static int ub953_parse_dt(struct ub953_data *priv)
11336363db1cSTomi Valkeinen {
11346363db1cSTomi Valkeinen struct device *dev = &priv->client->dev;
1135255b959bSTomi Valkeinen struct v4l2_fwnode_endpoint vep = {
1136255b959bSTomi Valkeinen .bus_type = V4L2_MBUS_CSI2_DPHY,
1137255b959bSTomi Valkeinen };
11386363db1cSTomi Valkeinen struct fwnode_handle *ep_fwnode;
1139255b959bSTomi Valkeinen unsigned char nlanes;
11406363db1cSTomi Valkeinen int ret;
11416363db1cSTomi Valkeinen
11426363db1cSTomi Valkeinen ep_fwnode = fwnode_graph_get_endpoint_by_id(dev_fwnode(dev),
11436363db1cSTomi Valkeinen UB953_PAD_SINK, 0, 0);
11446363db1cSTomi Valkeinen if (!ep_fwnode)
11456363db1cSTomi Valkeinen return dev_err_probe(dev, -ENOENT, "no endpoint found\n");
11466363db1cSTomi Valkeinen
1147255b959bSTomi Valkeinen ret = v4l2_fwnode_endpoint_parse(ep_fwnode, &vep);
11486363db1cSTomi Valkeinen
11496363db1cSTomi Valkeinen fwnode_handle_put(ep_fwnode);
11506363db1cSTomi Valkeinen
1151255b959bSTomi Valkeinen if (ret)
11526363db1cSTomi Valkeinen return dev_err_probe(dev, ret,
1153255b959bSTomi Valkeinen "failed to parse sink endpoint data\n");
11546363db1cSTomi Valkeinen
1155255b959bSTomi Valkeinen nlanes = vep.bus.mipi_csi2.num_data_lanes;
1156255b959bSTomi Valkeinen if (nlanes != 1 && nlanes != 2 && nlanes != 4)
11576363db1cSTomi Valkeinen return dev_err_probe(dev, -EINVAL,
1158255b959bSTomi Valkeinen "bad number of data-lanes: %u\n", nlanes);
11596363db1cSTomi Valkeinen
1160255b959bSTomi Valkeinen priv->num_data_lanes = nlanes;
11616363db1cSTomi Valkeinen
1162c7a52ae0STomi Valkeinen priv->non_continous_clk = vep.bus.mipi_csi2.flags &
1163c7a52ae0STomi Valkeinen V4L2_MBUS_CSI2_NONCONTINUOUS_CLOCK;
1164c7a52ae0STomi Valkeinen
11656363db1cSTomi Valkeinen return 0;
11666363db1cSTomi Valkeinen }
11676363db1cSTomi Valkeinen
ub953_hw_init(struct ub953_data * priv)11686363db1cSTomi Valkeinen static int ub953_hw_init(struct ub953_data *priv)
11696363db1cSTomi Valkeinen {
11706363db1cSTomi Valkeinen struct device *dev = &priv->client->dev;
11716363db1cSTomi Valkeinen bool mode_override;
11726363db1cSTomi Valkeinen int ret;
11736363db1cSTomi Valkeinen u8 v;
11746363db1cSTomi Valkeinen
11756363db1cSTomi Valkeinen ret = ub953_read(priv, UB953_REG_MODE_SEL, &v);
11766363db1cSTomi Valkeinen if (ret)
11776363db1cSTomi Valkeinen return ret;
11786363db1cSTomi Valkeinen
11796363db1cSTomi Valkeinen if (!(v & UB953_REG_MODE_SEL_MODE_DONE))
11806363db1cSTomi Valkeinen return dev_err_probe(dev, -EIO, "Mode value not stabilized\n");
11816363db1cSTomi Valkeinen
11826363db1cSTomi Valkeinen mode_override = v & UB953_REG_MODE_SEL_MODE_OVERRIDE;
11836363db1cSTomi Valkeinen
11846363db1cSTomi Valkeinen switch (v & UB953_REG_MODE_SEL_MODE_MASK) {
11856363db1cSTomi Valkeinen case 0:
11866363db1cSTomi Valkeinen priv->mode = UB953_MODE_SYNC;
11876363db1cSTomi Valkeinen break;
11886363db1cSTomi Valkeinen case 2:
11896363db1cSTomi Valkeinen priv->mode = UB953_MODE_NONSYNC_EXT;
11906363db1cSTomi Valkeinen break;
11916363db1cSTomi Valkeinen case 3:
11926363db1cSTomi Valkeinen priv->mode = UB953_MODE_NONSYNC_INT;
11936363db1cSTomi Valkeinen break;
11946363db1cSTomi Valkeinen case 5:
11956363db1cSTomi Valkeinen priv->mode = UB953_MODE_DVP;
11966363db1cSTomi Valkeinen break;
11976363db1cSTomi Valkeinen default:
11986363db1cSTomi Valkeinen return dev_err_probe(dev, -EIO,
11996363db1cSTomi Valkeinen "Invalid mode in mode register\n");
12006363db1cSTomi Valkeinen }
12016363db1cSTomi Valkeinen
12026363db1cSTomi Valkeinen dev_dbg(dev, "mode from %s: %#x\n", mode_override ? "reg" : "strap",
12036363db1cSTomi Valkeinen priv->mode);
12046363db1cSTomi Valkeinen
1205618aba51STomi Valkeinen if (priv->mode != UB953_MODE_SYNC &&
1206618aba51STomi Valkeinen priv->mode != UB953_MODE_NONSYNC_EXT)
12076363db1cSTomi Valkeinen return dev_err_probe(dev, -ENODEV,
1208618aba51STomi Valkeinen "Unsupported mode selected: %u\n",
1209618aba51STomi Valkeinen priv->mode);
1210618aba51STomi Valkeinen
1211618aba51STomi Valkeinen if (priv->mode == UB953_MODE_NONSYNC_EXT && !priv->clkin)
1212618aba51STomi Valkeinen return dev_err_probe(dev, -EINVAL,
1213618aba51STomi Valkeinen "clkin required for non-sync ext mode\n");
12146363db1cSTomi Valkeinen
12156363db1cSTomi Valkeinen ret = ub953_read(priv, UB953_REG_REV_MASK_ID, &v);
12166363db1cSTomi Valkeinen if (ret)
12176363db1cSTomi Valkeinen return dev_err_probe(dev, ret, "Failed to read revision");
12186363db1cSTomi Valkeinen
12196363db1cSTomi Valkeinen dev_info(dev, "Found %s rev/mask %#04x\n", priv->hw_data->model, v);
12206363db1cSTomi Valkeinen
12216363db1cSTomi Valkeinen ret = ub953_read(priv, UB953_REG_GENERAL_CFG, &v);
12226363db1cSTomi Valkeinen if (ret)
12236363db1cSTomi Valkeinen return ret;
12246363db1cSTomi Valkeinen
12256363db1cSTomi Valkeinen dev_dbg(dev, "i2c strap setting %s V\n",
12266363db1cSTomi Valkeinen (v & UB953_REG_GENERAL_CFG_I2C_STRAP_MODE) ? "1.8" : "3.3");
12276363db1cSTomi Valkeinen
12286363db1cSTomi Valkeinen ret = ub953_i2c_master_init(priv);
12296363db1cSTomi Valkeinen if (ret)
12306363db1cSTomi Valkeinen return dev_err_probe(dev, ret, "i2c init failed\n");
12316363db1cSTomi Valkeinen
12326363db1cSTomi Valkeinen ub953_write(priv, UB953_REG_GENERAL_CFG,
1233c7a52ae0STomi Valkeinen (priv->non_continous_clk ? 0 : UB953_REG_GENERAL_CFG_CONT_CLK) |
12346363db1cSTomi Valkeinen ((priv->num_data_lanes - 1) << UB953_REG_GENERAL_CFG_CSI_LANE_SEL_SHIFT) |
12356363db1cSTomi Valkeinen UB953_REG_GENERAL_CFG_CRC_TX_GEN_ENABLE);
12366363db1cSTomi Valkeinen
12376363db1cSTomi Valkeinen return 0;
12386363db1cSTomi Valkeinen }
12396363db1cSTomi Valkeinen
ub953_subdev_init(struct ub953_data * priv)12406363db1cSTomi Valkeinen static int ub953_subdev_init(struct ub953_data *priv)
12416363db1cSTomi Valkeinen {
12426363db1cSTomi Valkeinen struct device *dev = &priv->client->dev;
12436363db1cSTomi Valkeinen int ret;
12446363db1cSTomi Valkeinen
12456363db1cSTomi Valkeinen v4l2_i2c_subdev_init(&priv->sd, priv->client, &ub953_subdev_ops);
12466363db1cSTomi Valkeinen
12476363db1cSTomi Valkeinen priv->sd.flags |= V4L2_SUBDEV_FL_HAS_DEVNODE |
12486363db1cSTomi Valkeinen V4L2_SUBDEV_FL_HAS_EVENTS | V4L2_SUBDEV_FL_STREAMS;
12496363db1cSTomi Valkeinen priv->sd.entity.function = MEDIA_ENT_F_VID_IF_BRIDGE;
12506363db1cSTomi Valkeinen priv->sd.entity.ops = &ub953_entity_ops;
12516363db1cSTomi Valkeinen
12526363db1cSTomi Valkeinen priv->pads[0].flags = MEDIA_PAD_FL_SINK;
12536363db1cSTomi Valkeinen priv->pads[1].flags = MEDIA_PAD_FL_SOURCE;
12546363db1cSTomi Valkeinen
12556363db1cSTomi Valkeinen ret = media_entity_pads_init(&priv->sd.entity, 2, priv->pads);
12566363db1cSTomi Valkeinen if (ret)
12576363db1cSTomi Valkeinen return dev_err_probe(dev, ret, "Failed to init pads\n");
12586363db1cSTomi Valkeinen
12596363db1cSTomi Valkeinen ret = v4l2_subdev_init_finalize(&priv->sd);
12606363db1cSTomi Valkeinen if (ret)
1261905f88ccSTomi Valkeinen goto err_entity_cleanup;
12626363db1cSTomi Valkeinen
12636363db1cSTomi Valkeinen ret = ub953_v4l2_notifier_register(priv);
12646363db1cSTomi Valkeinen if (ret) {
12656363db1cSTomi Valkeinen dev_err_probe(dev, ret,
12666363db1cSTomi Valkeinen "v4l2 subdev notifier register failed\n");
12676363db1cSTomi Valkeinen goto err_free_state;
12686363db1cSTomi Valkeinen }
12696363db1cSTomi Valkeinen
12706363db1cSTomi Valkeinen ret = v4l2_async_register_subdev(&priv->sd);
12716363db1cSTomi Valkeinen if (ret) {
12726363db1cSTomi Valkeinen dev_err_probe(dev, ret, "v4l2_async_register_subdev error\n");
12736363db1cSTomi Valkeinen goto err_unreg_notif;
12746363db1cSTomi Valkeinen }
12756363db1cSTomi Valkeinen
12766363db1cSTomi Valkeinen return 0;
12776363db1cSTomi Valkeinen
12786363db1cSTomi Valkeinen err_unreg_notif:
12796363db1cSTomi Valkeinen ub953_v4l2_notifier_unregister(priv);
12806363db1cSTomi Valkeinen err_free_state:
12816363db1cSTomi Valkeinen v4l2_subdev_cleanup(&priv->sd);
12826363db1cSTomi Valkeinen err_entity_cleanup:
12836363db1cSTomi Valkeinen media_entity_cleanup(&priv->sd.entity);
12846363db1cSTomi Valkeinen
12856363db1cSTomi Valkeinen return ret;
12866363db1cSTomi Valkeinen }
12876363db1cSTomi Valkeinen
ub953_subdev_uninit(struct ub953_data * priv)12886363db1cSTomi Valkeinen static void ub953_subdev_uninit(struct ub953_data *priv)
12896363db1cSTomi Valkeinen {
12906363db1cSTomi Valkeinen v4l2_async_unregister_subdev(&priv->sd);
12916363db1cSTomi Valkeinen ub953_v4l2_notifier_unregister(priv);
12926363db1cSTomi Valkeinen v4l2_subdev_cleanup(&priv->sd);
12936363db1cSTomi Valkeinen fwnode_handle_put(priv->sd.fwnode);
12946363db1cSTomi Valkeinen media_entity_cleanup(&priv->sd.entity);
12956363db1cSTomi Valkeinen }
12966363db1cSTomi Valkeinen
ub953_probe(struct i2c_client * client)12976363db1cSTomi Valkeinen static int ub953_probe(struct i2c_client *client)
12986363db1cSTomi Valkeinen {
12996363db1cSTomi Valkeinen struct device *dev = &client->dev;
13006363db1cSTomi Valkeinen struct ub953_data *priv;
13016363db1cSTomi Valkeinen int ret;
13026363db1cSTomi Valkeinen
13036363db1cSTomi Valkeinen priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);
13046363db1cSTomi Valkeinen if (!priv)
13056363db1cSTomi Valkeinen return -ENOMEM;
13066363db1cSTomi Valkeinen
13076363db1cSTomi Valkeinen priv->client = client;
13086363db1cSTomi Valkeinen
13096363db1cSTomi Valkeinen priv->hw_data = device_get_match_data(dev);
13106363db1cSTomi Valkeinen
13116363db1cSTomi Valkeinen priv->plat_data = dev_get_platdata(&client->dev);
13126363db1cSTomi Valkeinen if (!priv->plat_data)
13136363db1cSTomi Valkeinen return dev_err_probe(dev, -ENODEV, "Platform data missing\n");
13146363db1cSTomi Valkeinen
13156363db1cSTomi Valkeinen mutex_init(&priv->reg_lock);
13166363db1cSTomi Valkeinen
13176363db1cSTomi Valkeinen /*
13186363db1cSTomi Valkeinen * Initialize to invalid values so that the first reg writes will
13196363db1cSTomi Valkeinen * configure the target.
13206363db1cSTomi Valkeinen */
13216363db1cSTomi Valkeinen priv->current_indirect_target = 0xff;
13226363db1cSTomi Valkeinen
13236363db1cSTomi Valkeinen priv->regmap = devm_regmap_init_i2c(client, &ub953_regmap_config);
13246363db1cSTomi Valkeinen if (IS_ERR(priv->regmap)) {
13256363db1cSTomi Valkeinen ret = PTR_ERR(priv->regmap);
13266363db1cSTomi Valkeinen dev_err_probe(dev, ret, "Failed to init regmap\n");
13276363db1cSTomi Valkeinen goto err_mutex_destroy;
13286363db1cSTomi Valkeinen }
13296363db1cSTomi Valkeinen
1330618aba51STomi Valkeinen priv->clkin = devm_clk_get_optional(dev, "clkin");
1331618aba51STomi Valkeinen if (IS_ERR(priv->clkin)) {
1332618aba51STomi Valkeinen ret = PTR_ERR(priv->clkin);
1333618aba51STomi Valkeinen dev_err_probe(dev, ret, "failed to parse 'clkin'\n");
1334618aba51STomi Valkeinen goto err_mutex_destroy;
1335618aba51STomi Valkeinen }
1336618aba51STomi Valkeinen
13376363db1cSTomi Valkeinen ret = ub953_parse_dt(priv);
13386363db1cSTomi Valkeinen if (ret)
13396363db1cSTomi Valkeinen goto err_mutex_destroy;
13406363db1cSTomi Valkeinen
13416363db1cSTomi Valkeinen ret = ub953_hw_init(priv);
13426363db1cSTomi Valkeinen if (ret)
13436363db1cSTomi Valkeinen goto err_mutex_destroy;
13446363db1cSTomi Valkeinen
13456363db1cSTomi Valkeinen ret = ub953_gpiochip_probe(priv);
13466363db1cSTomi Valkeinen if (ret) {
13476363db1cSTomi Valkeinen dev_err_probe(dev, ret, "Failed to init gpiochip\n");
13486363db1cSTomi Valkeinen goto err_mutex_destroy;
13496363db1cSTomi Valkeinen }
13506363db1cSTomi Valkeinen
13516363db1cSTomi Valkeinen ret = ub953_register_clkout(priv);
13526363db1cSTomi Valkeinen if (ret) {
13536363db1cSTomi Valkeinen dev_err_probe(dev, ret, "Failed to register clkout\n");
13546363db1cSTomi Valkeinen goto err_gpiochip_remove;
13556363db1cSTomi Valkeinen }
13566363db1cSTomi Valkeinen
13576363db1cSTomi Valkeinen ret = ub953_subdev_init(priv);
13586363db1cSTomi Valkeinen if (ret)
13596363db1cSTomi Valkeinen goto err_gpiochip_remove;
13606363db1cSTomi Valkeinen
13616363db1cSTomi Valkeinen ret = ub953_add_i2c_adapter(priv);
13626363db1cSTomi Valkeinen if (ret) {
13636363db1cSTomi Valkeinen dev_err_probe(dev, ret, "failed to add remote i2c adapter\n");
13646363db1cSTomi Valkeinen goto err_subdev_uninit;
13656363db1cSTomi Valkeinen }
13666363db1cSTomi Valkeinen
13676363db1cSTomi Valkeinen return 0;
13686363db1cSTomi Valkeinen
13696363db1cSTomi Valkeinen err_subdev_uninit:
13706363db1cSTomi Valkeinen ub953_subdev_uninit(priv);
13716363db1cSTomi Valkeinen err_gpiochip_remove:
13726363db1cSTomi Valkeinen ub953_gpiochip_remove(priv);
13736363db1cSTomi Valkeinen err_mutex_destroy:
13746363db1cSTomi Valkeinen mutex_destroy(&priv->reg_lock);
13756363db1cSTomi Valkeinen
13766363db1cSTomi Valkeinen return ret;
13776363db1cSTomi Valkeinen }
13786363db1cSTomi Valkeinen
ub953_remove(struct i2c_client * client)13796363db1cSTomi Valkeinen static void ub953_remove(struct i2c_client *client)
13806363db1cSTomi Valkeinen {
13816363db1cSTomi Valkeinen struct v4l2_subdev *sd = i2c_get_clientdata(client);
13826363db1cSTomi Valkeinen struct ub953_data *priv = sd_to_ub953(sd);
13836363db1cSTomi Valkeinen
13846363db1cSTomi Valkeinen i2c_atr_del_adapter(priv->plat_data->atr, priv->plat_data->port);
13856363db1cSTomi Valkeinen
13866363db1cSTomi Valkeinen ub953_subdev_uninit(priv);
13876363db1cSTomi Valkeinen
13886363db1cSTomi Valkeinen ub953_gpiochip_remove(priv);
13896363db1cSTomi Valkeinen mutex_destroy(&priv->reg_lock);
13906363db1cSTomi Valkeinen }
13916363db1cSTomi Valkeinen
13926363db1cSTomi Valkeinen static const struct ub953_hw_data ds90ub953_hw = {
13936363db1cSTomi Valkeinen .model = "ub953",
13946363db1cSTomi Valkeinen };
13956363db1cSTomi Valkeinen
13966363db1cSTomi Valkeinen static const struct ub953_hw_data ds90ub971_hw = {
13976363db1cSTomi Valkeinen .model = "ub971",
13986363db1cSTomi Valkeinen .is_ub971 = true,
13996363db1cSTomi Valkeinen };
14006363db1cSTomi Valkeinen
14016363db1cSTomi Valkeinen static const struct i2c_device_id ub953_id[] = {
14026363db1cSTomi Valkeinen { "ds90ub953-q1", (kernel_ulong_t)&ds90ub953_hw },
14036363db1cSTomi Valkeinen { "ds90ub971-q1", (kernel_ulong_t)&ds90ub971_hw },
14046363db1cSTomi Valkeinen {}
14056363db1cSTomi Valkeinen };
14066363db1cSTomi Valkeinen MODULE_DEVICE_TABLE(i2c, ub953_id);
14076363db1cSTomi Valkeinen
14086363db1cSTomi Valkeinen static const struct of_device_id ub953_dt_ids[] = {
14096363db1cSTomi Valkeinen { .compatible = "ti,ds90ub953-q1", .data = &ds90ub953_hw },
14106363db1cSTomi Valkeinen { .compatible = "ti,ds90ub971-q1", .data = &ds90ub971_hw },
14116363db1cSTomi Valkeinen {}
14126363db1cSTomi Valkeinen };
14136363db1cSTomi Valkeinen MODULE_DEVICE_TABLE(of, ub953_dt_ids);
14146363db1cSTomi Valkeinen
14156363db1cSTomi Valkeinen static struct i2c_driver ds90ub953_driver = {
1416f2183847SUwe Kleine-König .probe = ub953_probe,
14176363db1cSTomi Valkeinen .remove = ub953_remove,
14186363db1cSTomi Valkeinen .id_table = ub953_id,
14196363db1cSTomi Valkeinen .driver = {
14206363db1cSTomi Valkeinen .name = "ds90ub953",
14216363db1cSTomi Valkeinen .of_match_table = ub953_dt_ids,
14226363db1cSTomi Valkeinen },
14236363db1cSTomi Valkeinen };
14246363db1cSTomi Valkeinen module_i2c_driver(ds90ub953_driver);
14256363db1cSTomi Valkeinen
14266363db1cSTomi Valkeinen MODULE_LICENSE("GPL");
14276363db1cSTomi Valkeinen MODULE_DESCRIPTION("Texas Instruments FPD-Link III/IV CSI-2 Serializers Driver");
14286363db1cSTomi Valkeinen MODULE_AUTHOR("Luca Ceresoli <luca@lucaceresoli.net>");
14296363db1cSTomi Valkeinen MODULE_AUTHOR("Tomi Valkeinen <tomi.valkeinen@ideasonboard.com>");
14306363db1cSTomi Valkeinen MODULE_IMPORT_NS(I2C_ATR);
1431