1d2912cb1SThomas Gleixner // SPDX-License-Identifier: GPL-2.0-only 2dc55ac3bSJyri Sarha /* 3dc55ac3bSJyri Sarha * Copyright (C) 2016 Texas Instruments 4dc55ac3bSJyri Sarha * Author: Jyri Sarha <jsarha@ti.com> 5dc55ac3bSJyri Sarha */ 6dc55ac3bSJyri Sarha 7f56c9202SChristopher Spinrath #include <linux/gpio/consumer.h> 895b60804SSam Ravnborg #include <linux/i2c.h> 9dc55ac3bSJyri Sarha #include <linux/module.h> 10dc55ac3bSJyri Sarha #include <linux/of_graph.h> 11dc55ac3bSJyri Sarha #include <linux/platform_device.h> 12*5cafa0f1SLaurent Pinchart #include <linux/workqueue.h> 13dc55ac3bSJyri Sarha 14dc55ac3bSJyri Sarha #include <drm/drm_atomic_helper.h> 15ee68c743SBoris Brezillon #include <drm/drm_bridge.h> 16dc55ac3bSJyri Sarha #include <drm/drm_crtc.h> 1795b60804SSam Ravnborg #include <drm/drm_print.h> 18fcd70cd3SDaniel Vetter #include <drm/drm_probe_helper.h> 19dc55ac3bSJyri Sarha 20f56c9202SChristopher Spinrath #define HOTPLUG_DEBOUNCE_MS 1100 21f56c9202SChristopher Spinrath 22dc55ac3bSJyri Sarha struct tfp410 { 23dc55ac3bSJyri Sarha struct drm_bridge bridge; 24dc55ac3bSJyri Sarha struct drm_connector connector; 25dc55ac3bSJyri Sarha 260eb2766dSPeter Ujfalusi u32 bus_format; 27f56c9202SChristopher Spinrath struct delayed_work hpd_work; 2838c02db7SLaurent Pinchart struct gpio_desc *powerdown; 29dc55ac3bSJyri Sarha 30897dae56SLaurent Pinchart struct drm_bridge_timings timings; 31*5cafa0f1SLaurent Pinchart struct drm_bridge *next_bridge; 32897dae56SLaurent Pinchart 33dc55ac3bSJyri Sarha struct device *dev; 34dc55ac3bSJyri Sarha }; 35dc55ac3bSJyri Sarha 36dc55ac3bSJyri Sarha static inline struct tfp410 * 37dc55ac3bSJyri Sarha drm_bridge_to_tfp410(struct drm_bridge *bridge) 38dc55ac3bSJyri Sarha { 39dc55ac3bSJyri Sarha return container_of(bridge, struct tfp410, bridge); 40dc55ac3bSJyri Sarha } 41dc55ac3bSJyri Sarha 42dc55ac3bSJyri Sarha static inline struct tfp410 * 43dc55ac3bSJyri Sarha drm_connector_to_tfp410(struct drm_connector *connector) 44dc55ac3bSJyri Sarha { 45dc55ac3bSJyri Sarha return container_of(connector, struct tfp410, connector); 46dc55ac3bSJyri Sarha } 47dc55ac3bSJyri Sarha 48dc55ac3bSJyri Sarha static int tfp410_get_modes(struct drm_connector *connector) 49dc55ac3bSJyri Sarha { 50dc55ac3bSJyri Sarha struct tfp410 *dvi = drm_connector_to_tfp410(connector); 51dc55ac3bSJyri Sarha struct edid *edid; 52dc55ac3bSJyri Sarha int ret; 53dc55ac3bSJyri Sarha 54*5cafa0f1SLaurent Pinchart edid = drm_bridge_get_edid(dvi->next_bridge, connector); 55*5cafa0f1SLaurent Pinchart if (IS_ERR_OR_NULL(edid)) { 56*5cafa0f1SLaurent Pinchart if (edid != ERR_PTR(-ENOTSUPP)) 57dc55ac3bSJyri Sarha DRM_INFO("EDID read failed. Fallback to standard modes\n"); 58*5cafa0f1SLaurent Pinchart 59*5cafa0f1SLaurent Pinchart /* 60*5cafa0f1SLaurent Pinchart * No EDID, fallback on the XGA standard modes and prefer a mode 61*5cafa0f1SLaurent Pinchart * pretty much anything can handle. 62*5cafa0f1SLaurent Pinchart */ 63*5cafa0f1SLaurent Pinchart ret = drm_add_modes_noedid(connector, 1920, 1200); 64*5cafa0f1SLaurent Pinchart drm_set_preferred_mode(connector, 1024, 768); 65*5cafa0f1SLaurent Pinchart return ret; 66dc55ac3bSJyri Sarha } 67dc55ac3bSJyri Sarha 68c555f023SDaniel Vetter drm_connector_update_edid_property(connector, edid); 69dc55ac3bSJyri Sarha 70c08f99c3STomi Valkeinen ret = drm_add_edid_modes(connector, edid); 71c08f99c3STomi Valkeinen 72c08f99c3STomi Valkeinen kfree(edid); 73c08f99c3STomi Valkeinen 74c08f99c3STomi Valkeinen return ret; 75dc55ac3bSJyri Sarha } 76dc55ac3bSJyri Sarha 77dc55ac3bSJyri Sarha static const struct drm_connector_helper_funcs tfp410_con_helper_funcs = { 78dc55ac3bSJyri Sarha .get_modes = tfp410_get_modes, 79dc55ac3bSJyri Sarha }; 80dc55ac3bSJyri Sarha 81dc55ac3bSJyri Sarha static enum drm_connector_status 82dc55ac3bSJyri Sarha tfp410_connector_detect(struct drm_connector *connector, bool force) 83dc55ac3bSJyri Sarha { 84dc55ac3bSJyri Sarha struct tfp410 *dvi = drm_connector_to_tfp410(connector); 85dc55ac3bSJyri Sarha 86*5cafa0f1SLaurent Pinchart return drm_bridge_detect(dvi->next_bridge); 87dc55ac3bSJyri Sarha } 88dc55ac3bSJyri Sarha 89dc55ac3bSJyri Sarha static const struct drm_connector_funcs tfp410_con_funcs = { 90dc55ac3bSJyri Sarha .detect = tfp410_connector_detect, 91dc55ac3bSJyri Sarha .fill_modes = drm_helper_probe_single_connector_modes, 92dc55ac3bSJyri Sarha .destroy = drm_connector_cleanup, 93dc55ac3bSJyri Sarha .reset = drm_atomic_helper_connector_reset, 94dc55ac3bSJyri Sarha .atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state, 95dc55ac3bSJyri Sarha .atomic_destroy_state = drm_atomic_helper_connector_destroy_state, 96dc55ac3bSJyri Sarha }; 97dc55ac3bSJyri Sarha 98*5cafa0f1SLaurent Pinchart static void tfp410_hpd_work_func(struct work_struct *work) 99*5cafa0f1SLaurent Pinchart { 100*5cafa0f1SLaurent Pinchart struct tfp410 *dvi; 101*5cafa0f1SLaurent Pinchart 102*5cafa0f1SLaurent Pinchart dvi = container_of(work, struct tfp410, hpd_work.work); 103*5cafa0f1SLaurent Pinchart 104*5cafa0f1SLaurent Pinchart if (dvi->bridge.dev) 105*5cafa0f1SLaurent Pinchart drm_helper_hpd_irq_event(dvi->bridge.dev); 106*5cafa0f1SLaurent Pinchart } 107*5cafa0f1SLaurent Pinchart 108*5cafa0f1SLaurent Pinchart static void tfp410_hpd_callback(void *arg, enum drm_connector_status status) 109*5cafa0f1SLaurent Pinchart { 110*5cafa0f1SLaurent Pinchart struct tfp410 *dvi = arg; 111*5cafa0f1SLaurent Pinchart 112*5cafa0f1SLaurent Pinchart mod_delayed_work(system_wq, &dvi->hpd_work, 113*5cafa0f1SLaurent Pinchart msecs_to_jiffies(HOTPLUG_DEBOUNCE_MS)); 114*5cafa0f1SLaurent Pinchart } 115*5cafa0f1SLaurent Pinchart 116a25b988fSLaurent Pinchart static int tfp410_attach(struct drm_bridge *bridge, 117a25b988fSLaurent Pinchart enum drm_bridge_attach_flags flags) 118dc55ac3bSJyri Sarha { 119dc55ac3bSJyri Sarha struct tfp410 *dvi = drm_bridge_to_tfp410(bridge); 120dc55ac3bSJyri Sarha int ret; 121dc55ac3bSJyri Sarha 122*5cafa0f1SLaurent Pinchart ret = drm_bridge_attach(bridge->encoder, dvi->next_bridge, bridge, 123*5cafa0f1SLaurent Pinchart DRM_BRIDGE_ATTACH_NO_CONNECTOR); 124*5cafa0f1SLaurent Pinchart if (ret < 0) 125*5cafa0f1SLaurent Pinchart return ret; 126*5cafa0f1SLaurent Pinchart 127a25b988fSLaurent Pinchart if (flags & DRM_BRIDGE_ATTACH_NO_CONNECTOR) { 128a25b988fSLaurent Pinchart DRM_ERROR("Fix bridge driver to make connector optional!"); 129a25b988fSLaurent Pinchart return -EINVAL; 130a25b988fSLaurent Pinchart } 131a25b988fSLaurent Pinchart 132dc55ac3bSJyri Sarha if (!bridge->encoder) { 133dc55ac3bSJyri Sarha dev_err(dvi->dev, "Missing encoder\n"); 134dc55ac3bSJyri Sarha return -ENODEV; 135dc55ac3bSJyri Sarha } 136dc55ac3bSJyri Sarha 137*5cafa0f1SLaurent Pinchart if (dvi->next_bridge->ops & DRM_BRIDGE_OP_DETECT) 138f56c9202SChristopher Spinrath dvi->connector.polled = DRM_CONNECTOR_POLL_HPD; 1393d31e215SPeter Ujfalusi else 1403d31e215SPeter Ujfalusi dvi->connector.polled = DRM_CONNECTOR_POLL_CONNECT | DRM_CONNECTOR_POLL_DISCONNECT; 141f56c9202SChristopher Spinrath 142*5cafa0f1SLaurent Pinchart if (dvi->next_bridge->ops & DRM_BRIDGE_OP_HPD) { 143*5cafa0f1SLaurent Pinchart INIT_DELAYED_WORK(&dvi->hpd_work, tfp410_hpd_work_func); 144*5cafa0f1SLaurent Pinchart drm_bridge_hpd_enable(dvi->next_bridge, tfp410_hpd_callback, 145*5cafa0f1SLaurent Pinchart dvi); 146*5cafa0f1SLaurent Pinchart } 147*5cafa0f1SLaurent Pinchart 148dc55ac3bSJyri Sarha drm_connector_helper_add(&dvi->connector, 149dc55ac3bSJyri Sarha &tfp410_con_helper_funcs); 150cfb44455SAndrzej Pietrasiewicz ret = drm_connector_init_with_ddc(bridge->dev, &dvi->connector, 151cfb44455SAndrzej Pietrasiewicz &tfp410_con_funcs, 152*5cafa0f1SLaurent Pinchart dvi->next_bridge->type, 153*5cafa0f1SLaurent Pinchart dvi->next_bridge->ddc); 154dc55ac3bSJyri Sarha if (ret) { 155dc55ac3bSJyri Sarha dev_err(dvi->dev, "drm_connector_init() failed: %d\n", ret); 156dc55ac3bSJyri Sarha return ret; 157dc55ac3bSJyri Sarha } 158dc55ac3bSJyri Sarha 1590eb2766dSPeter Ujfalusi drm_display_info_set_bus_formats(&dvi->connector.display_info, 1600eb2766dSPeter Ujfalusi &dvi->bus_format, 1); 1610eb2766dSPeter Ujfalusi 162*5cafa0f1SLaurent Pinchart drm_connector_attach_encoder(&dvi->connector, bridge->encoder); 163dc55ac3bSJyri Sarha 164dc55ac3bSJyri Sarha return 0; 165dc55ac3bSJyri Sarha } 166dc55ac3bSJyri Sarha 167*5cafa0f1SLaurent Pinchart static void tfp410_detach(struct drm_bridge *bridge) 168*5cafa0f1SLaurent Pinchart { 169*5cafa0f1SLaurent Pinchart struct tfp410 *dvi = drm_bridge_to_tfp410(bridge); 170*5cafa0f1SLaurent Pinchart 171*5cafa0f1SLaurent Pinchart if (dvi->connector.dev && dvi->next_bridge->ops & DRM_BRIDGE_OP_HPD) { 172*5cafa0f1SLaurent Pinchart drm_bridge_hpd_disable(dvi->next_bridge); 173*5cafa0f1SLaurent Pinchart cancel_delayed_work_sync(&dvi->hpd_work); 174*5cafa0f1SLaurent Pinchart } 175*5cafa0f1SLaurent Pinchart } 176*5cafa0f1SLaurent Pinchart 17738c02db7SLaurent Pinchart static void tfp410_enable(struct drm_bridge *bridge) 17838c02db7SLaurent Pinchart { 17938c02db7SLaurent Pinchart struct tfp410 *dvi = drm_bridge_to_tfp410(bridge); 18038c02db7SLaurent Pinchart 18138c02db7SLaurent Pinchart gpiod_set_value_cansleep(dvi->powerdown, 0); 18238c02db7SLaurent Pinchart } 18338c02db7SLaurent Pinchart 18438c02db7SLaurent Pinchart static void tfp410_disable(struct drm_bridge *bridge) 18538c02db7SLaurent Pinchart { 18638c02db7SLaurent Pinchart struct tfp410 *dvi = drm_bridge_to_tfp410(bridge); 18738c02db7SLaurent Pinchart 18838c02db7SLaurent Pinchart gpiod_set_value_cansleep(dvi->powerdown, 1); 18938c02db7SLaurent Pinchart } 19038c02db7SLaurent Pinchart 1919109594dSTomi Valkeinen static enum drm_mode_status tfp410_mode_valid(struct drm_bridge *bridge, 1929109594dSTomi Valkeinen const struct drm_display_mode *mode) 1939109594dSTomi Valkeinen { 1949109594dSTomi Valkeinen if (mode->clock < 25000) 1959109594dSTomi Valkeinen return MODE_CLOCK_LOW; 1969109594dSTomi Valkeinen 1979109594dSTomi Valkeinen if (mode->clock > 165000) 1989109594dSTomi Valkeinen return MODE_CLOCK_HIGH; 1999109594dSTomi Valkeinen 2009109594dSTomi Valkeinen return MODE_OK; 2019109594dSTomi Valkeinen } 2029109594dSTomi Valkeinen 203dc55ac3bSJyri Sarha static const struct drm_bridge_funcs tfp410_bridge_funcs = { 204dc55ac3bSJyri Sarha .attach = tfp410_attach, 205*5cafa0f1SLaurent Pinchart .detach = tfp410_detach, 20638c02db7SLaurent Pinchart .enable = tfp410_enable, 20738c02db7SLaurent Pinchart .disable = tfp410_disable, 2089109594dSTomi Valkeinen .mode_valid = tfp410_mode_valid, 209dc55ac3bSJyri Sarha }; 210dc55ac3bSJyri Sarha 211897dae56SLaurent Pinchart static const struct drm_bridge_timings tfp410_default_timings = { 212897dae56SLaurent Pinchart .input_bus_flags = DRM_BUS_FLAG_PIXDATA_SAMPLE_POSEDGE 213897dae56SLaurent Pinchart | DRM_BUS_FLAG_DE_HIGH, 214897dae56SLaurent Pinchart .setup_time_ps = 1200, 215897dae56SLaurent Pinchart .hold_time_ps = 1300, 216897dae56SLaurent Pinchart }; 217897dae56SLaurent Pinchart 218897dae56SLaurent Pinchart static int tfp410_parse_timings(struct tfp410 *dvi, bool i2c) 219897dae56SLaurent Pinchart { 220897dae56SLaurent Pinchart struct drm_bridge_timings *timings = &dvi->timings; 221897dae56SLaurent Pinchart struct device_node *ep; 222897dae56SLaurent Pinchart u32 pclk_sample = 0; 2230eb2766dSPeter Ujfalusi u32 bus_width = 24; 224897dae56SLaurent Pinchart s32 deskew = 0; 225897dae56SLaurent Pinchart 226897dae56SLaurent Pinchart /* Start with defaults. */ 227897dae56SLaurent Pinchart *timings = tfp410_default_timings; 228897dae56SLaurent Pinchart 229897dae56SLaurent Pinchart if (i2c) 230897dae56SLaurent Pinchart /* 231897dae56SLaurent Pinchart * In I2C mode timings are configured through the I2C interface. 232897dae56SLaurent Pinchart * As the driver doesn't support I2C configuration yet, we just 233897dae56SLaurent Pinchart * go with the defaults (BSEL=1, DSEL=1, DKEN=0, EDGE=1). 234897dae56SLaurent Pinchart */ 235897dae56SLaurent Pinchart return 0; 236897dae56SLaurent Pinchart 237897dae56SLaurent Pinchart /* 238897dae56SLaurent Pinchart * In non-I2C mode, timings are configured through the BSEL, DSEL, DKEN 239897dae56SLaurent Pinchart * and EDGE pins. They are specified in DT through endpoint properties 240897dae56SLaurent Pinchart * and vendor-specific properties. 241897dae56SLaurent Pinchart */ 242897dae56SLaurent Pinchart ep = of_graph_get_endpoint_by_regs(dvi->dev->of_node, 0, 0); 243897dae56SLaurent Pinchart if (!ep) 244897dae56SLaurent Pinchart return -EINVAL; 245897dae56SLaurent Pinchart 246897dae56SLaurent Pinchart /* Get the sampling edge from the endpoint. */ 247897dae56SLaurent Pinchart of_property_read_u32(ep, "pclk-sample", &pclk_sample); 2480eb2766dSPeter Ujfalusi of_property_read_u32(ep, "bus-width", &bus_width); 249897dae56SLaurent Pinchart of_node_put(ep); 250897dae56SLaurent Pinchart 251897dae56SLaurent Pinchart timings->input_bus_flags = DRM_BUS_FLAG_DE_HIGH; 252897dae56SLaurent Pinchart 253897dae56SLaurent Pinchart switch (pclk_sample) { 254897dae56SLaurent Pinchart case 0: 255897dae56SLaurent Pinchart timings->input_bus_flags |= DRM_BUS_FLAG_PIXDATA_SAMPLE_NEGEDGE 256897dae56SLaurent Pinchart | DRM_BUS_FLAG_SYNC_SAMPLE_NEGEDGE; 257897dae56SLaurent Pinchart break; 258897dae56SLaurent Pinchart case 1: 259897dae56SLaurent Pinchart timings->input_bus_flags |= DRM_BUS_FLAG_PIXDATA_SAMPLE_POSEDGE 260897dae56SLaurent Pinchart | DRM_BUS_FLAG_SYNC_SAMPLE_POSEDGE; 261897dae56SLaurent Pinchart break; 262897dae56SLaurent Pinchart default: 263897dae56SLaurent Pinchart return -EINVAL; 264897dae56SLaurent Pinchart } 265897dae56SLaurent Pinchart 2660eb2766dSPeter Ujfalusi switch (bus_width) { 2670eb2766dSPeter Ujfalusi case 12: 2680eb2766dSPeter Ujfalusi dvi->bus_format = MEDIA_BUS_FMT_RGB888_2X12_LE; 2690eb2766dSPeter Ujfalusi break; 2700eb2766dSPeter Ujfalusi case 24: 2710eb2766dSPeter Ujfalusi dvi->bus_format = MEDIA_BUS_FMT_RGB888_1X24; 2720eb2766dSPeter Ujfalusi break; 2730eb2766dSPeter Ujfalusi default: 2740eb2766dSPeter Ujfalusi return -EINVAL; 2750eb2766dSPeter Ujfalusi } 2760eb2766dSPeter Ujfalusi 277897dae56SLaurent Pinchart /* Get the setup and hold time from vendor-specific properties. */ 278897dae56SLaurent Pinchart of_property_read_u32(dvi->dev->of_node, "ti,deskew", (u32 *)&deskew); 279897dae56SLaurent Pinchart if (deskew < -4 || deskew > 3) 280897dae56SLaurent Pinchart return -EINVAL; 281897dae56SLaurent Pinchart 282897dae56SLaurent Pinchart timings->setup_time_ps = min(0, 1200 - 350 * deskew); 283897dae56SLaurent Pinchart timings->hold_time_ps = min(0, 1300 + 350 * deskew); 284897dae56SLaurent Pinchart 285897dae56SLaurent Pinchart return 0; 286897dae56SLaurent Pinchart } 287897dae56SLaurent Pinchart 288897dae56SLaurent Pinchart static int tfp410_init(struct device *dev, bool i2c) 289dc55ac3bSJyri Sarha { 290*5cafa0f1SLaurent Pinchart struct device_node *node; 291dc55ac3bSJyri Sarha struct tfp410 *dvi; 292dc55ac3bSJyri Sarha int ret; 293dc55ac3bSJyri Sarha 294dc55ac3bSJyri Sarha if (!dev->of_node) { 295dc55ac3bSJyri Sarha dev_err(dev, "device-tree data is missing\n"); 296dc55ac3bSJyri Sarha return -ENXIO; 297dc55ac3bSJyri Sarha } 298dc55ac3bSJyri Sarha 299dc55ac3bSJyri Sarha dvi = devm_kzalloc(dev, sizeof(*dvi), GFP_KERNEL); 300dc55ac3bSJyri Sarha if (!dvi) 301dc55ac3bSJyri Sarha return -ENOMEM; 302*5cafa0f1SLaurent Pinchart 303*5cafa0f1SLaurent Pinchart dvi->dev = dev; 304dc55ac3bSJyri Sarha dev_set_drvdata(dev, dvi); 305dc55ac3bSJyri Sarha 306dc55ac3bSJyri Sarha dvi->bridge.funcs = &tfp410_bridge_funcs; 307dc55ac3bSJyri Sarha dvi->bridge.of_node = dev->of_node; 308897dae56SLaurent Pinchart dvi->bridge.timings = &dvi->timings; 309*5cafa0f1SLaurent Pinchart dvi->bridge.type = DRM_MODE_CONNECTOR_DVID; 310dc55ac3bSJyri Sarha 311897dae56SLaurent Pinchart ret = tfp410_parse_timings(dvi, i2c); 312897dae56SLaurent Pinchart if (ret) 313*5cafa0f1SLaurent Pinchart return ret; 314897dae56SLaurent Pinchart 315*5cafa0f1SLaurent Pinchart /* Get the next bridge, connected to port@1. */ 316*5cafa0f1SLaurent Pinchart node = of_graph_get_remote_node(dev->of_node, 1, -1); 317*5cafa0f1SLaurent Pinchart if (!node) 318*5cafa0f1SLaurent Pinchart return -ENODEV; 319dc55ac3bSJyri Sarha 320*5cafa0f1SLaurent Pinchart dvi->next_bridge = of_drm_find_bridge(node); 321*5cafa0f1SLaurent Pinchart of_node_put(node); 322*5cafa0f1SLaurent Pinchart 323*5cafa0f1SLaurent Pinchart if (!dvi->next_bridge) 324*5cafa0f1SLaurent Pinchart return -EPROBE_DEFER; 325*5cafa0f1SLaurent Pinchart 326*5cafa0f1SLaurent Pinchart /* Get the powerdown GPIO. */ 32738c02db7SLaurent Pinchart dvi->powerdown = devm_gpiod_get_optional(dev, "powerdown", 32838c02db7SLaurent Pinchart GPIOD_OUT_HIGH); 32938c02db7SLaurent Pinchart if (IS_ERR(dvi->powerdown)) { 33038c02db7SLaurent Pinchart dev_err(dev, "failed to parse powerdown gpio\n"); 33138c02db7SLaurent Pinchart return PTR_ERR(dvi->powerdown); 33238c02db7SLaurent Pinchart } 33338c02db7SLaurent Pinchart 334*5cafa0f1SLaurent Pinchart /* Register the DRM bridge. */ 335f74c5275SInki Dae drm_bridge_add(&dvi->bridge); 336dc55ac3bSJyri Sarha 337dc55ac3bSJyri Sarha return 0; 338dc55ac3bSJyri Sarha } 339dc55ac3bSJyri Sarha 340dc55ac3bSJyri Sarha static int tfp410_fini(struct device *dev) 341dc55ac3bSJyri Sarha { 342dc55ac3bSJyri Sarha struct tfp410 *dvi = dev_get_drvdata(dev); 343dc55ac3bSJyri Sarha 344dc55ac3bSJyri Sarha drm_bridge_remove(&dvi->bridge); 345dc55ac3bSJyri Sarha 346dc55ac3bSJyri Sarha return 0; 347dc55ac3bSJyri Sarha } 348dc55ac3bSJyri Sarha 349dc55ac3bSJyri Sarha static int tfp410_probe(struct platform_device *pdev) 350dc55ac3bSJyri Sarha { 351897dae56SLaurent Pinchart return tfp410_init(&pdev->dev, false); 352dc55ac3bSJyri Sarha } 353dc55ac3bSJyri Sarha 354dc55ac3bSJyri Sarha static int tfp410_remove(struct platform_device *pdev) 355dc55ac3bSJyri Sarha { 356dc55ac3bSJyri Sarha return tfp410_fini(&pdev->dev); 357dc55ac3bSJyri Sarha } 358dc55ac3bSJyri Sarha 359dc55ac3bSJyri Sarha static const struct of_device_id tfp410_match[] = { 360dc55ac3bSJyri Sarha { .compatible = "ti,tfp410" }, 361dc55ac3bSJyri Sarha {}, 362dc55ac3bSJyri Sarha }; 363dc55ac3bSJyri Sarha MODULE_DEVICE_TABLE(of, tfp410_match); 364dc55ac3bSJyri Sarha 3655b47d089SWei Yongjun static struct platform_driver tfp410_platform_driver = { 366dc55ac3bSJyri Sarha .probe = tfp410_probe, 367dc55ac3bSJyri Sarha .remove = tfp410_remove, 368dc55ac3bSJyri Sarha .driver = { 369dc55ac3bSJyri Sarha .name = "tfp410-bridge", 370dc55ac3bSJyri Sarha .of_match_table = tfp410_match, 371dc55ac3bSJyri Sarha }, 372dc55ac3bSJyri Sarha }; 373dc55ac3bSJyri Sarha 374dc55ac3bSJyri Sarha #if IS_ENABLED(CONFIG_I2C) 375dc55ac3bSJyri Sarha /* There is currently no i2c functionality. */ 376dc55ac3bSJyri Sarha static int tfp410_i2c_probe(struct i2c_client *client, 377dc55ac3bSJyri Sarha const struct i2c_device_id *id) 378dc55ac3bSJyri Sarha { 379dc55ac3bSJyri Sarha int reg; 380dc55ac3bSJyri Sarha 381dc55ac3bSJyri Sarha if (!client->dev.of_node || 382dc55ac3bSJyri Sarha of_property_read_u32(client->dev.of_node, "reg", ®)) { 383dc55ac3bSJyri Sarha dev_err(&client->dev, 384dc55ac3bSJyri Sarha "Can't get i2c reg property from device-tree\n"); 385dc55ac3bSJyri Sarha return -ENXIO; 386dc55ac3bSJyri Sarha } 387dc55ac3bSJyri Sarha 388897dae56SLaurent Pinchart return tfp410_init(&client->dev, true); 389dc55ac3bSJyri Sarha } 390dc55ac3bSJyri Sarha 391dc55ac3bSJyri Sarha static int tfp410_i2c_remove(struct i2c_client *client) 392dc55ac3bSJyri Sarha { 393dc55ac3bSJyri Sarha return tfp410_fini(&client->dev); 394dc55ac3bSJyri Sarha } 395dc55ac3bSJyri Sarha 396dc55ac3bSJyri Sarha static const struct i2c_device_id tfp410_i2c_ids[] = { 397dc55ac3bSJyri Sarha { "tfp410", 0 }, 398dc55ac3bSJyri Sarha { } 399dc55ac3bSJyri Sarha }; 400dc55ac3bSJyri Sarha MODULE_DEVICE_TABLE(i2c, tfp410_i2c_ids); 401dc55ac3bSJyri Sarha 402dc55ac3bSJyri Sarha static struct i2c_driver tfp410_i2c_driver = { 403dc55ac3bSJyri Sarha .driver = { 404dc55ac3bSJyri Sarha .name = "tfp410", 405dc55ac3bSJyri Sarha .of_match_table = of_match_ptr(tfp410_match), 406dc55ac3bSJyri Sarha }, 407dc55ac3bSJyri Sarha .id_table = tfp410_i2c_ids, 408dc55ac3bSJyri Sarha .probe = tfp410_i2c_probe, 409dc55ac3bSJyri Sarha .remove = tfp410_i2c_remove, 410dc55ac3bSJyri Sarha }; 411dc55ac3bSJyri Sarha #endif /* IS_ENABLED(CONFIG_I2C) */ 412dc55ac3bSJyri Sarha 413dc55ac3bSJyri Sarha static struct { 414dc55ac3bSJyri Sarha uint i2c:1; 415dc55ac3bSJyri Sarha uint platform:1; 416dc55ac3bSJyri Sarha } tfp410_registered_driver; 417dc55ac3bSJyri Sarha 418dc55ac3bSJyri Sarha static int __init tfp410_module_init(void) 419dc55ac3bSJyri Sarha { 420dc55ac3bSJyri Sarha int ret; 421dc55ac3bSJyri Sarha 422dc55ac3bSJyri Sarha #if IS_ENABLED(CONFIG_I2C) 423dc55ac3bSJyri Sarha ret = i2c_add_driver(&tfp410_i2c_driver); 424dc55ac3bSJyri Sarha if (ret) 425dc55ac3bSJyri Sarha pr_err("%s: registering i2c driver failed: %d", 426dc55ac3bSJyri Sarha __func__, ret); 427dc55ac3bSJyri Sarha else 428dc55ac3bSJyri Sarha tfp410_registered_driver.i2c = 1; 429dc55ac3bSJyri Sarha #endif 430dc55ac3bSJyri Sarha 431dc55ac3bSJyri Sarha ret = platform_driver_register(&tfp410_platform_driver); 432dc55ac3bSJyri Sarha if (ret) 433dc55ac3bSJyri Sarha pr_err("%s: registering platform driver failed: %d", 434dc55ac3bSJyri Sarha __func__, ret); 435dc55ac3bSJyri Sarha else 436dc55ac3bSJyri Sarha tfp410_registered_driver.platform = 1; 437dc55ac3bSJyri Sarha 438dc55ac3bSJyri Sarha if (tfp410_registered_driver.i2c || 439dc55ac3bSJyri Sarha tfp410_registered_driver.platform) 440dc55ac3bSJyri Sarha return 0; 441dc55ac3bSJyri Sarha 442dc55ac3bSJyri Sarha return ret; 443dc55ac3bSJyri Sarha } 444dc55ac3bSJyri Sarha module_init(tfp410_module_init); 445dc55ac3bSJyri Sarha 446dc55ac3bSJyri Sarha static void __exit tfp410_module_exit(void) 447dc55ac3bSJyri Sarha { 448dc55ac3bSJyri Sarha #if IS_ENABLED(CONFIG_I2C) 449dc55ac3bSJyri Sarha if (tfp410_registered_driver.i2c) 450dc55ac3bSJyri Sarha i2c_del_driver(&tfp410_i2c_driver); 451dc55ac3bSJyri Sarha #endif 452dc55ac3bSJyri Sarha if (tfp410_registered_driver.platform) 453dc55ac3bSJyri Sarha platform_driver_unregister(&tfp410_platform_driver); 454dc55ac3bSJyri Sarha } 455dc55ac3bSJyri Sarha module_exit(tfp410_module_exit); 456dc55ac3bSJyri Sarha 457dc55ac3bSJyri Sarha MODULE_AUTHOR("Jyri Sarha <jsarha@ti.com>"); 458dc55ac3bSJyri Sarha MODULE_DESCRIPTION("TI TFP410 DVI bridge driver"); 459dc55ac3bSJyri Sarha MODULE_LICENSE("GPL"); 460