[linux-2.6-block.git] / drivers / gpu / drm / tilcdc / tilcdc_external.c

/*
 * Copyright (C) 2015 Texas Instruments
 * Author: Jyri Sarha <jsarha@ti.com>
 *
 * This program is free software; you can redistribute it and/or modify it
 * under the terms of the GNU General Public License version 2 as published by
 * the Free Software Foundation.
 *
 */

#include <linux/component.h>
#include <linux/of_graph.h>
#include <drm/drm_of.h>

#include "tilcdc_drv.h"
#include "tilcdc_external.h"

static const struct tilcdc_panel_info panel_info_tda998x = {
		.ac_bias                = 255,
		.ac_bias_intrpt         = 0,
		.dma_burst_sz           = 16,
		.bpp                    = 16,
		.fdd                    = 0x80,
		.tft_alt_mode           = 0,
		.invert_pxl_clk		= 1,
		.sync_edge              = 1,
		.sync_ctrl              = 1,
		.raster_order           = 0,
};

static const struct tilcdc_panel_info panel_info_default = {
		.ac_bias                = 255,
		.ac_bias_intrpt         = 0,
		.dma_burst_sz           = 16,
		.bpp                    = 16,
		.fdd                    = 0x80,
		.tft_alt_mode           = 0,
		.sync_edge              = 0,
		.sync_ctrl              = 1,
		.raster_order           = 0,
};

static int tilcdc_external_mode_valid(struct drm_connector *connector,
				      struct drm_display_mode *mode)
{
	struct tilcdc_drm_private *priv = connector->dev->dev_private;
	int ret;

	ret = tilcdc_crtc_mode_valid(priv->crtc, mode);
	if (ret != MODE_OK)
		return ret;

	BUG_ON(priv->external_connector != connector);
	BUG_ON(!priv->connector_funcs);

	/* If the connector has its own mode_valid call it. */
	if (!IS_ERR(priv->connector_funcs) &&
	    priv->connector_funcs->mode_valid)
		return priv->connector_funcs->mode_valid(connector, mode);

	return MODE_OK;
}

static int tilcdc_add_external_connector(struct drm_device *dev,
					 struct drm_connector *connector)
{
	struct tilcdc_drm_private *priv = dev->dev_private;
	struct drm_connector_helper_funcs *connector_funcs;

	/* There should never be more than one connector */
	if (WARN_ON(priv->external_connector))
		return -EINVAL;

	priv->external_connector = connector;
	connector_funcs = devm_kzalloc(dev->dev, sizeof(*connector_funcs),
				       GFP_KERNEL);
	if (!connector_funcs)
		return -ENOMEM;

	/* connector->helper_private contains always struct
	 * connector_helper_funcs pointer. For tilcdc crtc to have a
	 * say if a specific mode is Ok, we need to install our own
	 * helper functions. In our helper functions we copy
	 * everything else but use our own mode_valid() (above).
	 */
	if (connector->helper_private) {
		priv->connector_funcs =	connector->helper_private;
		*connector_funcs = *priv->connector_funcs;
	} else {
		priv->connector_funcs = ERR_PTR(-ENOENT);
	}
	connector_funcs->mode_valid = tilcdc_external_mode_valid;
	drm_connector_helper_add(connector, connector_funcs);

	dev_dbg(dev->dev, "External connector '%s' connected\n",
		connector->name);

	return 0;
}

static
struct drm_connector *tilcdc_encoder_find_connector(struct drm_device *ddev,
						    struct drm_encoder *encoder)
{
	struct drm_connector *connector;
	int i;

	list_for_each_entry(connector, &ddev->mode_config.connector_list, head)
		for (i = 0; i < DRM_CONNECTOR_MAX_ENCODER; i++)
			if (connector->encoder_ids[i] == encoder->base.id)
				return connector;

	dev_err(ddev->dev, "No connector found for %s encoder (id %d)\n",
		encoder->name, encoder->base.id);

	return NULL;
}

int tilcdc_add_component_encoder(struct drm_device *ddev)
{
	struct tilcdc_drm_private *priv = ddev->dev_private;
	struct drm_connector *connector;
	struct drm_encoder *encoder;

	list_for_each_entry(encoder, &ddev->mode_config.encoder_list, head)
		if (encoder->possible_crtcs & (1 << priv->crtc->index))
			break;

	if (!encoder) {
		dev_err(ddev->dev, "%s: No suitable encoder found\n", __func__);
		return -ENODEV;
	}

	connector = tilcdc_encoder_find_connector(ddev, encoder);

	if (!connector)
		return -ENODEV;

	/* Only tda998x is supported at the moment. */
	tilcdc_crtc_set_simulate_vesa_sync(priv->crtc, true);
	tilcdc_crtc_set_panel_info(priv->crtc, &panel_info_tda998x);

	return tilcdc_add_external_connector(ddev, connector);
}

