tidss_encoder.c

  1// SPDX-License-Identifier: GPL-2.0
  2/*
  3 * Copyright (C) 2018 Texas Instruments Incorporated - https://www.ti.com/
  4 * Author: Tomi Valkeinen <tomi.valkeinen@ti.com>
  5 */
  6
  7#include <linux/export.h>
  8
  9#include <drm/drm_atomic_helper.h>
 10#include <drm/drm_bridge.h>
 11#include <drm/drm_bridge_connector.h>
 12#include <drm/drm_crtc.h>
 13#include <drm/drm_modeset_helper_vtables.h>
 14#include <drm/drm_panel.h>
 15#include <drm/drm_of.h>
 16#include <drm/drm_simple_kms_helper.h>
 17
 18#include "tidss_crtc.h"
 19#include "tidss_drv.h"
 20#include "tidss_encoder.h"
 21
 22struct tidss_encoder {
 23	struct drm_bridge bridge;
 24	struct drm_encoder encoder;
 25	struct drm_connector *connector;
 26	struct drm_bridge *next_bridge;
 27	struct tidss_device *tidss;
 28};
 29
 30static inline struct tidss_encoder
 31*bridge_to_tidss_encoder(struct drm_bridge *b)
 32{
 33	return container_of(b, struct tidss_encoder, bridge);
 34}
 35
 36static int tidss_bridge_attach(struct drm_bridge *bridge,
 37			       struct drm_encoder *encoder,
 38			       enum drm_bridge_attach_flags flags)
 39{
 40	struct tidss_encoder *t_enc = bridge_to_tidss_encoder(bridge);
 41
 42	return drm_bridge_attach(encoder, t_enc->next_bridge,
 43				 bridge, flags);
 44}
 45
 46static int tidss_bridge_atomic_check(struct drm_bridge *bridge,
 47				     struct drm_bridge_state *bridge_state,
 48				     struct drm_crtc_state *crtc_state,
 49				     struct drm_connector_state *conn_state)
 50{
 51	struct tidss_encoder *t_enc = bridge_to_tidss_encoder(bridge);
 52	struct tidss_device *tidss = t_enc->tidss;
 53	struct tidss_crtc_state *tcrtc_state = to_tidss_crtc_state(crtc_state);
 54	struct drm_display_info *di = &conn_state->connector->display_info;
 55	struct drm_bridge_state *next_bridge_state = NULL;
 56
 57	if (t_enc->next_bridge)
 58		next_bridge_state = drm_atomic_get_new_bridge_state(crtc_state->state,
 59								    t_enc->next_bridge);
 60
 61	if (next_bridge_state) {
 62		tcrtc_state->bus_flags = next_bridge_state->input_bus_cfg.flags;
 63		tcrtc_state->bus_format = next_bridge_state->input_bus_cfg.format;
 64	} else if (di->num_bus_formats) {
 65		tcrtc_state->bus_format = di->bus_formats[0];
 66		tcrtc_state->bus_flags = di->bus_flags;
 67	} else {
 68		dev_err(tidss->dev, "%s: No bus_formats in connected display\n",
 69			__func__);
 70		return -EINVAL;
 71	}
 72
 73	return 0;
 74}
 75
 76static const struct drm_bridge_funcs tidss_bridge_funcs = {
 77	.attach				= tidss_bridge_attach,
 78	.atomic_check			= tidss_bridge_atomic_check,
 79	.atomic_reset			= drm_atomic_helper_bridge_reset,
 80	.atomic_duplicate_state		= drm_atomic_helper_bridge_duplicate_state,
 81	.atomic_destroy_state		= drm_atomic_helper_bridge_destroy_state,
 82};
 83
 84int tidss_encoder_create(struct tidss_device *tidss,
 85			 struct drm_bridge *next_bridge,
 86			 u32 encoder_type, u32 possible_crtcs)
 87{
 88	struct tidss_encoder *t_enc;
 89	struct drm_encoder *enc;
 90	struct drm_connector *connector;
 91	int ret;
 92
 93	t_enc = devm_drm_bridge_alloc(tidss->dev, struct tidss_encoder,
 94				      bridge, &tidss_bridge_funcs);
 95	if (IS_ERR(t_enc))
 96		return PTR_ERR(t_enc);
 97
 98	ret = drm_simple_encoder_init(&tidss->ddev, &t_enc->encoder,
 99				      encoder_type);
100	if (ret)
101		return ret;
102
103	t_enc->tidss = tidss;
104	t_enc->next_bridge = next_bridge;
105
106	enc = &t_enc->encoder;
107	enc->possible_crtcs = possible_crtcs;
108
109	/* Attaching first bridge to the encoder */
110	ret = drm_bridge_attach(enc, &t_enc->bridge, NULL,
111				DRM_BRIDGE_ATTACH_NO_CONNECTOR);
112	if (ret) {
113		dev_err(tidss->dev, "bridge attach failed: %d\n", ret);
114		return ret;
115	}
116
117	/* Initializing the connector at the end of bridge-chain */
118	connector = drm_bridge_connector_init(&tidss->ddev, enc);
119	if (IS_ERR(connector)) {
120		dev_err(tidss->dev, "bridge_connector create failed\n");
121		return PTR_ERR(connector);
122	}
123
124	ret = drm_connector_attach_encoder(connector, enc);
125	if (ret) {
126		dev_err(tidss->dev, "attaching encoder to connector failed\n");
127		return ret;
128	}
129
130	t_enc->connector = connector;
131
132	dev_dbg(tidss->dev, "Encoder create done\n");
133
134	return ret;
135}