/* * Copyright (C) 2012 Avionic Design GmbH * Copyright (C) 2012 NVIDIA CORPORATION. All rights reserved. * * 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 #include "drm.h" static int tegra_connector_get_modes(struct drm_connector *connector) { struct tegra_output *output = connector_to_output(connector); struct edid *edid = NULL; int err = 0; if (output->edid) edid = kmemdup(output->edid, sizeof(*edid), GFP_KERNEL); else if (output->ddc) edid = drm_get_edid(connector, output->ddc); drm_mode_connector_update_edid_property(connector, edid); if (edid) { err = drm_add_edid_modes(connector, edid); kfree(edid); } return err; } static int tegra_connector_mode_valid(struct drm_connector *connector, struct drm_display_mode *mode) { struct tegra_output *output = connector_to_output(connector); enum drm_mode_status status = MODE_OK; int err; err = tegra_output_check_mode(output, mode, &status); if (err < 0) return MODE_ERROR; return status; } static struct drm_encoder * tegra_connector_best_encoder(struct drm_connector *connector) { struct tegra_output *output = connector_to_output(connector); return &output->encoder; } static const struct drm_connector_helper_funcs connector_helper_funcs = { .get_modes = tegra_connector_get_modes, .mode_valid = tegra_connector_mode_valid, .best_encoder = tegra_connector_best_encoder, }; static enum drm_connector_status tegra_connector_detect(struct drm_connector *connector, bool force) { struct tegra_output *output = connector_to_output(connector); enum drm_connector_status status = connector_status_unknown; if (gpio_is_valid(output->hpd_gpio)) { if (gpio_get_value(output->hpd_gpio) == 0) status = connector_status_disconnected; else status = connector_status_connected; } else { if (connector->connector_type == DRM_MODE_CONNECTOR_LVDS) status = connector_status_connected; } return status; } static void tegra_connector_destroy(struct drm_connector *connector) { drm_sysfs_connector_remove(connector); drm_connector_cleanup(connector); } static const struct drm_connector_funcs connector_funcs = { .dpms = drm_helper_connector_dpms, .detect = tegra_connector_detect, .fill_modes = drm_helper_probe_single_connector_modes, .destroy = tegra_connector_destroy, }; static void tegra_encoder_destroy(struct drm_encoder *encoder) { drm_encoder_cleanup(encoder); } static const struct drm_encoder_funcs encoder_funcs = { .destroy = tegra_encoder_destroy, }; static void tegra_encoder_dpms(struct drm_encoder *encoder, int mode) { } static bool tegra_encoder_mode_fixup(struct drm_encoder *encoder, const struct drm_display_mode *mode, struct drm_display_mode *adjusted) { return true; } static void tegra_encoder_prepare(struct drm_encoder *encoder) { } static void tegra_encoder_commit(struct drm_encoder *encoder) { } static void tegra_encoder_mode_set(struct drm_encoder *encoder, struct drm_display_mode *mode, struct drm_display_mode *adjusted) { struct tegra_output *output = encoder_to_output(encoder); int err; err = tegra_output_enable(output); if (err < 0) dev_err(encoder->dev->dev, "tegra_output_enable(): %d\n", err); } static const struct drm_encoder_helper_funcs encoder_helper_funcs = { .dpms = tegra_encoder_dpms, .mode_fixup = tegra_encoder_mode_fixup, .prepare = tegra_encoder_prepare, .commit = tegra_encoder_commit, .mode_set = tegra_encoder_mode_set, }; static irqreturn_t hpd_irq(int irq, void *data) { struct tegra_output *output = data; drm_helper_hpd_irq_event(output->connector.dev); return IRQ_HANDLED; } int tegra_output_parse_dt(struct tegra_output *output) { enum of_gpio_flags flags; struct device_node *ddc; size_t size; int err; if (!output->of_node) output->of_node = output->dev->of_node; output->edid = of_get_property(output->of_node, "nvidia,edid", &size); ddc = of_parse_phandle(output->of_node, "nvidia,ddc-i2c-bus", 0); if (ddc) { output->ddc = of_find_i2c_adapter_by_node(ddc); if (!output->ddc) { err = -EPROBE_DEFER; of_node_put(ddc); return err; } of_node_put(ddc); } if (!output->edid && !output->ddc) return -ENODEV; output->hpd_gpio = of_get_named_gpio_flags(output->of_node, "nvidia,hpd-gpio", 0, &flags); return 0; } int tegra_output_init(struct drm_device *drm, struct tegra_output *output) { int connector, encoder, err; if (gpio_is_valid(output->hpd_gpio)) { unsigned long flags; err = gpio_request_one(output->hpd_gpio, GPIOF_DIR_IN, "HDMI hotplug detect"); if (err < 0) { dev_err(output->dev, "gpio_request_one(): %d\n", err); return err; } err = gpio_to_irq(output->hpd_gpio); if (err < 0) { dev_err(output->dev, "gpio_to_irq(): %d\n", err); goto free_hpd; } output->hpd_irq = err; flags = IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING | IRQF_ONESHOT; err = request_threaded_irq(output->hpd_irq, NULL, hpd_irq, flags, "hpd", output); if (err < 0) { dev_err(output->dev, "failed to request IRQ#%u: %d\n", output->hpd_irq, err); goto free_hpd; } output->connector.polled = DRM_CONNECTOR_POLL_HPD; } switch (output->type) { case TEGRA_OUTPUT_RGB: connector = DRM_MODE_CONNECTOR_LVDS; encoder = DRM_MODE_ENCODER_LVDS; break; case TEGRA_OUTPUT_HDMI: connector = DRM_MODE_CONNECTOR_HDMIA; encoder = DRM_MODE_ENCODER_TMDS; break; default: connector = DRM_MODE_CONNECTOR_Unknown; encoder = DRM_MODE_ENCODER_NONE; break; } drm_connector_init(drm, &output->connector, &connector_funcs, connector); drm_connector_helper_add(&output->connector, &connector_helper_funcs); drm_encoder_init(drm, &output->encoder, &encoder_funcs, encoder); drm_encoder_helper_add(&output->encoder, &encoder_helper_funcs); drm_mode_connector_attach_encoder(&output->connector, &output->encoder); drm_sysfs_connector_add(&output->connector); output->encoder.possible_crtcs = 0x3; return 0; free_hpd: gpio_free(output->hpd_gpio); return err; } int tegra_output_exit(struct tegra_output *output) { if (gpio_is_valid(output->hpd_gpio)) { free_irq(output->hpd_irq, output); gpio_free(output->hpd_gpio); } if (output->ddc) put_device(&output->ddc->dev); return 0; }