void tilcdc_remove_external_device(struct drm_device *dev)
{
	struct tilcdc_drm_private *priv = dev->dev_private;

	/* Restore the original helper functions, if any. */
	if (IS_ERR(priv->connector_funcs))
		drm_connector_helper_add(priv->external_connector, NULL);
	else if (priv->connector_funcs)
		drm_connector_helper_add(priv->external_connector,
					 priv->connector_funcs);
}

static const struct drm_encoder_funcs tilcdc_external_encoder_funcs = {
	.destroy	= drm_encoder_cleanup,
};

static
int tilcdc_attach_bridge(struct drm_device *ddev, struct drm_bridge *bridge)
{
	struct tilcdc_drm_private *priv = ddev->dev_private;
	struct drm_connector *connector;
	int ret;

	priv->external_encoder->possible_crtcs = BIT(0);

	ret = drm_bridge_attach(priv->external_encoder, bridge, NULL);
	if (ret) {
		dev_err(ddev->dev, "drm_bridge_attach() failed %d\n", ret);
		return ret;
	}

	tilcdc_crtc_set_panel_info(priv->crtc, &panel_info_default);

	connector = tilcdc_encoder_find_connector(ddev, priv->external_encoder);
	if (!connector)
		return -ENODEV;

	ret = tilcdc_add_external_connector(ddev, connector);

	return ret;
}

int tilcdc_attach_external_device(struct drm_device *ddev)
{
	struct tilcdc_drm_private *priv = ddev->dev_private;
	struct drm_bridge *bridge;
	struct drm_panel *panel;
	int ret;

	ret = drm_of_find_panel_or_bridge(ddev->dev->of_node, 0, 0,
					  &panel, &bridge);
	if (ret == -ENODEV)
		return 0;
	else if (ret)
		return ret;

	priv->external_encoder = devm_kzalloc(ddev->dev,
					      sizeof(*priv->external_encoder),
					      GFP_KERNEL);
	if (!priv->external_encoder)
		return -ENOMEM;

	ret = drm_encoder_init(ddev, priv->external_encoder,
			       &tilcdc_external_encoder_funcs,
			       DRM_MODE_ENCODER_NONE, NULL);
	if (ret) {
		dev_err(ddev->dev, "drm_encoder_init() failed %d\n", ret);
		return ret;
	}

	if (panel) {
		bridge = devm_drm_panel_bridge_add(ddev->dev, panel,
						   DRM_MODE_CONNECTOR_DPI);
		if (IS_ERR(bridge)) {
			ret = PTR_ERR(bridge);
			goto err_encoder_cleanup;
		}
	}

	ret = tilcdc_attach_bridge(ddev, bridge);
	if (ret)
		goto err_encoder_cleanup;

	return 0;

err_encoder_cleanup:
	drm_encoder_cleanup(priv->external_encoder);
	return ret;
}

static int dev_match_of(struct device *dev, void *data)
{
	return dev->of_node == data;
}

int tilcdc_get_external_components(struct device *dev,
				   struct component_match **match)
{
	struct device_node *node;

	node = of_graph_get_remote_node(dev->of_node, 0, 0);

	if (!of_device_is_compatible(node, "nxp,tda998x")) {
		of_node_put(node);
		return 0;
	}

	if (match)
		drm_of_component_match_add(dev, match, dev_match_of, node);
	of_node_put(node);
	return 1;
}
Commit	Line	Data
103cd8bc JS	1	/*
	2	* Copyright (C) 2015 Texas Instruments
	3	* Author: Jyri Sarha <jsarha@ti.com>
	4	*
	5	* This program is free software; you can redistribute it and/or modify it
	6	* under the terms of the GNU General Public License version 2 as published by
	7	* the Free Software Foundation.
	8	*
	9	*/
	10
	11	#include <linux/component.h>
	12	#include <linux/of_graph.h>
97ac0e47	13	#include <drm/drm_of.h>
103cd8bc JS	14
	15	#include "tilcdc_drv.h"
	16	#include "tilcdc_external.h"
	17
	18	static const struct tilcdc_panel_info panel_info_tda998x = {
	19	.ac_bias = 255,
	20	.ac_bias_intrpt = 0,
	21	.dma_burst_sz = 16,
	22	.bpp = 16,
	23	.fdd = 0x80,
	24	.tft_alt_mode = 0,
	25	.invert_pxl_clk = 1,
	26	.sync_edge = 1,
	27	.sync_ctrl = 1,
	28	.raster_order = 0,
	29	};
	30
ec9eab09 JS	31	static const struct tilcdc_panel_info panel_info_default = {
	32	.ac_bias = 255,
	33	.ac_bias_intrpt = 0,
	34	.dma_burst_sz = 16,
	35	.bpp = 16,
	36	.fdd = 0x80,
	37	.tft_alt_mode = 0,
	38	.sync_edge = 0,
	39	.sync_ctrl = 1,
	40	.raster_order = 0,
	41	};
	42
