[PATCH v4 3/3] drm/bridge: chrontel-ch7033: Add a new driver
Daniel Vetter
daniel at ffwll.ch
Tue Apr 28 10:09:08 UTC 2020
On Thu, Apr 23, 2020 at 11:18:45PM +0200, Lubomir Rintel wrote:
> On Tue, Apr 21, 2020 at 02:54:12PM +0200, Daniel Vetter wrote:
> > On Tue, Mar 24, 2020 at 04:19:31PM +0100, Lubomir Rintel wrote:
> > > This is a driver for video encoder with VGA and DVI/HDMI outputs.
> > >
> > > There is no documentation for the chip -- the operation was guessed from
> > > what was sniffed on a Dell Wyse 3020 ThinOS terminal, the register names
> > > come from the ch7035 driver in Mediatek's GPL code dump.
> > >
> > > Only bare minimum is implemented -- no fancy stuff, such as scaling. That
> > > would only worsen our misery. We don't load the firmware and we don't need
> > > to even bother enabling the MCU. There are probably no distributable
> > > firmware images anyway.
> > >
> > > Just like the tda998x driver, this one uses the component framework and
> > > adds an encoder on component bind, so that it works with the Armada DRM
> > > driver.
>
> Thank you for your response.
>
> > Uh, can we instead pls land the patches for armada to switch over to of
> > bridge helpers.
>
> I honestly don't know -- it's not something I can do anything about.
>
> I didn't have any luck getting responses to my other patches for the
> Armada driver.
If it's just a case of unresponsive maintainer, we can take over with the
drm-misc group maintained fallback in drm. Still need someone to
review/ack patches ofc, but usually there's room for that in the drm-misc
group.
> > Iirc the big hold-up was that with direct bridge usage
> > instead of component framework, the drm driver wouldn't unload. But core
> > pm maintainers fixed device links to include driver unloading, and there
> > was a drm_bridge patch including armada patches to do all that.
> >
> > But somehow it didn't land. Iirc because Russell couldn't test them on
> > upstream somehow.
>
> This is what I've found [1]. It seems to include the device links work and
> switches over the komeda driver, not armada, from components to drm_bridge:
>
> [1] https://patchwork.kernel.org/cover/11262351/
>
> I'm wondering if this is the patch set you're referring to?
Yup that was one part. Maybe ping on that thread, if Mihail still is
interested in this you could cross-review each another's stuff and then
land it in drm-misc.
> > Adding more special cases and bridge drivers that we have to convert isn't
> > going to make this any easier.
>
> No conversion would be necessary -- merely stripping the
> component/encoder parts once they're no longer necessary. The driver
> would still work just fine with drivers that don't utilize the component
> framework, juts as tda998x does.
Hm I was pretty sure it (series to convert to armada) existed by someone,
but I can't find it anymore. Anyway if all we need is to remove a bunch
of stuff, then even better.
-Daniel
> > This entire discussion happened in
> >
> > https://www.spinics.net/lists/dri-devel/msg201927.html
> >
> > Can't find the armada patches real quick, nor the drm_bridge patch. But
> > the core infrastructure hides behind. The core pm change has been added in
> >
> > commit e7dd40105aac9ba051e44ad711123bc53a5e4c71
> > Author: Rafael J. Wysocki <rafael.j.wysocki at intel.com>
> > Date: Fri Feb 1 01:59:42 2019 +0100
> >
> > driver core: Add device link flag DL_FLAG_AUTOPROBE_CONSUMER
>
> Thank you
> Lubo
>
> >
> > Thanks, Daniel
> > >
> > > Tested with a handful of monitors ranging from 1024x768 at 75 to 1400x1050 at 60,
> > > with VGA as well as DVI.
> > >
> > > Signed-off-by: Lubomir Rintel <lkundrak at v3.sk>
> > >
> > > ---
> > > Changes since v3:
> > > - Cosmetic changes; drop ch7033_encoder_destroy() and use
> > > drm_encoder_cleanup() for drm_encoder_funcs.destroy callback
> > > directly.
> > >
> > > Changes since v1:
> > > - Sort the includes
> > > - Drop a useless model id read
> > > - Chain to the bridge-connector instead of dealing with the HPD/EDID
> > > readout machinery ourselves
> > > - Utilize regmap to access the registers
> > >
> > > drivers/gpu/drm/bridge/Kconfig | 10 +
> > > drivers/gpu/drm/bridge/Makefile | 1 +
> > > drivers/gpu/drm/bridge/chrontel-ch7033.c | 669 +++++++++++++++++++++++
> > > 3 files changed, 680 insertions(+)
> > > create mode 100644 drivers/gpu/drm/bridge/chrontel-ch7033.c
> > >
> > > diff --git a/drivers/gpu/drm/bridge/Kconfig b/drivers/gpu/drm/bridge/Kconfig
> > > index aaed2347ace9d..0ebc72d62a5b2 100644
> > > --- a/drivers/gpu/drm/bridge/Kconfig
> > > +++ b/drivers/gpu/drm/bridge/Kconfig
> > > @@ -27,6 +27,16 @@ config DRM_CDNS_DSI
> > > Support Cadence DPI to DSI bridge. This is an internal
> > > bridge and is meant to be directly embedded in a SoC.
> > >
> > > +config DRM_CHRONTEL_CH7033
> > > + tristate "Chrontel CH7033 Video Encoder"
> > > + depends on OF
> > > + select DRM_KMS_HELPER
> > > + help
> > > + Enable support for the Chrontel CH7033 VGA/DVI/HDMI Encoder, as
> > > + found in the Dell Wyse 3020 thin client.
> > > +
> > > + If in doubt, say "N".
> > > +
> > > config DRM_DISPLAY_CONNECTOR
> > > tristate "Display connector support"
> > > depends on OF
> > > diff --git a/drivers/gpu/drm/bridge/Makefile b/drivers/gpu/drm/bridge/Makefile
> > > index 6fb062b5b0f04..a844315feddb4 100644
> > > --- a/drivers/gpu/drm/bridge/Makefile
> > > +++ b/drivers/gpu/drm/bridge/Makefile
> > > @@ -1,5 +1,6 @@
> > > # SPDX-License-Identifier: GPL-2.0
> > > obj-$(CONFIG_DRM_CDNS_DSI) += cdns-dsi.o
> > > +obj-$(CONFIG_DRM_CHRONTEL_CH7033) += chrontel-ch7033.o
> > > obj-$(CONFIG_DRM_DISPLAY_CONNECTOR) += display-connector.o
> > > obj-$(CONFIG_DRM_LVDS_CODEC) += lvds-codec.o
> > > obj-$(CONFIG_DRM_MEGACHIPS_STDPXXXX_GE_B850V3_FW) += megachips-stdpxxxx-ge-b850v3-fw.o
> > > diff --git a/drivers/gpu/drm/bridge/chrontel-ch7033.c b/drivers/gpu/drm/bridge/chrontel-ch7033.c
> > > new file mode 100644
> > > index 0000000000000..f5cb2130684f7
> > > --- /dev/null
> > > +++ b/drivers/gpu/drm/bridge/chrontel-ch7033.c
> > > @@ -0,0 +1,669 @@
> > > +// SPDX-License-Identifier: GPL-2.0-only
> > > +/*
> > > + * Chrontel CH7033 Video Encoder Driver
> > > + *
> > > + * Copyright (C) 2019,2020 Lubomir Rintel
> > > + */
> > > +
> > > +#include <linux/component.h>
> > > +#include <linux/gpio/consumer.h>
> > > +#include <linux/module.h>
> > > +#include <linux/regmap.h>
> > > +
> > > +#include <drm/drm_atomic_helper.h>
> > > +#include <drm/drm_bridge.h>
> > > +#include <drm/drm_edid.h>
> > > +#include <drm/drm_of.h>
> > > +#include <drm/drm_print.h>
> > > +#include <drm/drm_probe_helper.h>
> > > +
> > > +/* Page 0, Register 0x07 */
> > > +enum {
> > > + DRI_PD = BIT(3),
> > > + IO_PD = BIT(5),
> > > +};
> > > +
> > > +/* Page 0, Register 0x08 */
> > > +enum {
> > > + DRI_PDDRI = GENMASK(7, 4),
> > > + PDDAC = GENMASK(3, 1),
> > > + PANEN = BIT(0),
> > > +};
> > > +
> > > +/* Page 0, Register 0x09 */
> > > +enum {
> > > + DPD = BIT(7),
> > > + GCKOFF = BIT(6),
> > > + TV_BP = BIT(5),
> > > + SCLPD = BIT(4),
> > > + SDPD = BIT(3),
> > > + VGA_PD = BIT(2),
> > > + HDBKPD = BIT(1),
> > > + HDMI_PD = BIT(0),
> > > +};
> > > +
> > > +/* Page 0, Register 0x0a */
> > > +enum {
> > > + MEMINIT = BIT(7),
> > > + MEMIDLE = BIT(6),
> > > + MEMPD = BIT(5),
> > > + STOP = BIT(4),
> > > + LVDS_PD = BIT(3),
> > > + HD_DVIB = BIT(2),
> > > + HDCP_PD = BIT(1),
> > > + MCU_PD = BIT(0),
> > > +};
> > > +
> > > +/* Page 0, Register 0x18 */
> > > +enum {
> > > + IDF = GENMASK(7, 4),
> > > + INTEN = BIT(3),
> > > + SWAP = GENMASK(2, 0),
> > > +};
> > > +
> > > +enum {
> > > + BYTE_SWAP_RGB = 0,
> > > + BYTE_SWAP_RBG = 1,
> > > + BYTE_SWAP_GRB = 2,
> > > + BYTE_SWAP_GBR = 3,
> > > + BYTE_SWAP_BRG = 4,
> > > + BYTE_SWAP_BGR = 5,
> > > +};
> > > +
> > > +/* Page 0, Register 0x19 */
> > > +enum {
> > > + HPO_I = BIT(5),
> > > + VPO_I = BIT(4),
> > > + DEPO_I = BIT(3),
> > > + CRYS_EN = BIT(2),
> > > + GCLKFREQ = GENMASK(2, 0),
> > > +};
> > > +
> > > +/* Page 0, Register 0x2e */
> > > +enum {
> > > + HFLIP = BIT(7),
> > > + VFLIP = BIT(6),
> > > + DEPO_O = BIT(5),
> > > + HPO_O = BIT(4),
> > > + VPO_O = BIT(3),
> > > + TE = GENMASK(2, 0),
> > > +};
> > > +
> > > +/* Page 0, Register 0x2b */
> > > +enum {
> > > + SWAPS = GENMASK(7, 4),
> > > + VFMT = GENMASK(3, 0),
> > > +};
> > > +
> > > +/* Page 0, Register 0x54 */
> > > +enum {
> > > + COMP_BP = BIT(7),
> > > + DAC_EN_T = BIT(6),
> > > + HWO_HDMI_HI = GENMASK(5, 3),
> > > + HOO_HDMI_HI = GENMASK(2, 0),
> > > +};
> > > +
> > > +/* Page 0, Register 0x57 */
> > > +enum {
> > > + FLDSEN = BIT(7),
> > > + VWO_HDMI_HI = GENMASK(5, 3),
> > > + VOO_HDMI_HI = GENMASK(2, 0),
> > > +};
> > > +
> > > +/* Page 0, Register 0x7e */
> > > +enum {
> > > + HDMI_LVDS_SEL = BIT(7),
> > > + DE_GEN = BIT(6),
> > > + PWM_INDEX_HI = BIT(5),
> > > + USE_DE = BIT(4),
> > > + R_INT = GENMASK(3, 0),
> > > +};
> > > +
> > > +/* Page 1, Register 0x07 */
> > > +enum {
> > > + BPCKSEL = BIT(7),
> > > + DRI_CMFB_EN = BIT(6),
> > > + CEC_PUEN = BIT(5),
> > > + CEC_T = BIT(3),
> > > + CKINV = BIT(2),
> > > + CK_TVINV = BIT(1),
> > > + DRI_CKS2 = BIT(0),
> > > +};
> > > +
> > > +/* Page 1, Register 0x08 */
> > > +enum {
> > > + DACG = BIT(6),
> > > + DACKTST = BIT(5),
> > > + DEDGEB = BIT(4),
> > > + SYO = BIT(3),
> > > + DRI_IT_LVDS = GENMASK(2, 1),
> > > + DISPON = BIT(0),
> > > +};
> > > +
> > > +/* Page 1, Register 0x0c */
> > > +enum {
> > > + DRI_PLL_CP = GENMASK(7, 6),
> > > + DRI_PLL_DIVSEL = BIT(5),
> > > + DRI_PLL_N1_1 = BIT(4),
> > > + DRI_PLL_N1_0 = BIT(3),
> > > + DRI_PLL_N3_1 = BIT(2),
> > > + DRI_PLL_N3_0 = BIT(1),
> > > + DRI_PLL_CKTSTEN = BIT(0),
> > > +};
> > > +
> > > +/* Page 1, Register 0x6b */
> > > +enum {
> > > + VCO3CS = GENMASK(7, 6),
> > > + ICPGBK2_0 = GENMASK(5, 3),
> > > + DRI_VCO357SC = BIT(2),
> > > + PDPLL2 = BIT(1),
> > > + DRI_PD_SER = BIT(0),
> > > +};
> > > +
> > > +/* Page 1, Register 0x6c */
> > > +enum {
> > > + PLL2N11 = GENMASK(7, 4),
> > > + PLL2N5_4 = BIT(3),
> > > + PLL2N5_TOP = BIT(2),
> > > + DRI_PLL_PD = BIT(1),
> > > + PD_I2CM = BIT(0),
> > > +};
> > > +
> > > +/* Page 3, Register 0x28 */
> > > +enum {
> > > + DIFF_EN = GENMASK(7, 6),
> > > + CORREC_EN = GENMASK(5, 4),
> > > + VGACLK_BP = BIT(3),
> > > + HM_LV_SEL = BIT(2),
> > > + HD_VGA_SEL = BIT(1),
> > > +};
> > > +
> > > +/* Page 3, Register 0x2a */
> > > +enum {
> > > + LVDSCLK_BP = BIT(7),
> > > + HDTVCLK_BP = BIT(6),
> > > + HDMICLK_BP = BIT(5),
> > > + HDTV_BP = BIT(4),
> > > + HDMI_BP = BIT(3),
> > > + THRWL = GENMASK(2, 0),
> > > +};
> > > +
> > > +/* Page 4, Register 0x52 */
> > > +enum {
> > > + PGM_ARSTB = BIT(7),
> > > + MCU_ARSTB = BIT(6),
> > > + MCU_RETB = BIT(2),
> > > + RESETIB = BIT(1),
> > > + RESETDB = BIT(0),
> > > +};
> > > +
> > > +struct ch7033_priv {
> > > + struct regmap *regmap;
> > > + struct drm_bridge *next_bridge;
> > > + struct drm_encoder encoder;
> > > + struct drm_bridge bridge;
> > > + struct drm_connector connector;
> > > +};
> > > +
> > > +#define conn_to_ch7033_priv(x) \
> > > + container_of(x, struct ch7033_priv, connector)
> > > +#define bridge_to_ch7033_priv(x) \
> > > + container_of(x, struct ch7033_priv, bridge)
> > > +
> > > +
> > > +static enum drm_connector_status ch7033_connector_detect(
> > > + struct drm_connector *connector, bool force)
> > > +{
> > > + struct ch7033_priv *priv = conn_to_ch7033_priv(connector);
> > > +
> > > + return drm_bridge_detect(priv->next_bridge);
> > > +}
> > > +
> > > +static const struct drm_connector_funcs ch7033_connector_funcs = {
> > > + .reset = drm_atomic_helper_connector_reset,
> > > + .fill_modes = drm_helper_probe_single_connector_modes,
> > > + .detect = ch7033_connector_detect,
> > > + .destroy = drm_connector_cleanup,
> > > + .atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state,
> > > + .atomic_destroy_state = drm_atomic_helper_connector_destroy_state,
> > > +};
> > > +
> > > +static int ch7033_connector_get_modes(struct drm_connector *connector)
> > > +{
> > > + struct ch7033_priv *priv = conn_to_ch7033_priv(connector);
> > > + struct edid *edid;
> > > + int ret;
> > > +
> > > + edid = drm_bridge_get_edid(priv->next_bridge, connector);
> > > + drm_connector_update_edid_property(connector, edid);
> > > + if (edid) {
> > > + ret = drm_add_edid_modes(connector, edid);
> > > + kfree(edid);
> > > + } else {
> > > + ret = drm_add_modes_noedid(connector, 1920, 1080);
> > > + drm_set_preferred_mode(connector, 1024, 768);
> > > + }
> > > +
> > > + return ret;
> > > +}
> > > +
> > > +static struct drm_encoder *ch7033_connector_best_encoder(
> > > + struct drm_connector *connector)
> > > +{
> > > + struct ch7033_priv *priv = conn_to_ch7033_priv(connector);
> > > +
> > > + return priv->bridge.encoder;
> > > +}
> > > +
> > > +static const struct drm_connector_helper_funcs ch7033_connector_helper_funcs = {
> > > + .get_modes = ch7033_connector_get_modes,
> > > + .best_encoder = ch7033_connector_best_encoder,
> > > +};
> > > +
> > > +static void ch7033_hpd_event(void *arg, enum drm_connector_status status)
> > > +{
> > > + struct ch7033_priv *priv = arg;
> > > +
> > > + if (priv->bridge.dev)
> > > + drm_helper_hpd_irq_event(priv->connector.dev);
> > > +}
> > > +
> > > +static int ch7033_bridge_attach(struct drm_bridge *bridge,
> > > + enum drm_bridge_attach_flags flags)
> > > +{
> > > + struct ch7033_priv *priv = bridge_to_ch7033_priv(bridge);
> > > + struct drm_connector *connector = &priv->connector;
> > > + int ret;
> > > +
> > > + ret = drm_bridge_attach(bridge->encoder, priv->next_bridge, bridge,
> > > + DRM_BRIDGE_ATTACH_NO_CONNECTOR);
> > > + if (ret)
> > > + return ret;
> > > +
> > > + if (flags & DRM_BRIDGE_ATTACH_NO_CONNECTOR)
> > > + return 0;
> > > +
> > > + if (priv->next_bridge->ops & DRM_BRIDGE_OP_DETECT) {
> > > + connector->polled = DRM_CONNECTOR_POLL_HPD;
> > > + } else {
> > > + connector->polled = DRM_CONNECTOR_POLL_CONNECT |
> > > + DRM_CONNECTOR_POLL_DISCONNECT;
> > > + }
> > > +
> > > + if (priv->next_bridge->ops & DRM_BRIDGE_OP_HPD) {
> > > + drm_bridge_hpd_enable(priv->next_bridge, ch7033_hpd_event,
> > > + priv);
> > > + }
> > > +
> > > + drm_connector_helper_add(connector,
> > > + &ch7033_connector_helper_funcs);
> > > + ret = drm_connector_init_with_ddc(bridge->dev, &priv->connector,
> > > + &ch7033_connector_funcs,
> > > + priv->next_bridge->type,
> > > + priv->next_bridge->ddc);
> > > + if (ret) {
> > > + DRM_ERROR("Failed to initialize connector\n");
> > > + return ret;
> > > + }
> > > +
> > > + return drm_connector_attach_encoder(&priv->connector, bridge->encoder);
> > > +}
> > > +
> > > +static void ch7033_bridge_detach(struct drm_bridge *bridge)
> > > +{
> > > + struct ch7033_priv *priv = bridge_to_ch7033_priv(bridge);
> > > +
> > > + if (priv->next_bridge->ops & DRM_BRIDGE_OP_HPD)
> > > + drm_bridge_hpd_disable(priv->next_bridge);
> > > + drm_connector_cleanup(&priv->connector);
> > > +}
> > > +
> > > +static enum drm_mode_status ch7033_bridge_mode_valid(struct drm_bridge *bridge,
> > > + const struct drm_display_mode *mode)
> > > +{
> > > + if (mode->clock > 165000)
> > > + return MODE_CLOCK_HIGH;
> > > + if (mode->hdisplay >= 1920)
> > > + return MODE_BAD_HVALUE;
> > > + if (mode->vdisplay >= 1080)
> > > + return MODE_BAD_VVALUE;
> > > + return MODE_OK;
> > > +}
> > > +
> > > +static void ch7033_bridge_disable(struct drm_bridge *bridge)
> > > +{
> > > + struct ch7033_priv *priv = bridge_to_ch7033_priv(bridge);
> > > +
> > > + regmap_write(priv->regmap, 0x03, 0x04);
> > > + regmap_update_bits(priv->regmap, 0x52, RESETDB, 0x00);
> > > +}
> > > +
> > > +static void ch7033_bridge_enable(struct drm_bridge *bridge)
> > > +{
> > > + struct ch7033_priv *priv = bridge_to_ch7033_priv(bridge);
> > > +
> > > + regmap_write(priv->regmap, 0x03, 0x04);
> > > + regmap_update_bits(priv->regmap, 0x52, RESETDB, RESETDB);
> > > +}
> > > +
> > > +static void ch7033_bridge_mode_set(struct drm_bridge *bridge,
> > > + const struct drm_display_mode *mode,
> > > + const struct drm_display_mode *adjusted_mode)
> > > +{
> > > + struct ch7033_priv *priv = bridge_to_ch7033_priv(bridge);
> > > + int hbporch = mode->hsync_start - mode->hdisplay;
> > > + int hsynclen = mode->hsync_end - mode->hsync_start;
> > > + int vbporch = mode->vsync_start - mode->vdisplay;
> > > + int vsynclen = mode->vsync_end - mode->vsync_start;
> > > +
> > > + /*
> > > + * Page 4
> > > + */
> > > + regmap_write(priv->regmap, 0x03, 0x04);
> > > +
> > > + /* Turn everything off to set all the registers to their defaults. */
> > > + regmap_write(priv->regmap, 0x52, 0x00);
> > > + /* Bring I/O block up. */
> > > + regmap_write(priv->regmap, 0x52, RESETIB);
> > > +
> > > + /*
> > > + * Page 0
> > > + */
> > > + regmap_write(priv->regmap, 0x03, 0x00);
> > > +
> > > + /* Bring up parts we need from the power down. */
> > > + regmap_update_bits(priv->regmap, 0x07, DRI_PD | IO_PD, 0);
> > > + regmap_update_bits(priv->regmap, 0x08, DRI_PDDRI | PDDAC | PANEN, 0);
> > > + regmap_update_bits(priv->regmap, 0x09, DPD | GCKOFF |
> > > + HDMI_PD | VGA_PD, 0);
> > > + regmap_update_bits(priv->regmap, 0x0a, HD_DVIB, 0);
> > > +
> > > + /* Horizontal input timing. */
> > > + regmap_write(priv->regmap, 0x0b, (mode->htotal >> 8) << 3 |
> > > + (mode->hdisplay >> 8));
> > > + regmap_write(priv->regmap, 0x0c, mode->hdisplay);
> > > + regmap_write(priv->regmap, 0x0d, mode->htotal);
> > > + regmap_write(priv->regmap, 0x0e, (hsynclen >> 8) << 3 |
> > > + (hbporch >> 8));
> > > + regmap_write(priv->regmap, 0x0f, hbporch);
> > > + regmap_write(priv->regmap, 0x10, hsynclen);
> > > +
> > > + /* Vertical input timing. */
> > > + regmap_write(priv->regmap, 0x11, (mode->vtotal >> 8) << 3 |
> > > + (mode->vdisplay >> 8));
> > > + regmap_write(priv->regmap, 0x12, mode->vdisplay);
> > > + regmap_write(priv->regmap, 0x13, mode->vtotal);
> > > + regmap_write(priv->regmap, 0x14, ((vsynclen >> 8) << 3) |
> > > + (vbporch >> 8));
> > > + regmap_write(priv->regmap, 0x15, vbporch);
> > > + regmap_write(priv->regmap, 0x16, vsynclen);
> > > +
> > > + /* Input color swap. */
> > > + regmap_update_bits(priv->regmap, 0x18, SWAP, BYTE_SWAP_BGR);
> > > +
> > > + /* Input clock and sync polarity. */
> > > + regmap_update_bits(priv->regmap, 0x19, 0x1, mode->clock >> 16);
> > > + regmap_update_bits(priv->regmap, 0x19, HPO_I | VPO_I | GCLKFREQ,
> > > + (mode->flags & DRM_MODE_FLAG_PHSYNC) ? HPO_I : 0 |
> > > + (mode->flags & DRM_MODE_FLAG_PVSYNC) ? VPO_I : 0 |
> > > + mode->clock >> 16);
> > > + regmap_write(priv->regmap, 0x1a, mode->clock >> 8);
> > > + regmap_write(priv->regmap, 0x1b, mode->clock);
> > > +
> > > + /* Horizontal output timing. */
> > > + regmap_write(priv->regmap, 0x1f, (mode->htotal >> 8) << 3 |
> > > + (mode->hdisplay >> 8));
> > > + regmap_write(priv->regmap, 0x20, mode->hdisplay);
> > > + regmap_write(priv->regmap, 0x21, mode->htotal);
> > > +
> > > + /* Vertical output timing. */
> > > + regmap_write(priv->regmap, 0x25, (mode->vtotal >> 8) << 3 |
> > > + (mode->vdisplay >> 8));
> > > + regmap_write(priv->regmap, 0x26, mode->vdisplay);
> > > + regmap_write(priv->regmap, 0x27, mode->vtotal);
> > > +
> > > + /* VGA channel bypass */
> > > + regmap_update_bits(priv->regmap, 0x2b, VFMT, 9);
> > > +
> > > + /* Output sync polarity. */
> > > + regmap_update_bits(priv->regmap, 0x2e, HPO_O | VPO_O,
> > > + (mode->flags & DRM_MODE_FLAG_PHSYNC) ? HPO_O : 0 |
> > > + (mode->flags & DRM_MODE_FLAG_PVSYNC) ? VPO_O : 0);
> > > +
> > > + /* HDMI horizontal output timing. */
> > > + regmap_update_bits(priv->regmap, 0x54, HWO_HDMI_HI | HOO_HDMI_HI,
> > > + (hsynclen >> 8) << 3 |
> > > + (hbporch >> 8));
> > > + regmap_write(priv->regmap, 0x55, hbporch);
> > > + regmap_write(priv->regmap, 0x56, hsynclen);
> > > +
> > > + /* HDMI vertical output timing. */
> > > + regmap_update_bits(priv->regmap, 0x57, VWO_HDMI_HI | VOO_HDMI_HI,
> > > + (vsynclen >> 8) << 3 |
> > > + (vbporch >> 8));
> > > + regmap_write(priv->regmap, 0x58, vbporch);
> > > + regmap_write(priv->regmap, 0x59, vsynclen);
> > > +
> > > + /* Pick HDMI, not LVDS. */
> > > + regmap_update_bits(priv->regmap, 0x7e, HDMI_LVDS_SEL, HDMI_LVDS_SEL);
> > > +
> > > + /*
> > > + * Page 1
> > > + */
> > > + regmap_write(priv->regmap, 0x03, 0x01);
> > > +
> > > + /* No idea what these do, but VGA is wobbly and blinky without them. */
> > > + regmap_update_bits(priv->regmap, 0x07, CKINV, CKINV);
> > > + regmap_update_bits(priv->regmap, 0x08, DISPON, DISPON);
> > > +
> > > + /* DRI PLL */
> > > + regmap_update_bits(priv->regmap, 0x0c, DRI_PLL_DIVSEL, DRI_PLL_DIVSEL);
> > > + if (mode->clock <= 40000) {
> > > + regmap_update_bits(priv->regmap, 0x0c, DRI_PLL_N1_1 |
> > > + DRI_PLL_N1_0 |
> > > + DRI_PLL_N3_1 |
> > > + DRI_PLL_N3_0,
> > > + 0);
> > > + } else if (mode->clock < 80000) {
> > > + regmap_update_bits(priv->regmap, 0x0c, DRI_PLL_N1_1 |
> > > + DRI_PLL_N1_0 |
> > > + DRI_PLL_N3_1 |
> > > + DRI_PLL_N3_0,
> > > + DRI_PLL_N3_0 |
> > > + DRI_PLL_N1_0);
> > > + } else {
> > > + regmap_update_bits(priv->regmap, 0x0c, DRI_PLL_N1_1 |
> > > + DRI_PLL_N1_0 |
> > > + DRI_PLL_N3_1 |
> > > + DRI_PLL_N3_0,
> > > + DRI_PLL_N3_1 |
> > > + DRI_PLL_N1_1);
> > > + }
> > > +
> > > + /* This seems to be color calibration for VGA. */
> > > + regmap_write(priv->regmap, 0x64, 0x29); /* LSB Blue */
> > > + regmap_write(priv->regmap, 0x65, 0x29); /* LSB Green */
> > > + regmap_write(priv->regmap, 0x66, 0x29); /* LSB Red */
> > > + regmap_write(priv->regmap, 0x67, 0x00); /* MSB Blue */
> > > + regmap_write(priv->regmap, 0x68, 0x00); /* MSB Green */
> > > + regmap_write(priv->regmap, 0x69, 0x00); /* MSB Red */
> > > +
> > > + regmap_update_bits(priv->regmap, 0x6b, DRI_PD_SER, 0x00);
> > > + regmap_update_bits(priv->regmap, 0x6c, DRI_PLL_PD, 0x00);
> > > +
> > > + /*
> > > + * Page 3
> > > + */
> > > + regmap_write(priv->regmap, 0x03, 0x03);
> > > +
> > > + /* More bypasses and apparently another HDMI/LVDS selector. */
> > > + regmap_update_bits(priv->regmap, 0x28, VGACLK_BP | HM_LV_SEL,
> > > + VGACLK_BP | HM_LV_SEL);
> > > + regmap_update_bits(priv->regmap, 0x2a, HDMICLK_BP | HDMI_BP,
> > > + HDMICLK_BP | HDMI_BP);
> > > +
> > > + /*
> > > + * Page 4
> > > + */
> > > + regmap_write(priv->regmap, 0x03, 0x04);
> > > +
> > > + /* Output clock. */
> > > + regmap_write(priv->regmap, 0x10, mode->clock >> 16);
> > > + regmap_write(priv->regmap, 0x11, mode->clock >> 8);
> > > + regmap_write(priv->regmap, 0x12, mode->clock);
> > > +}
> > > +
> > > +static const struct drm_bridge_funcs ch7033_bridge_funcs = {
> > > + .attach = ch7033_bridge_attach,
> > > + .detach = ch7033_bridge_detach,
> > > + .mode_valid = ch7033_bridge_mode_valid,
> > > + .disable = ch7033_bridge_disable,
> > > + .enable = ch7033_bridge_enable,
> > > + .mode_set = ch7033_bridge_mode_set,
> > > +};
> > > +
> > > +static const struct drm_encoder_funcs ch7033_encoder_funcs = {
> > > + .destroy = drm_encoder_cleanup,
> > > +};
> > > +
> > > +static int ch7033_bind(struct device *dev, struct device *master,
> > > + void *data)
> > > +{
> > > + struct drm_device *drm = data;
> > > + struct ch7033_priv *priv = dev_get_drvdata(dev);
> > > + uint32_t crtcs;
> > > + int ret;
> > > +
> > > + crtcs = drm_of_find_possible_crtcs(drm, dev->of_node);
> > > + priv->encoder.possible_crtcs = crtcs;
> > > +
> > > + ret = drm_encoder_init(drm, &priv->encoder, &ch7033_encoder_funcs,
> > > + DRM_MODE_ENCODER_TMDS, NULL);
> > > + if (ret)
> > > + return ret;
> > > +
> > > + ret = drm_bridge_attach(&priv->encoder, &priv->bridge, NULL, 0);
> > > + if (ret)
> > > + drm_encoder_cleanup(&priv->encoder);
> > > +
> > > + return ret;
> > > +}
> > > +
> > > +static void ch7033_unbind(struct device *dev, struct device *master,
> > > + void *data)
> > > +{
> > > + struct ch7033_priv *priv = dev_get_drvdata(dev);
> > > +
> > > + drm_encoder_cleanup(&priv->encoder);
> > > +}
> > > +
> > > +static const struct regmap_config ch7033_regmap_config = {
> > > + .reg_bits = 8,
> > > + .val_bits = 8,
> > > + .max_register = 0x7f,
> > > +};
> > > +
> > > +static const struct component_ops ch7033_ops = {
> > > + .bind = ch7033_bind,
> > > + .unbind = ch7033_unbind,
> > > +};
> > > +
> > > +static int ch7033_probe(struct i2c_client *client,
> > > + const struct i2c_device_id *id)
> > > +{
> > > + struct device *dev = &client->dev;
> > > + struct ch7033_priv *priv;
> > > + unsigned int val;
> > > + int ret;
> > > +
> > > + priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);
> > > + if (!priv)
> > > + return -ENOMEM;
> > > +
> > > + dev_set_drvdata(dev, priv);
> > > +
> > > + ret = drm_of_find_panel_or_bridge(dev->of_node, 1, -1, NULL,
> > > + &priv->next_bridge);
> > > + if (ret)
> > > + return ret;
> > > +
> > > + priv->regmap = devm_regmap_init_i2c(client, &ch7033_regmap_config);
> > > + if (IS_ERR(priv->regmap)) {
> > > + dev_err(&client->dev, "regmap init failed\n");
> > > + return PTR_ERR(priv->regmap);
> > > + }
> > > +
> > > + ret = regmap_read(priv->regmap, 0x00, &val);
> > > + if (ret < 0) {
> > > + dev_err(&client->dev, "error reading the model id: %d\n", ret);
> > > + return ret;
> > > + }
> > > + if ((val & 0xf7) != 0x56) {
> > > + dev_err(&client->dev, "the device is not a ch7033\n");
> > > + return -ENODEV;
> > > + }
> > > +
> > > + regmap_write(priv->regmap, 0x03, 0x04);
> > > + ret = regmap_read(priv->regmap, 0x51, &val);
> > > + if (ret < 0) {
> > > + dev_err(&client->dev, "error reading the model id: %d\n", ret);
> > > + return ret;
> > > + }
> > > + if ((val & 0x0f) != 3) {
> > > + dev_err(&client->dev, "unknown revision %u\n", val);
> > > + return -ENODEV;
> > > + }
> > > +
> > > + INIT_LIST_HEAD(&priv->bridge.list);
> > > + priv->bridge.funcs = &ch7033_bridge_funcs;
> > > + priv->bridge.of_node = dev->of_node;
> > > + drm_bridge_add(&priv->bridge);
> > > +
> > > + ret = component_add(dev, &ch7033_ops);
> > > + if (ret) {
> > > + drm_bridge_remove(&priv->bridge);
> > > + return ret;
> > > + }
> > > +
> > > + dev_info(dev, "Chrontel CH7033 Video Encoder\n");
> > > + return 0;
> > > +}
> > > +
> > > +static int ch7033_remove(struct i2c_client *client)
> > > +{
> > > + struct device *dev = &client->dev;
> > > + struct ch7033_priv *priv = dev_get_drvdata(dev);
> > > +
> > > + component_del(dev, &ch7033_ops);
> > > + drm_bridge_remove(&priv->bridge);
> > > +
> > > + return 0;
> > > +}
> > > +
> > > +static const struct of_device_id ch7033_dt_ids[] = {
> > > + { .compatible = "chrontel,ch7033", },
> > > + { }
> > > +};
> > > +MODULE_DEVICE_TABLE(of, ch7033_dt_ids);
> > > +
> > > +static const struct i2c_device_id ch7033_ids[] = {
> > > + { "ch7033", 0 },
> > > + { }
> > > +};
> > > +MODULE_DEVICE_TABLE(i2c, ch7033_ids);
> > > +
> > > +static struct i2c_driver ch7033_driver = {
> > > + .probe = ch7033_probe,
> > > + .remove = ch7033_remove,
> > > + .driver = {
> > > + .name = "ch7033",
> > > + .of_match_table = of_match_ptr(ch7033_dt_ids),
> > > + },
> > > + .id_table = ch7033_ids,
> > > +};
> > > +
> > > +module_i2c_driver(ch7033_driver);
> > > +
> > > +MODULE_AUTHOR("Lubomir Rintel <lkundrak at v3.sk>");
> > > +MODULE_DESCRIPTION("Chrontel CH7033 Video Encoder Driver");
> > > +MODULE_LICENSE("GPL v2");
> > > --
> > > 2.26.0.rc2
> > >
> > > _______________________________________________
> > > dri-devel mailing list
> > > dri-devel at lists.freedesktop.org
> > > https://lists.freedesktop.org/mailman/listinfo/dri-devel
> >
> > --
> > Daniel Vetter
> > Software Engineer, Intel Corporation
> > http://blog.ffwll.ch
> _______________________________________________
> dri-devel mailing list
> dri-devel at lists.freedesktop.org
> https://lists.freedesktop.org/mailman/listinfo/dri-devel
--
Daniel Vetter
Software Engineer, Intel Corporation
http://blog.ffwll.ch
More information about the dri-devel
mailing list