123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410 |
- // SPDX-License-Identifier: GPL-2.0-only
- /*
- * Copyright (c) 2016 MediaTek Inc.
- */
- #include <linux/delay.h>
- #include <linux/err.h>
- #include <linux/gpio/consumer.h>
- #include <linux/i2c.h>
- #include <linux/module.h>
- #include <linux/of_graph.h>
- #include <linux/regulator/consumer.h>
- #include <drm/drm_bridge.h>
- #include <drm/drm_mipi_dsi.h>
- #include <drm/drm_of.h>
- #include <drm/drm_panel.h>
- #include <drm/drm_print.h>
- #define PAGE2_GPIO_H 0xa7
- #define PS_GPIO9 BIT(1)
- #define PAGE2_I2C_BYPASS 0xea
- #define I2C_BYPASS_EN 0xd0
- #define PAGE2_MCS_EN 0xf3
- #define MCS_EN BIT(0)
- #define PAGE3_SET_ADD 0xfe
- #define VDO_CTL_ADD 0x13
- #define VDO_DIS 0x18
- #define VDO_EN 0x1c
- #define DP_NUM_LANES 4
- /*
- * PS8640 uses multiple addresses:
- * page[0]: for DP control
- * page[1]: for VIDEO Bridge
- * page[2]: for control top
- * page[3]: for DSI Link Control1
- * page[4]: for MIPI Phy
- * page[5]: for VPLL
- * page[6]: for DSI Link Control2
- * page[7]: for SPI ROM mapping
- */
- enum page_addr_offset {
- PAGE0_DP_CNTL = 0,
- PAGE1_VDO_BDG,
- PAGE2_TOP_CNTL,
- PAGE3_DSI_CNTL1,
- PAGE4_MIPI_PHY,
- PAGE5_VPLL,
- PAGE6_DSI_CNTL2,
- PAGE7_SPI_CNTL,
- MAX_DEVS
- };
- enum ps8640_vdo_control {
- DISABLE = VDO_DIS,
- ENABLE = VDO_EN,
- };
- struct ps8640 {
- struct drm_bridge bridge;
- struct drm_bridge *panel_bridge;
- struct mipi_dsi_device *dsi;
- struct i2c_client *page[MAX_DEVS];
- struct regulator_bulk_data supplies[2];
- struct gpio_desc *gpio_reset;
- struct gpio_desc *gpio_powerdown;
- bool powered;
- };
- static inline struct ps8640 *bridge_to_ps8640(struct drm_bridge *e)
- {
- return container_of(e, struct ps8640, bridge);
- }
- static int ps8640_bridge_vdo_control(struct ps8640 *ps_bridge,
- const enum ps8640_vdo_control ctrl)
- {
- struct i2c_client *client = ps_bridge->page[PAGE3_DSI_CNTL1];
- u8 vdo_ctrl_buf[] = { VDO_CTL_ADD, ctrl };
- int ret;
- ret = i2c_smbus_write_i2c_block_data(client, PAGE3_SET_ADD,
- sizeof(vdo_ctrl_buf),
- vdo_ctrl_buf);
- if (ret < 0) {
- DRM_ERROR("failed to %sable VDO: %d\n",
- ctrl == ENABLE ? "en" : "dis", ret);
- return ret;
- }
- return 0;
- }
- static void ps8640_bridge_poweron(struct ps8640 *ps_bridge)
- {
- struct i2c_client *client = ps_bridge->page[PAGE2_TOP_CNTL];
- unsigned long timeout;
- int ret, status;
- if (ps_bridge->powered)
- return;
- ret = regulator_bulk_enable(ARRAY_SIZE(ps_bridge->supplies),
- ps_bridge->supplies);
- if (ret < 0) {
- DRM_ERROR("cannot enable regulators %d\n", ret);
- return;
- }
- gpiod_set_value(ps_bridge->gpio_powerdown, 0);
- gpiod_set_value(ps_bridge->gpio_reset, 1);
- usleep_range(2000, 2500);
- gpiod_set_value(ps_bridge->gpio_reset, 0);
- /*
- * Wait for the ps8640 embedded MCU to be ready
- * First wait 200ms and then check the MCU ready flag every 20ms
- */
- msleep(200);
- timeout = jiffies + msecs_to_jiffies(200) + 1;
- while (time_is_after_jiffies(timeout)) {
- status = i2c_smbus_read_byte_data(client, PAGE2_GPIO_H);
- if (status < 0) {
- DRM_ERROR("failed read PAGE2_GPIO_H: %d\n", status);
- goto err_regulators_disable;
- }
- if ((status & PS_GPIO9) == PS_GPIO9)
- break;
- msleep(20);
- }
- msleep(50);
- /*
- * The Manufacturer Command Set (MCS) is a device dependent interface
- * intended for factory programming of the display module default
- * parameters. Once the display module is configured, the MCS shall be
- * disabled by the manufacturer. Once disabled, all MCS commands are
- * ignored by the display interface.
- */
- status = i2c_smbus_read_byte_data(client, PAGE2_MCS_EN);
- if (status < 0) {
- DRM_ERROR("failed read PAGE2_MCS_EN: %d\n", status);
- goto err_regulators_disable;
- }
- ret = i2c_smbus_write_byte_data(client, PAGE2_MCS_EN,
- status & ~MCS_EN);
- if (ret < 0) {
- DRM_ERROR("failed write PAGE2_MCS_EN: %d\n", ret);
- goto err_regulators_disable;
- }
- /* Switch access edp panel's edid through i2c */
- ret = i2c_smbus_write_byte_data(client, PAGE2_I2C_BYPASS,
- I2C_BYPASS_EN);
- if (ret < 0) {
- DRM_ERROR("failed write PAGE2_I2C_BYPASS: %d\n", ret);
- goto err_regulators_disable;
- }
- ps_bridge->powered = true;
- return;
- err_regulators_disable:
- regulator_bulk_disable(ARRAY_SIZE(ps_bridge->supplies),
- ps_bridge->supplies);
- }
- static void ps8640_bridge_poweroff(struct ps8640 *ps_bridge)
- {
- int ret;
- if (!ps_bridge->powered)
- return;
- gpiod_set_value(ps_bridge->gpio_reset, 1);
- gpiod_set_value(ps_bridge->gpio_powerdown, 1);
- ret = regulator_bulk_disable(ARRAY_SIZE(ps_bridge->supplies),
- ps_bridge->supplies);
- if (ret < 0)
- DRM_ERROR("cannot disable regulators %d\n", ret);
- ps_bridge->powered = false;
- }
- static void ps8640_pre_enable(struct drm_bridge *bridge)
- {
- struct ps8640 *ps_bridge = bridge_to_ps8640(bridge);
- int ret;
- ps8640_bridge_poweron(ps_bridge);
- ret = ps8640_bridge_vdo_control(ps_bridge, ENABLE);
- if (ret < 0)
- ps8640_bridge_poweroff(ps_bridge);
- }
- static void ps8640_post_disable(struct drm_bridge *bridge)
- {
- struct ps8640 *ps_bridge = bridge_to_ps8640(bridge);
- ps8640_bridge_vdo_control(ps_bridge, DISABLE);
- ps8640_bridge_poweroff(ps_bridge);
- }
- static int ps8640_bridge_attach(struct drm_bridge *bridge,
- enum drm_bridge_attach_flags flags)
- {
- struct ps8640 *ps_bridge = bridge_to_ps8640(bridge);
- struct device *dev = &ps_bridge->page[0]->dev;
- struct device_node *in_ep, *dsi_node;
- struct mipi_dsi_device *dsi;
- struct mipi_dsi_host *host;
- int ret;
- const struct mipi_dsi_device_info info = { .type = "ps8640",
- .channel = 0,
- .node = NULL,
- };
- if (!(flags & DRM_BRIDGE_ATTACH_NO_CONNECTOR))
- return -EINVAL;
- /* port@0 is ps8640 dsi input port */
- in_ep = of_graph_get_endpoint_by_regs(dev->of_node, 0, -1);
- if (!in_ep)
- return -ENODEV;
- dsi_node = of_graph_get_remote_port_parent(in_ep);
- of_node_put(in_ep);
- if (!dsi_node)
- return -ENODEV;
- host = of_find_mipi_dsi_host_by_node(dsi_node);
- of_node_put(dsi_node);
- if (!host)
- return -ENODEV;
- dsi = mipi_dsi_device_register_full(host, &info);
- if (IS_ERR(dsi)) {
- dev_err(dev, "failed to create dsi device\n");
- ret = PTR_ERR(dsi);
- return ret;
- }
- ps_bridge->dsi = dsi;
- dsi->host = host;
- dsi->mode_flags = MIPI_DSI_MODE_VIDEO |
- MIPI_DSI_MODE_VIDEO_SYNC_PULSE;
- dsi->format = MIPI_DSI_FMT_RGB888;
- dsi->lanes = DP_NUM_LANES;
- ret = mipi_dsi_attach(dsi);
- if (ret)
- goto err_dsi_attach;
- /* Attach the panel-bridge to the dsi bridge */
- return drm_bridge_attach(bridge->encoder, ps_bridge->panel_bridge,
- &ps_bridge->bridge, flags);
- err_dsi_attach:
- mipi_dsi_device_unregister(dsi);
- return ret;
- }
- static struct edid *ps8640_bridge_get_edid(struct drm_bridge *bridge,
- struct drm_connector *connector)
- {
- struct ps8640 *ps_bridge = bridge_to_ps8640(bridge);
- bool poweroff = !ps_bridge->powered;
- struct edid *edid;
- /*
- * When we end calling get_edid() triggered by an ioctl, i.e
- *
- * drm_mode_getconnector (ioctl)
- * -> drm_helper_probe_single_connector_modes
- * -> drm_bridge_connector_get_modes
- * -> ps8640_bridge_get_edid
- *
- * We need to make sure that what we need is enabled before reading
- * EDID, for this chip, we need to do a full poweron, otherwise it will
- * fail.
- */
- drm_bridge_chain_pre_enable(bridge);
- edid = drm_get_edid(connector,
- ps_bridge->page[PAGE0_DP_CNTL]->adapter);
- /*
- * If we call the get_edid() function without having enabled the chip
- * before, return the chip to its original power state.
- */
- if (poweroff)
- drm_bridge_chain_post_disable(bridge);
- return edid;
- }
- static const struct drm_bridge_funcs ps8640_bridge_funcs = {
- .attach = ps8640_bridge_attach,
- .get_edid = ps8640_bridge_get_edid,
- .post_disable = ps8640_post_disable,
- .pre_enable = ps8640_pre_enable,
- };
- static int ps8640_probe(struct i2c_client *client)
- {
- struct device *dev = &client->dev;
- struct device_node *np = dev->of_node;
- struct ps8640 *ps_bridge;
- struct drm_panel *panel;
- int ret;
- u32 i;
- ps_bridge = devm_kzalloc(dev, sizeof(*ps_bridge), GFP_KERNEL);
- if (!ps_bridge)
- return -ENOMEM;
- /* port@1 is ps8640 output port */
- ret = drm_of_find_panel_or_bridge(np, 1, 0, &panel, NULL);
- if (ret < 0)
- return ret;
- if (!panel)
- return -ENODEV;
- ps_bridge->panel_bridge = devm_drm_panel_bridge_add(dev, panel);
- if (IS_ERR(ps_bridge->panel_bridge))
- return PTR_ERR(ps_bridge->panel_bridge);
- ps_bridge->supplies[0].supply = "vdd33";
- ps_bridge->supplies[1].supply = "vdd12";
- ret = devm_regulator_bulk_get(dev, ARRAY_SIZE(ps_bridge->supplies),
- ps_bridge->supplies);
- if (ret)
- return ret;
- ps_bridge->gpio_powerdown = devm_gpiod_get(&client->dev, "powerdown",
- GPIOD_OUT_HIGH);
- if (IS_ERR(ps_bridge->gpio_powerdown))
- return PTR_ERR(ps_bridge->gpio_powerdown);
- /*
- * Assert the reset to avoid the bridge being initialized prematurely
- */
- ps_bridge->gpio_reset = devm_gpiod_get(&client->dev, "reset",
- GPIOD_OUT_HIGH);
- if (IS_ERR(ps_bridge->gpio_reset))
- return PTR_ERR(ps_bridge->gpio_reset);
- ps_bridge->bridge.funcs = &ps8640_bridge_funcs;
- ps_bridge->bridge.of_node = dev->of_node;
- ps_bridge->bridge.ops = DRM_BRIDGE_OP_EDID;
- ps_bridge->bridge.type = DRM_MODE_CONNECTOR_eDP;
- ps_bridge->page[PAGE0_DP_CNTL] = client;
- for (i = 1; i < ARRAY_SIZE(ps_bridge->page); i++) {
- ps_bridge->page[i] = devm_i2c_new_dummy_device(&client->dev,
- client->adapter,
- client->addr + i);
- if (IS_ERR(ps_bridge->page[i])) {
- dev_err(dev, "failed i2c dummy device, address %02x\n",
- client->addr + i);
- return PTR_ERR(ps_bridge->page[i]);
- }
- }
- i2c_set_clientdata(client, ps_bridge);
- drm_bridge_add(&ps_bridge->bridge);
- return 0;
- }
- static int ps8640_remove(struct i2c_client *client)
- {
- struct ps8640 *ps_bridge = i2c_get_clientdata(client);
- drm_bridge_remove(&ps_bridge->bridge);
- return 0;
- }
- static const struct of_device_id ps8640_match[] = {
- { .compatible = "parade,ps8640" },
- { }
- };
- MODULE_DEVICE_TABLE(of, ps8640_match);
- static struct i2c_driver ps8640_driver = {
- .probe_new = ps8640_probe,
- .remove = ps8640_remove,
- .driver = {
- .name = "ps8640",
- .of_match_table = ps8640_match,
- },
- };
- module_i2c_driver(ps8640_driver);
- MODULE_AUTHOR("Jitao Shi <jitao.shi@mediatek.com>");
- MODULE_AUTHOR("CK Hu <ck.hu@mediatek.com>");
- MODULE_AUTHOR("Enric Balletbo i Serra <enric.balletbo@collabora.com>");
- MODULE_DESCRIPTION("PARADE ps8640 DSI-eDP converter driver");
- MODULE_LICENSE("GPL v2");
|