103cd8bc JS	43	static int tilcdc_external_mode_valid(struct drm_connector *connector,
	44	struct drm_display_mode *mode)
	45	{
	46	struct tilcdc_drm_private *priv = connector->dev->dev_private;
ec9eab09	47	int ret;
103cd8bc JS	48
	49	ret = tilcdc_crtc_mode_valid(priv->crtc, mode);
	50	if (ret != MODE_OK)
	51	return ret;
	52
ec9eab09 JS	53	BUG_ON(priv->external_connector != connector);
ec9eab09 JS	54	BUG_ON(!priv->connector_funcs);
103cd8bc JS	55
103cd8bc JS	56	/* If the connector has its own mode_valid call it. */
ec9eab09 JS	57	if (!IS_ERR(priv->connector_funcs) &&
	58	priv->connector_funcs->mode_valid)
	59	return priv->connector_funcs->mode_valid(connector, mode);
103cd8bc JS	60
	61	return MODE_OK;
	62	}
	63
ec9eab09 JS	64	static int tilcdc_add_external_connector(struct drm_device *dev,
ec9eab09 JS	65	struct drm_connector *connector)
103cd8bc JS	66	{
	67	struct tilcdc_drm_private *priv = dev->dev_private;
	68	struct drm_connector_helper_funcs *connector_funcs;
	69
ec9eab09 JS	70	/* There should never be more than one connector */
	71	if (WARN_ON(priv->external_connector))
	72	return -EINVAL;
103cd8bc	73
ec9eab09	74	priv->external_connector = connector;
103cd8bc JS	75	connector_funcs = devm_kzalloc(dev->dev, sizeof(*connector_funcs),
	76	GFP_KERNEL);
	77	if (!connector_funcs)
	78	return -ENOMEM;
	79
	80	/* connector->helper_private contains always struct
	81	* connector_helper_funcs pointer. For tilcdc crtc to have a
	82	* say if a specific mode is Ok, we need to install our own
	83	* helper functions. In our helper functions we copy
	84	* everything else but use our own mode_valid() (above).
	85	*/
	86	if (connector->helper_private) {
ec9eab09 JS	87	priv->connector_funcs = connector->helper_private;
ec9eab09 JS	88	connector_funcs = priv->connector_funcs;
103cd8bc	89	} else {
ec9eab09	90	priv->connector_funcs = ERR_PTR(-ENOENT);
103cd8bc JS	91	}
	92	connector_funcs->mode_valid = tilcdc_external_mode_valid;
	93	drm_connector_helper_add(connector, connector_funcs);
103cd8bc	94
ec9eab09 JS	95	dev_dbg(dev->dev, "External connector '%s' connected\n",
ec9eab09 JS	96	connector->name);
103cd8bc JS	97
	98	return 0;
	99	}
	100
ec9eab09 JS	101	static
	102	struct drm_connector tilcdc_encoder_find_connector(struct drm_device ddev,
	103	struct drm_encoder *encoder)
