drm/sysfs: fix up memory leak problem

[firefly-linux-kernel-4.4.55.git] / drivers / gpu / drm / drm_sysfs.c

diff --git a/drivers/gpu/drm/drm_sysfs.c b/drivers/gpu/drm/drm_sysfs.c
index 615b7e667320184df169765862df055f36d7e0fd..3567aaf89995146643174305da4ba77f0c775d53 100644 (file)
--- a/drivers/gpu/drm/drm_sysfs.c
+++ b/drivers/gpu/drm/drm_sysfs.c
@@ -18,6 +18,7 @@
 #include <linux/err.h>
 #include <linux/export.h>
 
+#include <drm/drm_edid.h>
 #include <drm/drm_sysfs.h>
 #include <drm/drm_core.h>
 #include <drm/drmP.h>
@@ -32,6 +33,24 @@ static struct device_type drm_sysfs_device_minor = {
 
 struct class *drm_class;
 
+static const char * const audioformatstr[] = {
+       "",
+       "LPCM",         /*AUDIO_LPCM = 1,*/
+       "AC3",          /*AUDIO_AC3,*/
+       "MPEG1",        /*AUDIO_MPEG1,*/
+       "MP3",          /*AUDIO_MP3,*/
+       "MPEG2",        /*AUDIO_MPEG2,*/
+       "AAC-LC",       /*AUDIO_AAC_LC, AAC*/
+       "DTS",          /*AUDIO_DTS,*/
+       "ATARC",        /*AUDIO_ATARC,*/
+       "DSD",          /*AUDIO_DSD, One bit Audio */
+       "E-AC3",        /*AUDIO_E_AC3,*/
+       "DTS-HD",       /*AUDIO_DTS_HD,*/
+       "MLP",          /*AUDIO_MLP,*/
+       "DST",          /*AUDIO_DST,*/
+       "WMA-PRO",      /*AUDIO_WMA_PRO*/
+};
+
 /**
  * __drm_class_suspend - internal DRM class suspend routine
  * @dev: Linux device to suspend
@@ -248,6 +267,52 @@ static ssize_t enabled_show(struct device *device,
                        "disabled");
 }
 
+static int drm_get_audio_format(struct edid *edid,
+                              char *audioformat, int len)
+{
+       int i, size = 0, num = 0;
+       struct cea_sad *sads = NULL;
+
+       memset(audioformat, 0, len);
+       num = drm_edid_to_sad(edid, &sads);
+       if (num <= 0)
+               return 0;
+
+       for (i = 0; i < num; i++) {
+               if (sads[i].format < 1 || sads[i].format > 14) {
+                       DRM_ERROR("audio type unsupported.\n");
+                       continue;
+               }
+               size = strlen(audioformatstr[sads[i].format]);
+               memcpy(audioformat, audioformatstr[sads[i].format], size);
+               audioformat[size] = ',';
+               audioformat += (size + 1);
+       }
+       kfree(sads);
+
+       return num;
+}
+
+static ssize_t audioformat_show(struct device *device,
+                               struct device_attribute *attr,
+                               char *buf)
+{
+       char audioformat[200];
+       int ret = 0;
+       struct edid *edid;
+       struct drm_connector *connector = to_drm_connector(device);
+
+       if (!connector->edid_blob_ptr)
+               return 0;
+
+       edid = (struct edid *)connector->edid_blob_ptr->data;
+       ret = drm_get_audio_format(edid, audioformat, 200);
+       if (ret)
+               return snprintf(buf, PAGE_SIZE, "%s\n", audioformat);
+
+       return 0;
+}
+
 static ssize_t edid_show(struct file *filp, struct kobject *kobj,
                         struct bin_attribute *attr, char *buf, loff_t off,
                         size_t count)
@@ -284,13 +349,47 @@ static ssize_t modes_show(struct device *device,
        int written = 0;
 
        list_for_each_entry(mode, &connector->modes, head) {
-               written += snprintf(buf + written, PAGE_SIZE - written, "%s\n",
-                                   mode->name);
+               bool interlaced = !!(mode->flags & DRM_MODE_FLAG_INTERLACE);
+
+               written += snprintf(buf + written, PAGE_SIZE - written,
+                                   "%dx%d%s%d\n",
+                                   mode->hdisplay, mode->vdisplay,
+                                   interlaced ? "i" : "p",
+                                   drm_mode_vrefresh(mode));
        }
 
        return written;
 }
 
+static ssize_t mode_show(struct device *device,
+                          struct device_attribute *attr,
+                          char *buf)
+{
+       struct drm_connector *connector = to_drm_connector(device);
+       struct drm_display_mode *mode;
+       struct drm_crtc_state *crtc_state;
+       bool interlaced;
+       int written = 0;
+
+       if (!connector->state || !connector->state->crtc)
+               return written;
+
+       crtc_state = connector->state->crtc->state;
+       if (!crtc_state)
+               return written;
+
+       mode = &crtc_state->mode;
+
+       interlaced = !!(mode->flags & DRM_MODE_FLAG_INTERLACE);
+       written += snprintf(buf + written, PAGE_SIZE - written,
+                           "%dx%d%s%d\n",
+                           mode->hdisplay, mode->vdisplay,
+                           interlaced ? "i" : "p",
+                           drm_mode_vrefresh(mode));
+
+       return written;
+}
+
 static ssize_t tv_subconnector_show(struct device *device,
                                    struct device_attribute *attr,
                                    char *buf)
@@ -391,12 +490,16 @@ static DEVICE_ATTR_RW(status);
 static DEVICE_ATTR_RO(enabled);
 static DEVICE_ATTR_RO(dpms);
 static DEVICE_ATTR_RO(modes);
+static DEVICE_ATTR_RO(mode);
+static DEVICE_ATTR_RO(audioformat);
 
 static struct attribute *connector_dev_attrs[] = {
        &dev_attr_status.attr,
        &dev_attr_enabled.attr,
        &dev_attr_dpms.attr,
        &dev_attr_modes.attr,
+       &dev_attr_mode.attr,
+       &dev_attr_audioformat.attr,
        NULL
 };