1// SPDX-License-Identifier: GPL-2.0+
  2/*
  3 * Copyright (C) 2017 Free Electrons
  4 * Maxime Ripard <maxime.ripard@free-electrons.com>
  5 */
  6
  7#include <linux/clk.h>
  8
  9#include <drm/drm_atomic_helper.h>
 10#include <drm/drm_bridge.h>
 11#include <drm/drm_of.h>
 12#include <drm/drm_panel.h>
 13#include <drm/drm_print.h>
 14#include <drm/drm_probe_helper.h>
 15#include <drm/drm_simple_kms_helper.h>
 16
 17#include "sun4i_crtc.h"
 18#include "sun4i_tcon.h"
 19#include "sun4i_lvds.h"
 20
 21struct sun4i_lvds {
 22	struct drm_connector	connector;
 23	struct drm_encoder	encoder;
 24
 25	struct drm_panel	*panel;
 26};
 27
 28static inline struct sun4i_lvds *
 29drm_connector_to_sun4i_lvds(struct drm_connector *connector)
 30{
 31	return container_of(connector, struct sun4i_lvds,
 32			    connector);
 33}
 34
 35static inline struct sun4i_lvds *
 36drm_encoder_to_sun4i_lvds(struct drm_encoder *encoder)
 37{
 38	return container_of(encoder, struct sun4i_lvds,
 39			    encoder);
 40}
 41
 42static int sun4i_lvds_get_modes(struct drm_connector *connector)
 43{
 44	struct sun4i_lvds *lvds =
 45		drm_connector_to_sun4i_lvds(connector);
 46
 47	return drm_panel_get_modes(lvds->panel, connector);
 48}
 49
 50static const struct drm_connector_helper_funcs sun4i_lvds_con_helper_funcs = {
 51	.get_modes	= sun4i_lvds_get_modes,
 52};
 53
 54static void
 55sun4i_lvds_connector_destroy(struct drm_connector *connector)
 56{
 57	drm_connector_cleanup(connector);
 58}
 59
 60static const struct drm_connector_funcs sun4i_lvds_con_funcs = {
 61	.fill_modes		= drm_helper_probe_single_connector_modes,
 62	.destroy		= sun4i_lvds_connector_destroy,
 63	.reset			= drm_atomic_helper_connector_reset,
 64	.atomic_duplicate_state	= drm_atomic_helper_connector_duplicate_state,
 65	.atomic_destroy_state	= drm_atomic_helper_connector_destroy_state,
 66};
 67
 68static void sun4i_lvds_encoder_enable(struct drm_encoder *encoder)
 69{
 70	struct sun4i_lvds *lvds = drm_encoder_to_sun4i_lvds(encoder);
 71
 72	DRM_DEBUG_DRIVER("Enabling LVDS output\n");
 73
 74	if (lvds->panel) {
 75		drm_panel_prepare(lvds->panel);
 76		drm_panel_enable(lvds->panel);
 77	}
 78}
 79
 80static void sun4i_lvds_encoder_disable(struct drm_encoder *encoder)
 81{
 82	struct sun4i_lvds *lvds = drm_encoder_to_sun4i_lvds(encoder);
 83
 84	DRM_DEBUG_DRIVER("Disabling LVDS output\n");
 85
 86	if (lvds->panel) {
 87		drm_panel_disable(lvds->panel);
 88		drm_panel_unprepare(lvds->panel);
 89	}
 90}
 91
 92static const struct drm_encoder_helper_funcs sun4i_lvds_enc_helper_funcs = {
 93	.disable	= sun4i_lvds_encoder_disable,
 94	.enable		= sun4i_lvds_encoder_enable,
 95};
 96
 97int sun4i_lvds_init(struct drm_device *drm, struct sun4i_tcon *tcon)
 98{
 99	struct drm_encoder *encoder;
100	struct drm_bridge *bridge;
101	struct sun4i_lvds *lvds;
102	int ret;
103
104	lvds = devm_kzalloc(drm->dev, sizeof(*lvds), GFP_KERNEL);
105	if (!lvds)
106		return -ENOMEM;
107	encoder = &lvds->encoder;
108
109	ret = drm_of_find_panel_or_bridge(tcon->dev->of_node, 1, 0,
110					  &lvds->panel, &bridge);
111	if (ret) {
112		dev_info(drm->dev, "No panel or bridge found... LVDS output disabled\n");
113		return 0;
114	}
115
116	drm_encoder_helper_add(&lvds->encoder,
117			       &sun4i_lvds_enc_helper_funcs);
118	ret = drm_simple_encoder_init(drm, &lvds->encoder,
119				      DRM_MODE_ENCODER_LVDS);
120	if (ret) {
121		dev_err(drm->dev, "Couldn't initialise the lvds encoder\n");
122		goto err_out;
123	}
124
125	/* The LVDS encoder can only work with the TCON channel 0 */
126	lvds->encoder.possible_crtcs = drm_crtc_mask(&tcon->crtc->crtc);
127
128	if (lvds->panel) {
129		drm_connector_helper_add(&lvds->connector,
130					 &sun4i_lvds_con_helper_funcs);
131		ret = drm_connector_init(drm, &lvds->connector,
132					 &sun4i_lvds_con_funcs,
133					 DRM_MODE_CONNECTOR_LVDS);
134		if (ret) {
135			dev_err(drm->dev, "Couldn't initialise the lvds connector\n");
136			goto err_cleanup_connector;
137		}
138
139		drm_connector_attach_encoder(&lvds->connector,
140						  &lvds->encoder);
141	}
142
143	if (bridge) {
144		ret = drm_bridge_attach(encoder, bridge, NULL, 0);
145		if (ret)
146			goto err_cleanup_connector;
147	}
148
149	return 0;
150
151err_cleanup_connector:
152	drm_encoder_cleanup(&lvds->encoder);
153err_out:
154	return ret;
155}
156EXPORT_SYMBOL(sun4i_lvds_init);