103cd8bc	104	{
103cd8bc	105	struct drm_connector *connector;
ec9eab09 JS	106	int i;
	107
	108	list_for_each_entry(connector, &ddev->mode_config.connector_list, head)
	109	for (i = 0; i < DRM_CONNECTOR_MAX_ENCODER; i++)
	110	if (connector->encoder_ids[i] == encoder->base.id)
	111	return connector;
	112
	113	dev_err(ddev->dev, "No connector found for %s encoder (id %d)\n",
	114	encoder->name, encoder->base.id);
	115
	116	return NULL;
	117	}
	118
	119	int tilcdc_add_component_encoder(struct drm_device *ddev)
	120	{
	121	struct tilcdc_drm_private *priv = ddev->dev_private;
	122	struct drm_connector *connector;
	123	struct drm_encoder *encoder;
	124
	125	list_for_each_entry(encoder, &ddev->mode_config.encoder_list, head)
	126	if (encoder->possible_crtcs & (1 << priv->crtc->index))
	127	break;
	128
	129	if (!encoder) {
	130	dev_err(ddev->dev, "%s: No suitable encoder found\n", __func__);
	131	return -ENODEV;
103cd8bc	132	}
ec9eab09 JS	133
	134	connector = tilcdc_encoder_find_connector(ddev, encoder);
	135
	136	if (!connector)
	137	return -ENODEV;
	138
	139	/* Only tda998x is supported at the moment. */
	140	tilcdc_crtc_set_simulate_vesa_sync(priv->crtc, true);
	141	tilcdc_crtc_set_panel_info(priv->crtc, &panel_info_tda998x);
	142
	143	return tilcdc_add_external_connector(ddev, connector);
103cd8bc JS	144	}
103cd8bc JS	145
ec9eab09	146	void tilcdc_remove_external_device(struct drm_device *dev)
103cd8bc JS	147	{
103cd8bc JS	148	struct tilcdc_drm_private *priv = dev->dev_private;
103cd8bc JS	149
103cd8bc JS	150	/* Restore the original helper functions, if any. */
ec9eab09 JS	151	if (IS_ERR(priv->connector_funcs))
	152	drm_connector_helper_add(priv->external_connector, NULL);
	153	else if (priv->connector_funcs)
	154	drm_connector_helper_add(priv->external_connector,
	155	priv->connector_funcs);
	156	}
	157
	158	static const struct drm_encoder_funcs tilcdc_external_encoder_funcs = {
	159	.destroy = drm_encoder_cleanup,
	160	};
	161
	162	static
	163	int tilcdc_attach_bridge(struct drm_device ddev, struct drm_bridge bridge)
	164	{
	165	struct tilcdc_drm_private *priv = ddev->dev_private;
	166	struct drm_connector *connector;
	167	int ret;
	168
	169	priv->external_encoder->possible_crtcs = BIT(0);
ec9eab09	170
3bb80f24	171	ret = drm_bridge_attach(priv->external_encoder, bridge, NULL);
ec9eab09 JS	172	if (ret) {
	173	dev_err(ddev->dev, "drm_bridge_attach() failed %d\n", ret);
	174	return ret;
	175	}
	176
	177	tilcdc_crtc_set_panel_info(priv->crtc, &panel_info_default);
	178
	179	connector = tilcdc_encoder_find_connector(ddev, priv->external_encoder);
	180	if (!connector)
	181	return -ENODEV;
	182
	183	ret = tilcdc_add_external_connector(ddev, connector);
	184
	185	return ret;
	186	}
	187
ec9eab09 JS	188	int tilcdc_attach_external_device(struct drm_device *ddev)
	189	{
	190	struct tilcdc_drm_private *priv = ddev->dev_private;
ec9eab09	191	struct drm_bridge *bridge;
544f7377	192	struct drm_panel *panel;
ec9eab09 JS	193	int ret;
ec9eab09 JS	194
544f7377 JS	195	ret = drm_of_find_panel_or_bridge(ddev->dev->of_node, 0, 0,
	196	&panel, &bridge);
	197	if (ret == -ENODEV)
ec9eab09	198	return 0;
544f7377 JS	199	else if (ret)
544f7377 JS	200	return ret;
ec9eab09 JS	201
	202	priv->external_encoder = devm_kzalloc(ddev->dev,
	203	sizeof(*priv->external_encoder),
	204	GFP_KERNEL);
	205	if (!priv->external_encoder)
	206	return -ENOMEM;
	207
	208	ret = drm_encoder_init(ddev, priv->external_encoder,
	209	&tilcdc_external_encoder_funcs,
	210	DRM_MODE_ENCODER_NONE, NULL);
	211	if (ret) {
	212	dev_err(ddev->dev, "drm_encoder_init() failed %d\n", ret);
	213	return ret;
	214	}
	215
544f7377 JS	216	if (panel) {
	217	bridge = devm_drm_panel_bridge_add(ddev->dev, panel,
	218	DRM_MODE_CONNECTOR_DPI);
	219	if (IS_ERR(bridge)) {
	220	ret = PTR_ERR(bridge);
	221	goto err_encoder_cleanup;
	222	}
	223	}
	224
ec9eab09 JS	225	ret = tilcdc_attach_bridge(ddev, bridge);
ec9eab09 JS	226	if (ret)
544f7377 JS	227	goto err_encoder_cleanup;
	228
	229	return 0;
ec9eab09	230
544f7377 JS	231	err_encoder_cleanup:
544f7377 JS	232	drm_encoder_cleanup(priv->external_encoder);
ec9eab09	233	return ret;
103cd8bc JS	234	}
	235
	236	static int dev_match_of(struct device dev, void data)
	237	{
	238	return dev->of_node == data;
	239	}
	240
	241	int tilcdc_get_external_components(struct device *dev,
	242	struct component_match **match)
	243	{
10a55a18	244	struct device_node *node;
103cd8bc	245
86418f90	246	node = of_graph_get_remote_node(dev->of_node, 0, 0);
ec9eab09	247
86418f90	248	if (!of_device_is_compatible(node, "nxp,tda998x")) {
ec9eab09	249	of_node_put(node);
86418f90	250	return 0;
103cd8bc JS	251	}
103cd8bc JS	252
86418f90 RH	253	if (match)
	254	drm_of_component_match_add(dev, match, dev_match_of, node);
	255	of_node_put(node);
	256	return 1;
103cd8bc	257	}