drm/components: add generic vga encoder driver
From: Heiko Stuebner <heiko@...> Date: Tue, 24 Mar 2015 17:30:47 +0100
Commit-Message
This adds a driver for generic vga encoders like the Analog Devices adv7123 and similar ics. These chips do not have any special configuration options except a powersafe gpio. An exception is added for the rcar-du driver which also implements support for the adv7123 internally but is not yet converted to the component framework. Signed-off-by: Heiko Stuebner <heiko@...>
Patch-Comment
drivers/gpu/drm/components/Kconfig | 5 + drivers/gpu/drm/components/Makefile | 2 + drivers/gpu/drm/components/vga-encoder.c | 315 +++++++++++++++++++++++++++++++ 3 files changed, 322 insertions(+) create mode 100644 drivers/gpu/drm/components/vga-encoder.c
Statistics
- 322 lines added
- 0 lines removed
Changes
---------------------- drivers/gpu/drm/components/Kconfig ----------------------
index 9d5d462..647cea6 100644
@@ -1,4 +1,9 @@
menu "Standalone components for use with the component framework"
depends on DRM && DRM_KMS_HELPER
+config DRM_COMPONENTS_VGA_ENCODER
+ tristate "Generic vga encoder"
+ help
+ Support for generic vga encoder chips without any special controls.
+
endmenu
--------------------- drivers/gpu/drm/components/Makefile ----------------------
index be16eca..719b1c9 100644
@@ -1 +1,3 @@
ccflags-y := -Iinclude/drm
+
+obj-$(CONFIG_DRM_COMPONENTS_VGA_ENCODER) += vga-encoder.o
------------------- drivers/gpu/drm/components/vga-encoder.c -------------------
new file mode 100644
index 0000000..f559b5e
@@ -0,0 +1,315 @@
+/*
+ * Simple vga encoder driver
+ *
+ * Copyright (C) 2014 Heiko Stuebner <heiko@sntech.de>
+ *
+ * This software is licensed under the terms of the GNU General Public
+ * License version 2, as published by the Free Software Foundation, and
+ * may be copied, distributed, and modified under those terms.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
+ * GNU General Public License for more details.
+ */
+
+#include <linux/module.h>
+#include <linux/component.h>
+#include <linux/gpio.h>
+#include <linux/gpio/consumer.h>
+#include <linux/i2c.h>
+#include <linux/regulator/consumer.h>
+#include <linux/of_graph.h>
+#include <drm/drm_of.h>
+#include <drm/drmP.h>
+#include <drm/drm_crtc.h>
+#include <drm/drm_crtc_helper.h>
+#include <drm/drm_edid.h>
+
+#define encoder_to_vga_encoder(x) container_of(x, struct vga_encoder, encoder)
+
+struct vga_encoder {
+ struct drm_encoder encoder;
+ struct device *dev;
+ struct regulator *vaa_reg;
+ struct gpio_desc *psave_gpio;
+
+ struct mutex enable_lock;
+ bool enabled;
+};
+
+static void vga_encoder_destroy(struct drm_encoder *encoder)
+{
+ drm_encoder_cleanup(encoder);
+}
+
+static const struct drm_encoder_funcs vga_encoder_funcs = {
+ .destroy = vga_encoder_destroy,
+};
+
+static void vga_encoder_dpms(struct drm_encoder *encoder, int mode)
+{
+ struct vga_encoder *vga = encoder_to_vga_encoder(encoder);
+
+ mutex_lock(&vga->enable_lock);
+
+ switch (mode) {
+ case DRM_MODE_DPMS_ON:
+ if (vga->enabled)
+ goto out;
+
+ if (!IS_ERR(vga->vaa_reg))
+ regulator_enable(vga->vaa_reg);
+
+ if (vga->psave_gpio)
+ gpiod_set_value(vga->psave_gpio, 1);
+
+ vga->enabled = true;
+ break;
+ case DRM_MODE_DPMS_STANDBY:
+ case DRM_MODE_DPMS_SUSPEND:
+ case DRM_MODE_DPMS_OFF:
+ if (!vga->enabled)
+ goto out;
+
+ if (vga->psave_gpio)
+ gpiod_set_value(vga->psave_gpio, 0);
+
+ if (!IS_ERR(vga->vaa_reg))
+ regulator_enable(vga->vaa_reg);
+
+ vga->enabled = false;
+ break;
+ default:
+ break;
+ }
+
+out:
+ mutex_unlock(&vga->enable_lock);
+}
+
+static bool vga_encoder_mode_fixup(struct drm_encoder *encoder,
+ const struct drm_display_mode *mode,
+ struct drm_display_mode *adjusted_mode)
+{
+ return true;
+}
+
+static void vga_encoder_prepare(struct drm_encoder *encoder)
+{
+}
+
+static void vga_encoder_mode_set(struct drm_encoder *encoder,
+ struct drm_display_mode *mode,
+ struct drm_display_mode *adjusted_mode)
+{
+}
+
+static void vga_encoder_commit(struct drm_encoder *encoder)
+{
+ vga_encoder_dpms(encoder, DRM_MODE_DPMS_ON);
+}
+
+static void vga_encoder_disable(struct drm_encoder *encoder)
+{
+ vga_encoder_dpms(encoder, DRM_MODE_DPMS_OFF);
+}
+
+static const struct drm_encoder_helper_funcs vga_encoder_helper_funcs = {
+ .dpms = vga_encoder_dpms,
+ .mode_fixup = vga_encoder_mode_fixup,
+ .prepare = vga_encoder_prepare,
+ .mode_set = vga_encoder_mode_set,
+ .commit = vga_encoder_commit,
+ .disable = vga_encoder_disable,
+};
+
+/*
+ * Component helper functions
+ */
+
+static int vga_encoder_bind(struct device *dev, struct device *master,
+ void *data)
+{
+ struct vga_encoder *vga = dev_get_drvdata(dev);
+ struct device_node *np = vga->encoder.of_node;
+ struct drm_device *drm_dev = data;
+
+ vga->encoder.possible_crtcs = drm_of_find_possible_crtcs(drm_dev, np);
+
+ drm_encoder_helper_add(&vga->encoder, &vga_encoder_helper_funcs);
+ drm_encoder_init(drm_dev, &vga->encoder, &vga_encoder_funcs,
+ DRM_MODE_ENCODER_DAC);
+
+ return component_bind_all(dev, drm_dev);
+}
+
+static void vga_encoder_unbind(struct device *dev, struct device *master,
+ void *data)
+{
+ struct vga_encoder *vga = dev_get_drvdata(dev);
+ struct drm_device *drm_dev = data;
+
+ component_unbind_all(dev, drm_dev);
+ vga->encoder.funcs->destroy(&vga->encoder);
+}
+
+static const struct component_ops vga_encoder_ops = {
+ .bind = vga_encoder_bind,
+ .unbind = vga_encoder_unbind,
+};
+
+static int compare_of(struct device *dev, void *data)
+{
+ return dev->of_node == data;
+}
+
+static int vga_encoder_master_bind(struct device *dev)
+{
+ return 0;
+}
+
+static void vga_encoder_master_unbind(struct device *dev)
+{
+ /* do nothing */
+}
+
+static const struct component_master_ops vga_encoder_master_ops = {
+ .bind = vga_encoder_master_bind,
+ .unbind = vga_encoder_master_unbind,
+};
+
+static int vga_encoder_probe(struct platform_device *pdev)
+{
+ struct device_node *np = pdev->dev.of_node;
+ struct device_node *port, *connector_node;
+ struct device *dev = &pdev->dev;
+ struct component_match *match = NULL;
+ struct vga_encoder *vga;
+ int ret;
+
+ if (!np)
+ return -ENODEV;
+
+ vga = devm_kzalloc(dev, sizeof(*vga), GFP_KERNEL);
+ if (!vga)
+ return -ENOMEM;
+
+ vga->dev = dev;
+ dev_set_drvdata(dev, vga);
+ mutex_init(&vga->enable_lock);
+
+ vga->psave_gpio = devm_gpiod_get_optional(dev, "psave",
+ GPIOD_OUT_LOW);
+ if (IS_ERR(vga->psave_gpio)) {
+ ret = PTR_ERR(vga->psave_gpio);
+ dev_err(dev, "failed to request GPIO: %d\n", ret);
+ return ret;
+ }
+
+ vga->enabled = false;
+ vga->vaa_reg = devm_regulator_get_optional(dev, "vaa");
+ vga->encoder.of_node = np;
+
+ port = of_graph_get_port_by_id(dev->of_node, 1);
+ if (port) {
+ struct device_node *endpoint;
+
+ endpoint = of_get_child_by_name(port, "endpoint");
+ if (endpoint) {
+ connector_node = of_graph_get_remote_port_parent(endpoint);
+ of_node_put(endpoint);
+ }
+
+ of_node_put(port);
+ }
+
+ if (!of_drm_find_connector(connector_node))
+ return -EPROBE_DEFER;
+
+ component_match_add(dev, &match, compare_of, connector_node);
+
+ ret = drm_encoder_add(&vga->encoder);
+ if (ret < 0)
+ return ret;
+
+ ret = component_master_add_with_match(dev, &vga_encoder_master_ops, match);
+ if (ret < 0)
+ goto err_encoder_remove;
+
+ ret = component_add(dev, &vga_encoder_ops);
+ if (ret < 0)
+ goto err_master_remove;
+
+ return 0;
+
+err_master_remove:
+ component_master_del(&pdev->dev, &vga_encoder_master_ops);
+err_encoder_remove:
+ drm_encoder_remove(&vga->encoder);
+
+ return ret;
+}
+
+static int vga_encoder_remove(struct platform_device *pdev)
+{
+ struct vga_encoder *vga = dev_get_drvdata(&pdev->dev);
+
+ component_del(&pdev->dev, &vga_encoder_ops);
+ component_master_del(&pdev->dev, &vga_encoder_master_ops);
+ drm_encoder_remove(&vga->encoder);
+
+ return 0;
+}
+
+static const struct of_device_id vga_encoder_ids[] = {
+ { .compatible = "adi,adv7123", },
+ {},
+};
+MODULE_DEVICE_TABLE(of, vga_encoder_ids);
+
+static struct platform_driver vga_encoder_driver = {
+ .probe = vga_encoder_probe,
+ .remove = vga_encoder_remove,
+ .driver = {
+ .name = "vga-encoder",
+ .of_match_table = vga_encoder_ids,
+ },
+};
+
+static const struct of_device_id rcar_du_of_table[] = {
+ { .compatible = "renesas,du-r8a7779" },
+ { .compatible = "renesas,du-r8a7790" },
+ { .compatible = "renesas,du-r8a7791" },
+ { }
+};
+
+static int __init vga_encoder_init(void)
+{
+ struct device_node *np;
+
+ /*
+ * Play nice with rcar-du that is having its own implementation
+ * of the adv7123 binding implementation and is not yet
+ * converted to using components.
+ */
+ np = of_find_matching_node(NULL, rcar_du_of_table);
+ if (np) {
+ of_node_put(np);
+ return 0;
+ }
+
+ return platform_driver_register(&vga_encoder_driver);
+}
+
+static void __exit vga_encoder_exit(void)
+{
+ platform_driver_unregister(&vga_encoder_driver);
+}
+
+module_init(vga_encoder_init);
+module_exit(vga_encoder_exit);
+
+MODULE_AUTHOR("Heiko Stuebner <heiko@sntech.de>");
+MODULE_DESCRIPTION("Simple vga converter");
+MODULE_LICENSE("GPL");