cachepc-linux

Fork of AMDESE/linux with modifications for CachePC side-channel attack
git clone https://git.sinitax.com/sinitax/cachepc-linux
Log | Files | Refs | README | LICENSE | sfeed.txt

sun4i_lvds.c (3899B)

      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);