drm/i2c: tda998x: convert to bridge driver
Convert tda998x to a bridge driver with built-in encoder support for compatibility with existing component drivers. Tested-by: Peter Rosin <peda@axentia.se> Signed-off-by: Russell King <rmk+kernel@armlinux.org.uk>
This commit is contained in:
parent
6c1187aaa2
commit
30bd8b862f
|
@ -69,6 +69,7 @@ struct tda998x_priv {
|
||||||
bool edid_delay_active;
|
bool edid_delay_active;
|
||||||
|
|
||||||
struct drm_encoder encoder;
|
struct drm_encoder encoder;
|
||||||
|
struct drm_bridge bridge;
|
||||||
struct drm_connector connector;
|
struct drm_connector connector;
|
||||||
|
|
||||||
struct tda998x_audio_port audio_port[2];
|
struct tda998x_audio_port audio_port[2];
|
||||||
|
@ -79,9 +80,10 @@ struct tda998x_priv {
|
||||||
|
|
||||||
#define conn_to_tda998x_priv(x) \
|
#define conn_to_tda998x_priv(x) \
|
||||||
container_of(x, struct tda998x_priv, connector)
|
container_of(x, struct tda998x_priv, connector)
|
||||||
|
|
||||||
#define enc_to_tda998x_priv(x) \
|
#define enc_to_tda998x_priv(x) \
|
||||||
container_of(x, struct tda998x_priv, encoder)
|
container_of(x, struct tda998x_priv, encoder)
|
||||||
|
#define bridge_to_tda998x_priv(x) \
|
||||||
|
container_of(x, struct tda998x_priv, bridge)
|
||||||
|
|
||||||
/* The TDA9988 series of devices use a paged register scheme.. to simplify
|
/* The TDA9988 series of devices use a paged register scheme.. to simplify
|
||||||
* things we encode the page # in upper bits of the register #. To read/
|
* things we encode the page # in upper bits of the register #. To read/
|
||||||
|
@ -1271,7 +1273,7 @@ tda998x_connector_best_encoder(struct drm_connector *connector)
|
||||||
{
|
{
|
||||||
struct tda998x_priv *priv = conn_to_tda998x_priv(connector);
|
struct tda998x_priv *priv = conn_to_tda998x_priv(connector);
|
||||||
|
|
||||||
return &priv->encoder;
|
return priv->bridge.encoder;
|
||||||
}
|
}
|
||||||
|
|
||||||
static
|
static
|
||||||
|
@ -1301,15 +1303,32 @@ static int tda998x_connector_init(struct tda998x_priv *priv,
|
||||||
if (ret)
|
if (ret)
|
||||||
return ret;
|
return ret;
|
||||||
|
|
||||||
drm_mode_connector_attach_encoder(&priv->connector, &priv->encoder);
|
drm_mode_connector_attach_encoder(&priv->connector,
|
||||||
|
priv->bridge.encoder);
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
/* DRM encoder functions */
|
/* DRM bridge functions */
|
||||||
|
|
||||||
static void tda998x_enable(struct tda998x_priv *priv)
|
static int tda998x_bridge_attach(struct drm_bridge *bridge)
|
||||||
{
|
{
|
||||||
|
struct tda998x_priv *priv = bridge_to_tda998x_priv(bridge);
|
||||||
|
|
||||||
|
return tda998x_connector_init(priv, bridge->dev);
|
||||||
|
}
|
||||||
|
|
||||||
|
static void tda998x_bridge_detach(struct drm_bridge *bridge)
|
||||||
|
{
|
||||||
|
struct tda998x_priv *priv = bridge_to_tda998x_priv(bridge);
|
||||||
|
|
||||||
|
drm_connector_cleanup(&priv->connector);
|
||||||
|
}
|
||||||
|
|
||||||
|
static void tda998x_bridge_enable(struct drm_bridge *bridge)
|
||||||
|
{
|
||||||
|
struct tda998x_priv *priv = bridge_to_tda998x_priv(bridge);
|
||||||
|
|
||||||
if (!priv->is_on) {
|
if (!priv->is_on) {
|
||||||
/* enable video ports, audio will be enabled later */
|
/* enable video ports, audio will be enabled later */
|
||||||
reg_write(priv, REG_ENA_VP_0, 0xff);
|
reg_write(priv, REG_ENA_VP_0, 0xff);
|
||||||
|
@ -1324,8 +1343,10 @@ static void tda998x_enable(struct tda998x_priv *priv)
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
static void tda998x_disable(struct tda998x_priv *priv)
|
static void tda998x_bridge_disable(struct drm_bridge *bridge)
|
||||||
{
|
{
|
||||||
|
struct tda998x_priv *priv = bridge_to_tda998x_priv(bridge);
|
||||||
|
|
||||||
if (priv->is_on) {
|
if (priv->is_on) {
|
||||||
/* disable video ports */
|
/* disable video ports */
|
||||||
reg_write(priv, REG_ENA_VP_0, 0x00);
|
reg_write(priv, REG_ENA_VP_0, 0x00);
|
||||||
|
@ -1336,29 +1357,11 @@ static void tda998x_disable(struct tda998x_priv *priv)
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
static void tda998x_encoder_dpms(struct drm_encoder *encoder, int mode)
|
static void tda998x_bridge_mode_set(struct drm_bridge *bridge,
|
||||||
{
|
|
||||||
struct tda998x_priv *priv = enc_to_tda998x_priv(encoder);
|
|
||||||
bool on;
|
|
||||||
|
|
||||||
/* we only care about on or off: */
|
|
||||||
on = mode == DRM_MODE_DPMS_ON;
|
|
||||||
|
|
||||||
if (on == priv->is_on)
|
|
||||||
return;
|
|
||||||
|
|
||||||
if (on)
|
|
||||||
tda998x_enable(priv);
|
|
||||||
else
|
|
||||||
tda998x_disable(priv);
|
|
||||||
}
|
|
||||||
|
|
||||||
static void
|
|
||||||
tda998x_encoder_mode_set(struct drm_encoder *encoder,
|
|
||||||
struct drm_display_mode *mode,
|
struct drm_display_mode *mode,
|
||||||
struct drm_display_mode *adjusted_mode)
|
struct drm_display_mode *adjusted_mode)
|
||||||
{
|
{
|
||||||
struct tda998x_priv *priv = enc_to_tda998x_priv(encoder);
|
struct tda998x_priv *priv = bridge_to_tda998x_priv(bridge);
|
||||||
u16 ref_pix, ref_line, n_pix, n_line;
|
u16 ref_pix, ref_line, n_pix, n_line;
|
||||||
u16 hs_pix_s, hs_pix_e;
|
u16 hs_pix_s, hs_pix_e;
|
||||||
u16 vs1_pix_s, vs1_pix_e, vs1_line_s, vs1_line_e;
|
u16 vs1_pix_s, vs1_pix_e, vs1_line_s, vs1_line_e;
|
||||||
|
@ -1565,8 +1568,18 @@ tda998x_encoder_mode_set(struct drm_encoder *encoder,
|
||||||
mutex_unlock(&priv->audio_mutex);
|
mutex_unlock(&priv->audio_mutex);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
static const struct drm_bridge_funcs tda998x_bridge_funcs = {
|
||||||
|
.attach = tda998x_bridge_attach,
|
||||||
|
.detach = tda998x_bridge_detach,
|
||||||
|
.disable = tda998x_bridge_disable,
|
||||||
|
.mode_set = tda998x_bridge_mode_set,
|
||||||
|
.enable = tda998x_bridge_enable,
|
||||||
|
};
|
||||||
|
|
||||||
static void tda998x_destroy(struct tda998x_priv *priv)
|
static void tda998x_destroy(struct tda998x_priv *priv)
|
||||||
{
|
{
|
||||||
|
drm_bridge_remove(&priv->bridge);
|
||||||
|
|
||||||
/* disable all IRQs and free the IRQ handler */
|
/* disable all IRQs and free the IRQ handler */
|
||||||
cec_write(priv, REG_CEC_RXSHPDINTENA, 0);
|
cec_write(priv, REG_CEC_RXSHPDINTENA, 0);
|
||||||
reg_clear(priv, REG_INT_FLAGS_2, INT_FLAGS_2_EDID_BLK_RD);
|
reg_clear(priv, REG_INT_FLAGS_2, INT_FLAGS_2_EDID_BLK_RD);
|
||||||
|
@ -1659,6 +1672,7 @@ static int tda998x_create(struct i2c_client *client, struct tda998x_priv *priv)
|
||||||
mutex_init(&priv->mutex); /* protect the page access */
|
mutex_init(&priv->mutex); /* protect the page access */
|
||||||
mutex_init(&priv->audio_mutex); /* protect access from audio thread */
|
mutex_init(&priv->audio_mutex); /* protect access from audio thread */
|
||||||
mutex_init(&priv->edid_mutex);
|
mutex_init(&priv->edid_mutex);
|
||||||
|
INIT_LIST_HEAD(&priv->bridge.list);
|
||||||
init_waitqueue_head(&priv->edid_delay_waitq);
|
init_waitqueue_head(&priv->edid_delay_waitq);
|
||||||
timer_setup(&priv->edid_delay_timer, tda998x_edid_delay_done, 0);
|
timer_setup(&priv->edid_delay_timer, tda998x_edid_delay_done, 0);
|
||||||
INIT_WORK(&priv->detect_work, tda998x_detect_work);
|
INIT_WORK(&priv->detect_work, tda998x_detect_work);
|
||||||
|
@ -1819,43 +1833,25 @@ static int tda998x_create(struct i2c_client *client, struct tda998x_priv *priv)
|
||||||
tda998x_set_config(priv, client->dev.platform_data);
|
tda998x_set_config(priv, client->dev.platform_data);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
priv->bridge.funcs = &tda998x_bridge_funcs;
|
||||||
|
#ifdef CONFIG_OF
|
||||||
|
priv->bridge.of_node = dev->of_node;
|
||||||
|
#endif
|
||||||
|
|
||||||
|
drm_bridge_add(&priv->bridge);
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
|
|
||||||
fail:
|
fail:
|
||||||
/* if encoder_init fails, the encoder slave is never registered,
|
tda998x_destroy(priv);
|
||||||
* so cleanup here:
|
|
||||||
*/
|
|
||||||
i2c_unregister_device(priv->cec);
|
|
||||||
if (priv->cec_notify)
|
|
||||||
cec_notifier_put(priv->cec_notify);
|
|
||||||
if (client->irq)
|
|
||||||
free_irq(client->irq, priv);
|
|
||||||
err_irq:
|
err_irq:
|
||||||
return ret;
|
return ret;
|
||||||
}
|
}
|
||||||
|
|
||||||
static void tda998x_encoder_prepare(struct drm_encoder *encoder)
|
/* DRM encoder functions */
|
||||||
{
|
|
||||||
tda998x_encoder_dpms(encoder, DRM_MODE_DPMS_OFF);
|
|
||||||
}
|
|
||||||
|
|
||||||
static void tda998x_encoder_commit(struct drm_encoder *encoder)
|
|
||||||
{
|
|
||||||
tda998x_encoder_dpms(encoder, DRM_MODE_DPMS_ON);
|
|
||||||
}
|
|
||||||
|
|
||||||
static const struct drm_encoder_helper_funcs tda998x_encoder_helper_funcs = {
|
|
||||||
.dpms = tda998x_encoder_dpms,
|
|
||||||
.prepare = tda998x_encoder_prepare,
|
|
||||||
.commit = tda998x_encoder_commit,
|
|
||||||
.mode_set = tda998x_encoder_mode_set,
|
|
||||||
};
|
|
||||||
|
|
||||||
static void tda998x_encoder_destroy(struct drm_encoder *encoder)
|
static void tda998x_encoder_destroy(struct drm_encoder *encoder)
|
||||||
{
|
{
|
||||||
struct tda998x_priv *priv = enc_to_tda998x_priv(encoder);
|
|
||||||
|
|
||||||
tda998x_destroy(priv);
|
|
||||||
drm_encoder_cleanup(encoder);
|
drm_encoder_cleanup(encoder);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -1863,20 +1859,12 @@ static const struct drm_encoder_funcs tda998x_encoder_funcs = {
|
||||||
.destroy = tda998x_encoder_destroy,
|
.destroy = tda998x_encoder_destroy,
|
||||||
};
|
};
|
||||||
|
|
||||||
static int tda998x_bind(struct device *dev, struct device *master, void *data)
|
static int tda998x_encoder_init(struct device *dev, struct drm_device *drm)
|
||||||
{
|
{
|
||||||
struct i2c_client *client = to_i2c_client(dev);
|
struct tda998x_priv *priv = dev_get_drvdata(dev);
|
||||||
struct drm_device *drm = data;
|
|
||||||
struct tda998x_priv *priv;
|
|
||||||
u32 crtcs = 0;
|
u32 crtcs = 0;
|
||||||
int ret;
|
int ret;
|
||||||
|
|
||||||
priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);
|
|
||||||
if (!priv)
|
|
||||||
return -ENOMEM;
|
|
||||||
|
|
||||||
dev_set_drvdata(dev, priv);
|
|
||||||
|
|
||||||
if (dev->of_node)
|
if (dev->of_node)
|
||||||
crtcs = drm_of_find_possible_crtcs(drm, dev->of_node);
|
crtcs = drm_of_find_possible_crtcs(drm, dev->of_node);
|
||||||
|
|
||||||
|
@ -1888,35 +1876,53 @@ static int tda998x_bind(struct device *dev, struct device *master, void *data)
|
||||||
|
|
||||||
priv->encoder.possible_crtcs = crtcs;
|
priv->encoder.possible_crtcs = crtcs;
|
||||||
|
|
||||||
ret = tda998x_create(client, priv);
|
|
||||||
if (ret)
|
|
||||||
return ret;
|
|
||||||
|
|
||||||
drm_encoder_helper_add(&priv->encoder, &tda998x_encoder_helper_funcs);
|
|
||||||
ret = drm_encoder_init(drm, &priv->encoder, &tda998x_encoder_funcs,
|
ret = drm_encoder_init(drm, &priv->encoder, &tda998x_encoder_funcs,
|
||||||
DRM_MODE_ENCODER_TMDS, NULL);
|
DRM_MODE_ENCODER_TMDS, NULL);
|
||||||
if (ret)
|
if (ret)
|
||||||
goto err_encoder;
|
goto err_encoder;
|
||||||
|
|
||||||
ret = tda998x_connector_init(priv, drm);
|
ret = drm_bridge_attach(&priv->encoder, &priv->bridge, NULL);
|
||||||
if (ret)
|
if (ret)
|
||||||
goto err_connector;
|
goto err_bridge;
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
|
|
||||||
err_connector:
|
err_bridge:
|
||||||
drm_encoder_cleanup(&priv->encoder);
|
drm_encoder_cleanup(&priv->encoder);
|
||||||
err_encoder:
|
err_encoder:
|
||||||
|
return ret;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int tda998x_bind(struct device *dev, struct device *master, void *data)
|
||||||
|
{
|
||||||
|
struct i2c_client *client = to_i2c_client(dev);
|
||||||
|
struct drm_device *drm = data;
|
||||||
|
struct tda998x_priv *priv;
|
||||||
|
int ret;
|
||||||
|
|
||||||
|
priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);
|
||||||
|
if (!priv)
|
||||||
|
return -ENOMEM;
|
||||||
|
|
||||||
|
dev_set_drvdata(dev, priv);
|
||||||
|
|
||||||
|
ret = tda998x_create(client, priv);
|
||||||
|
if (ret)
|
||||||
|
return ret;
|
||||||
|
|
||||||
|
ret = tda998x_encoder_init(dev, drm);
|
||||||
|
if (ret) {
|
||||||
tda998x_destroy(priv);
|
tda998x_destroy(priv);
|
||||||
return ret;
|
return ret;
|
||||||
}
|
}
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
static void tda998x_unbind(struct device *dev, struct device *master,
|
static void tda998x_unbind(struct device *dev, struct device *master,
|
||||||
void *data)
|
void *data)
|
||||||
{
|
{
|
||||||
struct tda998x_priv *priv = dev_get_drvdata(dev);
|
struct tda998x_priv *priv = dev_get_drvdata(dev);
|
||||||
|
|
||||||
drm_connector_cleanup(&priv->connector);
|
|
||||||
drm_encoder_cleanup(&priv->encoder);
|
drm_encoder_cleanup(&priv->encoder);
|
||||||
tda998x_destroy(priv);
|
tda998x_destroy(priv);
|
||||||
}
|
}
|
||||||
|
|
Loading…
Reference in a new issue