1 files changed, 182 insertions, 0 deletions

diff --git a/drivers/gpu/drm/drm_debugfs.c b/drivers/gpu/drm/drm_debugfs.c
index b4b51d46f339..13bd42923dd4 100644
--- a/drivers/gpu/drm/drm_debugfs.c
+++ b/drivers/gpu/drm/drm_debugfs.c
@@ -35,6 +35,7 @@
 #include <linux/slab.h>
 #include <linux/export.h>
 #include <drm/drmP.h>
+#include <drm/drm_edid.h>
 
 #if defined(CONFIG_DEBUG_FS)
 
@@ -237,5 +238,186 @@ int drm_debugfs_cleanup(struct drm_minor *minor)
         return 0;
 }
 
+static int connector_show(struct seq_file *m, void *data)
+{
+        struct drm_connector *connector = m->private;
+        const char *status;
+
+        switch (connector->force) {
+        case DRM_FORCE_ON:
+                status = "on\n";
+                break;
+
+        case DRM_FORCE_ON_DIGITAL:
+                status = "digital\n";
+                break;
+
+        case DRM_FORCE_OFF:
+                status = "off\n";
+                break;
+
+        case DRM_FORCE_UNSPECIFIED:
+                status = "unspecified\n";
+                break;
+
+        default:
+                return 0;
+        }
+
+        seq_puts(m, status);
+
+        return 0;
+}
+
+static int connector_open(struct inode *inode, struct file *file)
+{
+        struct drm_connector *dev = inode->i_private;
+
+        return single_open(file, connector_show, dev);
+}
+
+static ssize_t connector_write(struct file *file, const char __user *ubuf,
+                               size_t len, loff_t *offp)
+{
+        struct seq_file *m = file->private_data;
+        struct drm_connector *connector = m->private;
+        char buf[12];
+
+        if (len > sizeof(buf) - 1)
+                return -EINVAL;
+
+        if (copy_from_user(buf, ubuf, len))
+                return -EFAULT;
+
+        buf[len] = '\0';
+
+        if (!strcmp(buf, "on"))
+                connector->force = DRM_FORCE_ON;
+        else if (!strcmp(buf, "digital"))
+                connector->force = DRM_FORCE_ON_DIGITAL;
+        else if (!strcmp(buf, "off"))
+                connector->force = DRM_FORCE_OFF;
+        else if (!strcmp(buf, "unspecified"))
+                connector->force = DRM_FORCE_UNSPECIFIED;
+        else
+                return -EINVAL;
+
+        return len;
+}
+
+static int edid_show(struct seq_file *m, void *data)
+{
+        struct drm_connector *connector = m->private;
+        struct drm_property_blob *edid = connector->edid_blob_ptr;
+
+        if (connector->override_edid && edid)
+                seq_write(m, edid->data, edid->length);
+
+        return 0;
+}
+
+static int edid_open(struct inode *inode, struct file *file)
+{
+        struct drm_connector *dev = inode->i_private;
+
+        return single_open(file, edid_show, dev);
+}
+
+static ssize_t edid_write(struct file *file, const char __user *ubuf,
+                          size_t len, loff_t *offp)
+{
+        struct seq_file *m = file->private_data;
+        struct drm_connector *connector = m->private;
+        char *buf;
+        struct edid *edid;
+        int ret;
+
+        buf = memdup_user(ubuf, len);
+        if (IS_ERR(buf))
+                return PTR_ERR(buf);
+
+        edid = (struct edid *) buf;
+
+        if (len == 5 && !strncmp(buf, "reset", 5)) {
+                connector->override_edid = false;
+                ret = drm_mode_connector_update_edid_property(connector, NULL);
+        } else if (len < EDID_LENGTH ||
+                   EDID_LENGTH * (1 + edid->extensions) > len)
+                ret = -EINVAL;
+        else {
+                connector->override_edid = false;
+                ret = drm_mode_connector_update_edid_property(connector, edid);
+                if (!ret)
+                        connector->override_edid = true;
+        }
+
+        kfree(buf);
+
+        return (ret) ? ret : len;
+}
+
+static const struct file_operations drm_edid_fops = {
+        .owner = THIS_MODULE,
+        .open = edid_open,
+        .read = seq_read,
+        .llseek = seq_lseek,
+        .release = single_release,
+        .write = edid_write
+};
+
+
+static const struct file_operations drm_connector_fops = {
+        .owner = THIS_MODULE,
+        .open = connector_open,
+        .read = seq_read,
+        .llseek = seq_lseek,
+        .release = single_release,
+        .write = connector_write
+};
+
+int drm_debugfs_connector_add(struct drm_connector *connector)
+{
+        struct drm_minor *minor = connector->dev->primary;
+        struct dentry *root, *ent;
+
+        if (!minor->debugfs_root)
+                return -1;
+
+        root = debugfs_create_dir(connector->name, minor->debugfs_root);
+        if (!root)
+                return -ENOMEM;
+
+        connector->debugfs_entry = root;
+
+        /* force */
+        ent = debugfs_create_file("force", S_IRUGO | S_IWUSR, root, connector,
+                                  &drm_connector_fops);
+        if (!ent)
+                goto error;
+
+        /* edid */
+        ent = debugfs_create_file("edid_override", S_IRUGO | S_IWUSR, root,
+                                  connector, &drm_edid_fops);
+        if (!ent)
+                goto error;
+
+        return 0;
+
+error:
+        debugfs_remove_recursive(connector->debugfs_entry);
+        connector->debugfs_entry = NULL;
+        return -ENOMEM;
+}
+
+void drm_debugfs_connector_remove(struct drm_connector *connector)
+{
+        if (!connector->debugfs_entry)
+                return;
+
+        debugfs_remove_recursive(connector->debugfs_entry);
+
+        connector->debugfs_entry = NULL;
+}
+
 #endif /* CONFIG_DEBUG_FS */