[PATCH v2 1/28] drm/i2c: tda998x: simplify the i2c read/write functions

Russell King - ARM Linux linux at arm.linux.org.uk
Sat Jan 11 11:57:23 EST 2014


On Thu, Jan 09, 2014 at 11:57:24AM +0100, Jean-Francois Moine wrote:
> This patch simplifies the i2c read/write functions and permits them to
> be easily called in more contexts.
> 
> Signed-off-by: Jean-Francois Moine <moinejf at free.fr>

Nice cleanup.

Acked-by: Russell King <rmk+kernel at arm.linux.org.uk>
Tested-by: Russell King <rmk+kernel at arm.linux.org.uk>

> ---
>  drivers/gpu/drm/i2c/tda998x_drv.c | 322 +++++++++++----------
>  1 file changed, 162 insertions(+), 160 deletions(-)
> 
> diff --git a/drivers/gpu/drm/i2c/tda998x_drv.c b/drivers/gpu/drm/i2c/tda998x_drv.c
> index 400b0c4..26dd299 100644
> --- a/drivers/gpu/drm/i2c/tda998x_drv.c
> +++ b/drivers/gpu/drm/i2c/tda998x_drv.c
> @@ -30,6 +30,7 @@
>  
>  struct tda998x_priv {
>  	struct i2c_client *cec;
> +	struct i2c_client *hdmi;
>  	uint16_t rev;
>  	uint8_t current_page;
>  	int dpms;
> @@ -328,9 +329,9 @@ struct tda998x_priv {
>  #define TDA19988                  0x0301
>  
>  static void
> -cec_write(struct drm_encoder *encoder, uint16_t addr, uint8_t val)
> +cec_write(struct tda998x_priv *priv, uint16_t addr, uint8_t val)
>  {
> -	struct i2c_client *client = to_tda998x_priv(encoder)->cec;
> +	struct i2c_client *client = priv->cec;
>  	uint8_t buf[] = {addr, val};
>  	int ret;
>  
> @@ -340,9 +341,9 @@ cec_write(struct drm_encoder *encoder, uint16_t addr, uint8_t val)
>  }
>  
>  static uint8_t
> -cec_read(struct drm_encoder *encoder, uint8_t addr)
> +cec_read(struct tda998x_priv *priv, uint8_t addr)
>  {
> -	struct i2c_client *client = to_tda998x_priv(encoder)->cec;
> +	struct i2c_client *client = priv->cec;
>  	uint8_t val;
>  	int ret;
>  
> @@ -362,12 +363,10 @@ fail:
>  }
>  
>  static void
> -set_page(struct drm_encoder *encoder, uint16_t reg)
> +set_page(struct tda998x_priv *priv, uint16_t reg)
>  {
> -	struct tda998x_priv *priv = to_tda998x_priv(encoder);
> -
>  	if (REG2PAGE(reg) != priv->current_page) {
> -		struct i2c_client *client = drm_i2c_encoder_get_client(encoder);
> +		struct i2c_client *client = priv->hdmi;
>  		uint8_t buf[] = {
>  				REG_CURPAGE, REG2PAGE(reg)
>  		};
> @@ -380,13 +379,13 @@ set_page(struct drm_encoder *encoder, uint16_t reg)
>  }
>  
>  static int
> -reg_read_range(struct drm_encoder *encoder, uint16_t reg, char *buf, int cnt)
> +reg_read_range(struct tda998x_priv *priv, uint16_t reg, char *buf, int cnt)
>  {
> -	struct i2c_client *client = drm_i2c_encoder_get_client(encoder);
> +	struct i2c_client *client = priv->hdmi;
>  	uint8_t addr = REG2ADDR(reg);
>  	int ret;
>  
> -	set_page(encoder, reg);
> +	set_page(priv, reg);
>  
>  	ret = i2c_master_send(client, &addr, sizeof(addr));
>  	if (ret < 0)
> @@ -404,16 +403,16 @@ fail:
>  }
>  
>  static void
> -reg_write_range(struct drm_encoder *encoder, uint16_t reg, uint8_t *p, int cnt)
> +reg_write_range(struct tda998x_priv *priv, uint16_t reg, uint8_t *p, int cnt)
>  {
> -	struct i2c_client *client = drm_i2c_encoder_get_client(encoder);
> +	struct i2c_client *client = priv->hdmi;
>  	uint8_t buf[cnt+1];
>  	int ret;
>  
>  	buf[0] = REG2ADDR(reg);
>  	memcpy(&buf[1], p, cnt);
>  
> -	set_page(encoder, reg);
> +	set_page(priv, reg);
>  
>  	ret = i2c_master_send(client, buf, cnt + 1);
>  	if (ret < 0)
> @@ -421,21 +420,21 @@ reg_write_range(struct drm_encoder *encoder, uint16_t reg, uint8_t *p, int cnt)
>  }
>  
>  static uint8_t
> -reg_read(struct drm_encoder *encoder, uint16_t reg)
> +reg_read(struct tda998x_priv *priv, uint16_t reg)
>  {
>  	uint8_t val = 0;
> -	reg_read_range(encoder, reg, &val, sizeof(val));
> +	reg_read_range(priv, reg, &val, sizeof(val));
>  	return val;
>  }
>  
>  static void
> -reg_write(struct drm_encoder *encoder, uint16_t reg, uint8_t val)
> +reg_write(struct tda998x_priv *priv, uint16_t reg, uint8_t val)
>  {
> -	struct i2c_client *client = drm_i2c_encoder_get_client(encoder);
> +	struct i2c_client *client = priv->hdmi;
>  	uint8_t buf[] = {REG2ADDR(reg), val};
>  	int ret;
>  
> -	set_page(encoder, reg);
> +	set_page(priv, reg);
>  
>  	ret = i2c_master_send(client, buf, ARRAY_SIZE(buf));
>  	if (ret < 0)
> @@ -443,13 +442,13 @@ reg_write(struct drm_encoder *encoder, uint16_t reg, uint8_t val)
>  }
>  
>  static void
> -reg_write16(struct drm_encoder *encoder, uint16_t reg, uint16_t val)
> +reg_write16(struct tda998x_priv *priv, uint16_t reg, uint16_t val)
>  {
> -	struct i2c_client *client = drm_i2c_encoder_get_client(encoder);
> +	struct i2c_client *client = priv->hdmi;
>  	uint8_t buf[] = {REG2ADDR(reg), val >> 8, val};
>  	int ret;
>  
> -	set_page(encoder, reg);
> +	set_page(priv, reg);
>  
>  	ret = i2c_master_send(client, buf, ARRAY_SIZE(buf));
>  	if (ret < 0)
> @@ -457,47 +456,47 @@ reg_write16(struct drm_encoder *encoder, uint16_t reg, uint16_t val)
>  }
>  
>  static void
> -reg_set(struct drm_encoder *encoder, uint16_t reg, uint8_t val)
> +reg_set(struct tda998x_priv *priv, uint16_t reg, uint8_t val)
>  {
> -	reg_write(encoder, reg, reg_read(encoder, reg) | val);
> +	reg_write(priv, reg, reg_read(priv, reg) | val);
>  }
>  
>  static void
> -reg_clear(struct drm_encoder *encoder, uint16_t reg, uint8_t val)
> +reg_clear(struct tda998x_priv *priv, uint16_t reg, uint8_t val)
>  {
> -	reg_write(encoder, reg, reg_read(encoder, reg) & ~val);
> +	reg_write(priv, reg, reg_read(priv, reg) & ~val);
>  }
>  
>  static void
> -tda998x_reset(struct drm_encoder *encoder)
> +tda998x_reset(struct tda998x_priv *priv)
>  {
>  	/* reset audio and i2c master: */
> -	reg_set(encoder, REG_SOFTRESET, SOFTRESET_AUDIO | SOFTRESET_I2C_MASTER);
> +	reg_set(priv, REG_SOFTRESET, SOFTRESET_AUDIO | SOFTRESET_I2C_MASTER);
>  	msleep(50);
> -	reg_clear(encoder, REG_SOFTRESET, SOFTRESET_AUDIO | SOFTRESET_I2C_MASTER);
> +	reg_clear(priv, REG_SOFTRESET, SOFTRESET_AUDIO | SOFTRESET_I2C_MASTER);
>  	msleep(50);
>  
>  	/* reset transmitter: */
> -	reg_set(encoder, REG_MAIN_CNTRL0, MAIN_CNTRL0_SR);
> -	reg_clear(encoder, REG_MAIN_CNTRL0, MAIN_CNTRL0_SR);
> +	reg_set(priv, REG_MAIN_CNTRL0, MAIN_CNTRL0_SR);
> +	reg_clear(priv, REG_MAIN_CNTRL0, MAIN_CNTRL0_SR);
>  
>  	/* PLL registers common configuration */
> -	reg_write(encoder, REG_PLL_SERIAL_1, 0x00);
> -	reg_write(encoder, REG_PLL_SERIAL_2, PLL_SERIAL_2_SRL_NOSC(1));
> -	reg_write(encoder, REG_PLL_SERIAL_3, 0x00);
> -	reg_write(encoder, REG_SERIALIZER,   0x00);
> -	reg_write(encoder, REG_BUFFER_OUT,   0x00);
> -	reg_write(encoder, REG_PLL_SCG1,     0x00);
> -	reg_write(encoder, REG_AUDIO_DIV,    AUDIO_DIV_SERCLK_8);
> -	reg_write(encoder, REG_SEL_CLK,      SEL_CLK_SEL_CLK1 | SEL_CLK_ENA_SC_CLK);
> -	reg_write(encoder, REG_PLL_SCGN1,    0xfa);
> -	reg_write(encoder, REG_PLL_SCGN2,    0x00);
> -	reg_write(encoder, REG_PLL_SCGR1,    0x5b);
> -	reg_write(encoder, REG_PLL_SCGR2,    0x00);
> -	reg_write(encoder, REG_PLL_SCG2,     0x10);
> +	reg_write(priv, REG_PLL_SERIAL_1, 0x00);
> +	reg_write(priv, REG_PLL_SERIAL_2, PLL_SERIAL_2_SRL_NOSC(1));
> +	reg_write(priv, REG_PLL_SERIAL_3, 0x00);
> +	reg_write(priv, REG_SERIALIZER,   0x00);
> +	reg_write(priv, REG_BUFFER_OUT,   0x00);
> +	reg_write(priv, REG_PLL_SCG1,     0x00);
> +	reg_write(priv, REG_AUDIO_DIV,    AUDIO_DIV_SERCLK_8);
> +	reg_write(priv, REG_SEL_CLK,      SEL_CLK_SEL_CLK1 | SEL_CLK_ENA_SC_CLK);
> +	reg_write(priv, REG_PLL_SCGN1,    0xfa);
> +	reg_write(priv, REG_PLL_SCGN2,    0x00);
> +	reg_write(priv, REG_PLL_SCGR1,    0x5b);
> +	reg_write(priv, REG_PLL_SCGR2,    0x00);
> +	reg_write(priv, REG_PLL_SCG2,     0x10);
>  
>  	/* Write the default value MUX register */
> -	reg_write(encoder, REG_MUX_VP_VIP_OUT, 0x24);
> +	reg_write(priv, REG_MUX_VP_VIP_OUT, 0x24);
>  }
>  
>  static uint8_t tda998x_cksum(uint8_t *buf, size_t bytes)
> @@ -513,18 +512,18 @@ static uint8_t tda998x_cksum(uint8_t *buf, size_t bytes)
>  #define PB(x) (HB(2) + 1 + (x))
>  
>  static void
> -tda998x_write_if(struct drm_encoder *encoder, uint8_t bit, uint16_t addr,
> +tda998x_write_if(struct tda998x_priv *priv, uint8_t bit, uint16_t addr,
>  		 uint8_t *buf, size_t size)
>  {
>  	buf[PB(0)] = tda998x_cksum(buf, size);
>  
> -	reg_clear(encoder, REG_DIP_IF_FLAGS, bit);
> -	reg_write_range(encoder, addr, buf, size);
> -	reg_set(encoder, REG_DIP_IF_FLAGS, bit);
> +	reg_clear(priv, REG_DIP_IF_FLAGS, bit);
> +	reg_write_range(priv, addr, buf, size);
> +	reg_set(priv, REG_DIP_IF_FLAGS, bit);
>  }
>  
>  static void
> -tda998x_write_aif(struct drm_encoder *encoder, struct tda998x_encoder_params *p)
> +tda998x_write_aif(struct tda998x_priv *priv, struct tda998x_encoder_params *p)
>  {
>  	uint8_t buf[PB(5) + 1];
>  
> @@ -537,12 +536,12 @@ tda998x_write_aif(struct drm_encoder *encoder, struct tda998x_encoder_params *p)
>  	buf[PB(4)] = p->audio_frame[4];
>  	buf[PB(5)] = p->audio_frame[5] & 0xf8; /* DM_INH + LSV */
>  
> -	tda998x_write_if(encoder, DIP_IF_FLAGS_IF4, REG_IF4_HB0, buf,
> +	tda998x_write_if(priv, DIP_IF_FLAGS_IF4, REG_IF4_HB0, buf,
>  			 sizeof(buf));
>  }
>  
>  static void
> -tda998x_write_avi(struct drm_encoder *encoder, struct drm_display_mode *mode)
> +tda998x_write_avi(struct tda998x_priv *priv, struct drm_display_mode *mode)
>  {
>  	uint8_t buf[PB(13) + 1];
>  
> @@ -554,36 +553,36 @@ tda998x_write_avi(struct drm_encoder *encoder, struct drm_display_mode *mode)
>  	buf[PB(3)] = HDMI_QUANTIZATION_RANGE_FULL << 2;
>  	buf[PB(4)] = drm_match_cea_mode(mode);
>  
> -	tda998x_write_if(encoder, DIP_IF_FLAGS_IF2, REG_IF2_HB0, buf,
> +	tda998x_write_if(priv, DIP_IF_FLAGS_IF2, REG_IF2_HB0, buf,
>  			 sizeof(buf));
>  }
>  
> -static void tda998x_audio_mute(struct drm_encoder *encoder, bool on)
> +static void tda998x_audio_mute(struct tda998x_priv *priv, bool on)
>  {
>  	if (on) {
> -		reg_set(encoder, REG_SOFTRESET, SOFTRESET_AUDIO);
> -		reg_clear(encoder, REG_SOFTRESET, SOFTRESET_AUDIO);
> -		reg_set(encoder, REG_AIP_CNTRL_0, AIP_CNTRL_0_RST_FIFO);
> +		reg_set(priv, REG_SOFTRESET, SOFTRESET_AUDIO);
> +		reg_clear(priv, REG_SOFTRESET, SOFTRESET_AUDIO);
> +		reg_set(priv, REG_AIP_CNTRL_0, AIP_CNTRL_0_RST_FIFO);
>  	} else {
> -		reg_clear(encoder, REG_AIP_CNTRL_0, AIP_CNTRL_0_RST_FIFO);
> +		reg_clear(priv, REG_AIP_CNTRL_0, AIP_CNTRL_0_RST_FIFO);
>  	}
>  }
>  
>  static void
> -tda998x_configure_audio(struct drm_encoder *encoder,
> +tda998x_configure_audio(struct tda998x_priv *priv,
>  		struct drm_display_mode *mode, struct tda998x_encoder_params *p)
>  {
>  	uint8_t buf[6], clksel_aip, clksel_fs, ca_i2s, cts_n, adiv;
>  	uint32_t n;
>  
>  	/* Enable audio ports */
> -	reg_write(encoder, REG_ENA_AP, p->audio_cfg);
> -	reg_write(encoder, REG_ENA_ACLK, p->audio_clk_cfg);
> +	reg_write(priv, REG_ENA_AP, p->audio_cfg);
> +	reg_write(priv, REG_ENA_ACLK, p->audio_clk_cfg);
>  
>  	/* Set audio input source */
>  	switch (p->audio_format) {
>  	case AFMT_SPDIF:
> -		reg_write(encoder, REG_MUX_AP, 0x40);
> +		reg_write(priv, REG_MUX_AP, 0x40);
>  		clksel_aip = AIP_CLKSEL_AIP(0);
>  		/* FS64SPDIF */
>  		clksel_fs = AIP_CLKSEL_FS(2);
> @@ -592,7 +591,7 @@ tda998x_configure_audio(struct drm_encoder *encoder,
>  		break;
>  
>  	case AFMT_I2S:
> -		reg_write(encoder, REG_MUX_AP, 0x64);
> +		reg_write(priv, REG_MUX_AP, 0x64);
>  		clksel_aip = AIP_CLKSEL_AIP(1);
>  		/* ACLK */
>  		clksel_fs = AIP_CLKSEL_FS(0);
> @@ -605,12 +604,12 @@ tda998x_configure_audio(struct drm_encoder *encoder,
>  		return;
>  	}
>  
> -	reg_write(encoder, REG_AIP_CLKSEL, clksel_aip);
> -	reg_clear(encoder, REG_AIP_CNTRL_0, AIP_CNTRL_0_LAYOUT);
> +	reg_write(priv, REG_AIP_CLKSEL, clksel_aip);
> +	reg_clear(priv, REG_AIP_CNTRL_0, AIP_CNTRL_0_LAYOUT);
>  
>  	/* Enable automatic CTS generation */
> -	reg_clear(encoder, REG_AIP_CNTRL_0, AIP_CNTRL_0_ACR_MAN);
> -	reg_write(encoder, REG_CTS_N, cts_n);
> +	reg_clear(priv, REG_AIP_CNTRL_0, AIP_CNTRL_0_ACR_MAN);
> +	reg_write(priv, REG_CTS_N, cts_n);
>  
>  	/*
>  	 * Audio input somehow depends on HDMI line rate which is
> @@ -623,7 +622,7 @@ tda998x_configure_audio(struct drm_encoder *encoder,
>  		adiv = AUDIO_DIV_SERCLK_16;
>  	else
>  		adiv = AUDIO_DIV_SERCLK_8;
> -	reg_write(encoder, REG_AUDIO_DIV, adiv);
> +	reg_write(priv, REG_AUDIO_DIV, adiv);
>  
>  	/*
>  	 * This is the approximate value of N, which happens to be
> @@ -638,28 +637,28 @@ tda998x_configure_audio(struct drm_encoder *encoder,
>  	buf[3] = n;
>  	buf[4] = n >> 8;
>  	buf[5] = n >> 16;
> -	reg_write_range(encoder, REG_ACR_CTS_0, buf, 6);
> +	reg_write_range(priv, REG_ACR_CTS_0, buf, 6);
>  
>  	/* Set CTS clock reference */
> -	reg_write(encoder, REG_AIP_CLKSEL, clksel_aip | clksel_fs);
> +	reg_write(priv, REG_AIP_CLKSEL, clksel_aip | clksel_fs);
>  
>  	/* Reset CTS generator */
> -	reg_set(encoder, REG_AIP_CNTRL_0, AIP_CNTRL_0_RST_CTS);
> -	reg_clear(encoder, REG_AIP_CNTRL_0, AIP_CNTRL_0_RST_CTS);
> +	reg_set(priv, REG_AIP_CNTRL_0, AIP_CNTRL_0_RST_CTS);
> +	reg_clear(priv, REG_AIP_CNTRL_0, AIP_CNTRL_0_RST_CTS);
>  
>  	/* Write the channel status */
>  	buf[0] = 0x04;
>  	buf[1] = 0x00;
>  	buf[2] = 0x00;
>  	buf[3] = 0xf1;
> -	reg_write_range(encoder, REG_CH_STAT_B(0), buf, 4);
> +	reg_write_range(priv, REG_CH_STAT_B(0), buf, 4);
>  
> -	tda998x_audio_mute(encoder, true);
> +	tda998x_audio_mute(priv, true);
>  	mdelay(20);
> -	tda998x_audio_mute(encoder, false);
> +	tda998x_audio_mute(priv, false);
>  
>  	/* Write the audio information packet */
> -	tda998x_write_aif(encoder, p);
> +	tda998x_write_aif(priv, p);
>  }
>  
>  /* DRM encoder functions */
> @@ -701,19 +700,19 @@ tda998x_encoder_dpms(struct drm_encoder *encoder, int mode)
>  	switch (mode) {
>  	case DRM_MODE_DPMS_ON:
>  		/* enable video ports, audio will be enabled later */
> -		reg_write(encoder, REG_ENA_VP_0, 0xff);
> -		reg_write(encoder, REG_ENA_VP_1, 0xff);
> -		reg_write(encoder, REG_ENA_VP_2, 0xff);
> +		reg_write(priv, REG_ENA_VP_0, 0xff);
> +		reg_write(priv, REG_ENA_VP_1, 0xff);
> +		reg_write(priv, REG_ENA_VP_2, 0xff);
>  		/* set muxing after enabling ports: */
> -		reg_write(encoder, REG_VIP_CNTRL_0, priv->vip_cntrl_0);
> -		reg_write(encoder, REG_VIP_CNTRL_1, priv->vip_cntrl_1);
> -		reg_write(encoder, REG_VIP_CNTRL_2, priv->vip_cntrl_2);
> +		reg_write(priv, REG_VIP_CNTRL_0, priv->vip_cntrl_0);
> +		reg_write(priv, REG_VIP_CNTRL_1, priv->vip_cntrl_1);
> +		reg_write(priv, REG_VIP_CNTRL_2, priv->vip_cntrl_2);
>  		break;
>  	case DRM_MODE_DPMS_OFF:
>  		/* disable video ports */
> -		reg_write(encoder, REG_ENA_VP_0, 0x00);
> -		reg_write(encoder, REG_ENA_VP_1, 0x00);
> -		reg_write(encoder, REG_ENA_VP_2, 0x00);
> +		reg_write(priv, REG_ENA_VP_0, 0x00);
> +		reg_write(priv, REG_ENA_VP_1, 0x00);
> +		reg_write(priv, REG_ENA_VP_2, 0x00);
>  		break;
>  	}
>  
> @@ -826,57 +825,57 @@ tda998x_encoder_mode_set(struct drm_encoder *encoder,
>  	div = 148500 / mode->clock;
>  
>  	/* mute the audio FIFO: */
> -	reg_set(encoder, REG_AIP_CNTRL_0, AIP_CNTRL_0_RST_FIFO);
> +	reg_set(priv, REG_AIP_CNTRL_0, AIP_CNTRL_0_RST_FIFO);
>  
>  	/* set HDMI HDCP mode off: */
> -	reg_set(encoder, REG_TBG_CNTRL_1, TBG_CNTRL_1_DWIN_DIS);
> -	reg_clear(encoder, REG_TX33, TX33_HDMI);
> +	reg_set(priv, REG_TBG_CNTRL_1, TBG_CNTRL_1_DWIN_DIS);
> +	reg_clear(priv, REG_TX33, TX33_HDMI);
> +	reg_write(priv, REG_ENC_CNTRL, ENC_CNTRL_CTL_CODE(0));
>  
> -	reg_write(encoder, REG_ENC_CNTRL, ENC_CNTRL_CTL_CODE(0));
>  	/* no pre-filter or interpolator: */
> -	reg_write(encoder, REG_HVF_CNTRL_0, HVF_CNTRL_0_PREFIL(0) |
> +	reg_write(priv, REG_HVF_CNTRL_0, HVF_CNTRL_0_PREFIL(0) |
>  			HVF_CNTRL_0_INTPOL(0));
> -	reg_write(encoder, REG_VIP_CNTRL_5, VIP_CNTRL_5_SP_CNT(0));
> -	reg_write(encoder, REG_VIP_CNTRL_4, VIP_CNTRL_4_BLANKIT(0) |
> +	reg_write(priv, REG_VIP_CNTRL_5, VIP_CNTRL_5_SP_CNT(0));
> +	reg_write(priv, REG_VIP_CNTRL_4, VIP_CNTRL_4_BLANKIT(0) |
>  			VIP_CNTRL_4_BLC(0));
> -	reg_clear(encoder, REG_PLL_SERIAL_3, PLL_SERIAL_3_SRL_CCIR);
> +	reg_clear(priv, REG_PLL_SERIAL_3, PLL_SERIAL_3_SRL_CCIR);
>  
> -	reg_clear(encoder, REG_PLL_SERIAL_1, PLL_SERIAL_1_SRL_MAN_IZ);
> -	reg_clear(encoder, REG_PLL_SERIAL_3, PLL_SERIAL_3_SRL_DE);
> -	reg_write(encoder, REG_SERIALIZER, 0);
> -	reg_write(encoder, REG_HVF_CNTRL_1, HVF_CNTRL_1_VQR(0));
> +	reg_clear(priv, REG_PLL_SERIAL_1, PLL_SERIAL_1_SRL_MAN_IZ);
> +	reg_clear(priv, REG_PLL_SERIAL_3, PLL_SERIAL_3_SRL_DE);
> +	reg_write(priv, REG_SERIALIZER, 0);
> +	reg_write(priv, REG_HVF_CNTRL_1, HVF_CNTRL_1_VQR(0));
>  
>  	/* TODO enable pixel repeat for pixel rates less than 25Msamp/s */
>  	rep = 0;
> -	reg_write(encoder, REG_RPT_CNTRL, 0);
> -	reg_write(encoder, REG_SEL_CLK, SEL_CLK_SEL_VRF_CLK(0) |
> +	reg_write(priv, REG_RPT_CNTRL, 0);
> +	reg_write(priv, REG_SEL_CLK, SEL_CLK_SEL_VRF_CLK(0) |
>  			SEL_CLK_SEL_CLK1 | SEL_CLK_ENA_SC_CLK);
>  
> -	reg_write(encoder, REG_PLL_SERIAL_2, PLL_SERIAL_2_SRL_NOSC(div) |
> +	reg_write(priv, REG_PLL_SERIAL_2, PLL_SERIAL_2_SRL_NOSC(div) |
>  			PLL_SERIAL_2_SRL_PR(rep));
>  
>  	/* set color matrix bypass flag: */
> -	reg_set(encoder, REG_MAT_CONTRL, MAT_CONTRL_MAT_BP);
> +	reg_set(priv, REG_MAT_CONTRL, MAT_CONTRL_MAT_BP);
>  
>  	/* set BIAS tmds value: */
> -	reg_write(encoder, REG_ANA_GENERAL, 0x09);
> +	reg_write(priv, REG_ANA_GENERAL, 0x09);
>  
> -	reg_clear(encoder, REG_TBG_CNTRL_0, TBG_CNTRL_0_SYNC_MTHD);
> +	reg_clear(priv, REG_TBG_CNTRL_0, TBG_CNTRL_0_SYNC_MTHD);
>  
>  	/*
>  	 * Sync on rising HSYNC/VSYNC
>  	 */
> -	reg_write(encoder, REG_VIP_CNTRL_3, 0);
> -	reg_set(encoder, REG_VIP_CNTRL_3, VIP_CNTRL_3_SYNC_HS);
> +	reg_write(priv, REG_VIP_CNTRL_3, 0);
> +	reg_set(priv, REG_VIP_CNTRL_3, VIP_CNTRL_3_SYNC_HS);
>  
>  	/*
>  	 * TDA19988 requires high-active sync at input stage,
>  	 * so invert low-active sync provided by master encoder here
>  	 */
>  	if (mode->flags & DRM_MODE_FLAG_NHSYNC)
> -		reg_set(encoder, REG_VIP_CNTRL_3, VIP_CNTRL_3_H_TGL);
> +		reg_set(priv, REG_VIP_CNTRL_3, VIP_CNTRL_3_H_TGL);
>  	if (mode->flags & DRM_MODE_FLAG_NVSYNC)
> -		reg_set(encoder, REG_VIP_CNTRL_3, VIP_CNTRL_3_V_TGL);
> +		reg_set(priv, REG_VIP_CNTRL_3, VIP_CNTRL_3_V_TGL);
>  
>  	/*
>  	 * Always generate sync polarity relative to input sync and
> @@ -887,49 +886,49 @@ tda998x_encoder_mode_set(struct drm_encoder *encoder,
>  		reg |= TBG_CNTRL_1_H_TGL;
>  	if (mode->flags & DRM_MODE_FLAG_NVSYNC)
>  		reg |= TBG_CNTRL_1_V_TGL;
> -	reg_write(encoder, REG_TBG_CNTRL_1, reg);
> -
> -	reg_write(encoder, REG_VIDFORMAT, 0x00);
> -	reg_write16(encoder, REG_REFPIX_MSB, ref_pix);
> -	reg_write16(encoder, REG_REFLINE_MSB, ref_line);
> -	reg_write16(encoder, REG_NPIX_MSB, n_pix);
> -	reg_write16(encoder, REG_NLINE_MSB, n_line);
> -	reg_write16(encoder, REG_VS_LINE_STRT_1_MSB, vs1_line_s);
> -	reg_write16(encoder, REG_VS_PIX_STRT_1_MSB, vs1_pix_s);
> -	reg_write16(encoder, REG_VS_LINE_END_1_MSB, vs1_line_e);
> -	reg_write16(encoder, REG_VS_PIX_END_1_MSB, vs1_pix_e);
> -	reg_write16(encoder, REG_VS_LINE_STRT_2_MSB, vs2_line_s);
> -	reg_write16(encoder, REG_VS_PIX_STRT_2_MSB, vs2_pix_s);
> -	reg_write16(encoder, REG_VS_LINE_END_2_MSB, vs2_line_e);
> -	reg_write16(encoder, REG_VS_PIX_END_2_MSB, vs2_pix_e);
> -	reg_write16(encoder, REG_HS_PIX_START_MSB, hs_pix_s);
> -	reg_write16(encoder, REG_HS_PIX_STOP_MSB, hs_pix_e);
> -	reg_write16(encoder, REG_VWIN_START_1_MSB, vwin1_line_s);
> -	reg_write16(encoder, REG_VWIN_END_1_MSB, vwin1_line_e);
> -	reg_write16(encoder, REG_VWIN_START_2_MSB, vwin2_line_s);
> -	reg_write16(encoder, REG_VWIN_END_2_MSB, vwin2_line_e);
> -	reg_write16(encoder, REG_DE_START_MSB, de_pix_s);
> -	reg_write16(encoder, REG_DE_STOP_MSB, de_pix_e);
> +	reg_write(priv, REG_TBG_CNTRL_1, reg);
> +
> +	reg_write(priv, REG_VIDFORMAT, 0x00);
> +	reg_write16(priv, REG_REFPIX_MSB, ref_pix);
> +	reg_write16(priv, REG_REFLINE_MSB, ref_line);
> +	reg_write16(priv, REG_NPIX_MSB, n_pix);
> +	reg_write16(priv, REG_NLINE_MSB, n_line);
> +	reg_write16(priv, REG_VS_LINE_STRT_1_MSB, vs1_line_s);
> +	reg_write16(priv, REG_VS_PIX_STRT_1_MSB, vs1_pix_s);
> +	reg_write16(priv, REG_VS_LINE_END_1_MSB, vs1_line_e);
> +	reg_write16(priv, REG_VS_PIX_END_1_MSB, vs1_pix_e);
> +	reg_write16(priv, REG_VS_LINE_STRT_2_MSB, vs2_line_s);
> +	reg_write16(priv, REG_VS_PIX_STRT_2_MSB, vs2_pix_s);
> +	reg_write16(priv, REG_VS_LINE_END_2_MSB, vs2_line_e);
> +	reg_write16(priv, REG_VS_PIX_END_2_MSB, vs2_pix_e);
> +	reg_write16(priv, REG_HS_PIX_START_MSB, hs_pix_s);
> +	reg_write16(priv, REG_HS_PIX_STOP_MSB, hs_pix_e);
> +	reg_write16(priv, REG_VWIN_START_1_MSB, vwin1_line_s);
> +	reg_write16(priv, REG_VWIN_END_1_MSB, vwin1_line_e);
> +	reg_write16(priv, REG_VWIN_START_2_MSB, vwin2_line_s);
> +	reg_write16(priv, REG_VWIN_END_2_MSB, vwin2_line_e);
> +	reg_write16(priv, REG_DE_START_MSB, de_pix_s);
> +	reg_write16(priv, REG_DE_STOP_MSB, de_pix_e);
>  
>  	if (priv->rev == TDA19988) {
>  		/* let incoming pixels fill the active space (if any) */
> -		reg_write(encoder, REG_ENABLE_SPACE, 0x01);
> +		reg_write(priv, REG_ENABLE_SPACE, 0x01);
>  	}
>  
>  	/* must be last register set: */
> -	reg_clear(encoder, REG_TBG_CNTRL_0, TBG_CNTRL_0_SYNC_ONCE);
> +	reg_clear(priv, REG_TBG_CNTRL_0, TBG_CNTRL_0_SYNC_ONCE);
>  
>  	/* Only setup the info frames if the sink is HDMI */
>  	if (priv->is_hdmi_sink) {
>  		/* We need to turn HDMI HDCP stuff on to get audio through */
> -		reg_clear(encoder, REG_TBG_CNTRL_1, TBG_CNTRL_1_DWIN_DIS);
> -		reg_write(encoder, REG_ENC_CNTRL, ENC_CNTRL_CTL_CODE(1));
> -		reg_set(encoder, REG_TX33, TX33_HDMI);
> +		reg_clear(priv, REG_TBG_CNTRL_1, TBG_CNTRL_1_DWIN_DIS);
> +		reg_write(priv, REG_ENC_CNTRL, ENC_CNTRL_CTL_CODE(1));
> +		reg_set(priv, REG_TX33, TX33_HDMI);
>  
> -		tda998x_write_avi(encoder, adjusted_mode);
> +		tda998x_write_avi(priv, adjusted_mode);
>  
>  		if (priv->params.audio_cfg)
> -			tda998x_configure_audio(encoder, adjusted_mode,
> +			tda998x_configure_audio(priv, adjusted_mode,
>  						&priv->params);
>  	}
>  }
> @@ -938,7 +937,9 @@ static enum drm_connector_status
>  tda998x_encoder_detect(struct drm_encoder *encoder,
>  		      struct drm_connector *connector)
>  {
> -	uint8_t val = cec_read(encoder, REG_CEC_RXSHPDLEV);
> +	struct tda998x_priv *priv = to_tda998x_priv(encoder);
> +	uint8_t val = cec_read(priv, REG_CEC_RXSHPDLEV);
> +
>  	return (val & CEC_RXSHPDLEV_HPD) ? connector_status_connected :
>  			connector_status_disconnected;
>  }
> @@ -946,29 +947,30 @@ tda998x_encoder_detect(struct drm_encoder *encoder,
>  static int
>  read_edid_block(struct drm_encoder *encoder, uint8_t *buf, int blk)
>  {
> +	struct tda998x_priv *priv = to_tda998x_priv(encoder);
>  	uint8_t offset, segptr;
>  	int ret, i;
>  
>  	/* enable EDID read irq: */
> -	reg_set(encoder, REG_INT_FLAGS_2, INT_FLAGS_2_EDID_BLK_RD);
> +	reg_set(priv, REG_INT_FLAGS_2, INT_FLAGS_2_EDID_BLK_RD);
>  
>  	offset = (blk & 1) ? 128 : 0;
>  	segptr = blk / 2;
>  
> -	reg_write(encoder, REG_DDC_ADDR, 0xa0);
> -	reg_write(encoder, REG_DDC_OFFS, offset);
> -	reg_write(encoder, REG_DDC_SEGM_ADDR, 0x60);
> -	reg_write(encoder, REG_DDC_SEGM, segptr);
> +	reg_write(priv, REG_DDC_ADDR, 0xa0);
> +	reg_write(priv, REG_DDC_OFFS, offset);
> +	reg_write(priv, REG_DDC_SEGM_ADDR, 0x60);
> +	reg_write(priv, REG_DDC_SEGM, segptr);
>  
>  	/* enable reading EDID: */
> -	reg_write(encoder, REG_EDID_CTRL, 0x1);
> +	reg_write(priv, REG_EDID_CTRL, 0x1);
>  
>  	/* flag must be cleared by sw: */
> -	reg_write(encoder, REG_EDID_CTRL, 0x0);
> +	reg_write(priv, REG_EDID_CTRL, 0x0);
>  
>  	/* wait for block read to complete: */
>  	for (i = 100; i > 0; i--) {
> -		uint8_t val = reg_read(encoder, REG_INT_FLAGS_2);
> +		uint8_t val = reg_read(priv, REG_INT_FLAGS_2);
>  		if (val & INT_FLAGS_2_EDID_BLK_RD)
>  			break;
>  		msleep(1);
> @@ -977,14 +979,14 @@ read_edid_block(struct drm_encoder *encoder, uint8_t *buf, int blk)
>  	if (i == 0)
>  		return -ETIMEDOUT;
>  
> -	ret = reg_read_range(encoder, REG_EDID_DATA_0, buf, EDID_LENGTH);
> +	ret = reg_read_range(priv, REG_EDID_DATA_0, buf, EDID_LENGTH);
>  	if (ret != EDID_LENGTH) {
>  		dev_err(encoder->dev->dev, "failed to read edid block %d: %d",
>  				blk, ret);
>  		return ret;
>  	}
>  
> -	reg_clear(encoder, REG_INT_FLAGS_2, INT_FLAGS_2_EDID_BLK_RD);
> +	reg_clear(priv, REG_INT_FLAGS_2, INT_FLAGS_2_EDID_BLK_RD);
>  
>  	return 0;
>  }
> @@ -1001,7 +1003,7 @@ do_get_edid(struct drm_encoder *encoder)
>  		return NULL;
>  
>  	if (priv->rev == TDA19988)
> -		reg_clear(encoder, REG_TX4, TX4_PD_RAM);
> +		reg_clear(priv, REG_TX4, TX4_PD_RAM);
>  
>  	/* base block fetch */
>  	if (read_edid_block(encoder, block, 0))
> @@ -1041,13 +1043,13 @@ do_get_edid(struct drm_encoder *encoder)
>  
>  done:
>  	if (priv->rev == TDA19988)
> -		reg_set(encoder, REG_TX4, TX4_PD_RAM);
> +		reg_set(priv, REG_TX4, TX4_PD_RAM);
>  
>  	return block;
>  
>  fail:
>  	if (priv->rev == TDA19988)
> -		reg_set(encoder, REG_TX4, TX4_PD_RAM);
> +		reg_set(priv, REG_TX4, TX4_PD_RAM);
>  	dev_warn(encoder->dev->dev, "failed to read EDID\n");
>  	kfree(block);
>  	return NULL;
> @@ -1131,7 +1133,6 @@ tda998x_encoder_init(struct i2c_client *client,
>  		    struct drm_device *dev,
>  		    struct drm_encoder_slave *encoder_slave)
>  {
> -	struct drm_encoder *encoder = &encoder_slave->base;
>  	struct tda998x_priv *priv;
>  
>  	priv = kzalloc(sizeof(*priv), GFP_KERNEL);
> @@ -1143,6 +1144,7 @@ tda998x_encoder_init(struct i2c_client *client,
>  	priv->vip_cntrl_2 = VIP_CNTRL_2_SWAP_E(4) | VIP_CNTRL_2_SWAP_F(5);
>  
>  	priv->current_page = 0;
> +	priv->hdmi = client;
>  	priv->cec = i2c_new_dummy(client->adapter, 0x34);
>  	priv->dpms = DRM_MODE_DPMS_OFF;
>  
> @@ -1150,14 +1152,14 @@ tda998x_encoder_init(struct i2c_client *client,
>  	encoder_slave->slave_funcs = &tda998x_encoder_funcs;
>  
>  	/* wake up the device: */
> -	cec_write(encoder, REG_CEC_ENAMODS,
> +	cec_write(priv, REG_CEC_ENAMODS,
>  			CEC_ENAMODS_EN_RXSENS | CEC_ENAMODS_EN_HDMI);
>  
> -	tda998x_reset(encoder);
> +	tda998x_reset(priv);
>  
>  	/* read version: */
> -	priv->rev = reg_read(encoder, REG_VERSION_LSB) |
> -			reg_read(encoder, REG_VERSION_MSB) << 8;
> +	priv->rev = reg_read(priv, REG_VERSION_LSB) |
> +			reg_read(priv, REG_VERSION_MSB) << 8;
>  
>  	/* mask off feature bits: */
>  	priv->rev &= ~0x30; /* not-hdcp and not-scalar bit */
> @@ -1173,16 +1175,16 @@ tda998x_encoder_init(struct i2c_client *client,
>  	}
>  
>  	/* after reset, enable DDC: */
> -	reg_write(encoder, REG_DDC_DISABLE, 0x00);
> +	reg_write(priv, REG_DDC_DISABLE, 0x00);
>  
>  	/* set clock on DDC channel: */
> -	reg_write(encoder, REG_TX3, 39);
> +	reg_write(priv, REG_TX3, 39);
>  
>  	/* if necessary, disable multi-master: */
>  	if (priv->rev == TDA19989)
> -		reg_set(encoder, REG_I2C_MASTER, I2C_MASTER_DIS_MM);
> +		reg_set(priv, REG_I2C_MASTER, I2C_MASTER_DIS_MM);
>  
> -	cec_write(encoder, REG_CEC_FRO_IM_CLK_CTRL,
> +	cec_write(priv, REG_CEC_FRO_IM_CLK_CTRL,
>  			CEC_FRO_IM_CLK_CTRL_GHOST_DIS | CEC_FRO_IM_CLK_CTRL_IMCLK_SEL);
>  
>  	return 0;
> 
> 
> -- 
> Ken ar c'hentañ	|	      ** Breizh ha Linux atav! **
> Jef		|		http://moinejf.free.fr/
> 
> _______________________________________________
> linux-arm-kernel mailing list
> linux-arm-kernel at lists.infradead.org
> http://lists.infradead.org/mailman/listinfo/linux-arm-kernel

-- 
FTTC broadband for 0.8mile line: 5.8Mbps down 500kbps up.  Estimation
in database were 13.1 to 19Mbit for a good line, about 7.5+ for a bad.
Estimate before purchase was "up to 13.2Mbit".



More information about the linux-arm-kernel mailing list