UPSTREAM: drm/edid: Extract SADs properly from multiple audio data blocks
[firefly-linux-kernel-4.4.55.git] / drivers / gpu / drm / drm_sysfs.c
1
2 /*
3  * drm_sysfs.c - Modifications to drm_sysfs_class.c to support
4  *               extra sysfs attribute from DRM. Normal drm_sysfs_class
5  *               does not allow adding attributes.
6  *
7  * Copyright (c) 2004 Jon Smirl <jonsmirl@gmail.com>
8  * Copyright (c) 2003-2004 Greg Kroah-Hartman <greg@kroah.com>
9  * Copyright (c) 2003-2004 IBM Corp.
10  *
11  * This file is released under the GPLv2
12  *
13  */
14
15 #include <linux/device.h>
16 #include <linux/kdev_t.h>
17 #include <linux/gfp.h>
18 #include <linux/err.h>
19 #include <linux/export.h>
20
21 #include <drm/drm_sysfs.h>
22 #include <drm/drm_core.h>
23 #include <drm/drmP.h>
24 #include "drm_internal.h"
25
26 #define to_drm_minor(d) dev_get_drvdata(d)
27 #define to_drm_connector(d) dev_get_drvdata(d)
28
29 static struct device_type drm_sysfs_device_minor = {
30         .name = "drm_minor"
31 };
32
33 struct class *drm_class;
34
35 /**
36  * __drm_class_suspend - internal DRM class suspend routine
37  * @dev: Linux device to suspend
38  * @state: power state to enter
39  *
40  * Just figures out what the actual struct drm_device associated with
41  * @dev is and calls its suspend hook, if present.
42  */
43 static int __drm_class_suspend(struct device *dev, pm_message_t state)
44 {
45         if (dev->type == &drm_sysfs_device_minor) {
46                 struct drm_minor *drm_minor = to_drm_minor(dev);
47                 struct drm_device *drm_dev = drm_minor->dev;
48
49                 if (drm_minor->type == DRM_MINOR_LEGACY &&
50                     !drm_core_check_feature(drm_dev, DRIVER_MODESET) &&
51                     drm_dev->driver->suspend)
52                         return drm_dev->driver->suspend(drm_dev, state);
53         }
54         return 0;
55 }
56
57 /**
58  * drm_class_suspend - internal DRM class suspend hook. Simply calls
59  * __drm_class_suspend() with the correct pm state.
60  * @dev: Linux device to suspend
61  */
62 static int drm_class_suspend(struct device *dev)
63 {
64         return __drm_class_suspend(dev, PMSG_SUSPEND);
65 }
66
67 /**
68  * drm_class_freeze - internal DRM class freeze hook. Simply calls
69  * __drm_class_suspend() with the correct pm state.
70  * @dev: Linux device to freeze
71  */
72 static int drm_class_freeze(struct device *dev)
73 {
74         return __drm_class_suspend(dev, PMSG_FREEZE);
75 }
76
77 /**
78  * drm_class_resume - DRM class resume hook
79  * @dev: Linux device to resume
80  *
81  * Just figures out what the actual struct drm_device associated with
82  * @dev is and calls its resume hook, if present.
83  */
84 static int drm_class_resume(struct device *dev)
85 {
86         if (dev->type == &drm_sysfs_device_minor) {
87                 struct drm_minor *drm_minor = to_drm_minor(dev);
88                 struct drm_device *drm_dev = drm_minor->dev;
89
90                 if (drm_minor->type == DRM_MINOR_LEGACY &&
91                     !drm_core_check_feature(drm_dev, DRIVER_MODESET) &&
92                     drm_dev->driver->resume)
93                         return drm_dev->driver->resume(drm_dev);
94         }
95         return 0;
96 }
97
98 static const struct dev_pm_ops drm_class_dev_pm_ops = {
99         .suspend        = drm_class_suspend,
100         .resume         = drm_class_resume,
101         .freeze         = drm_class_freeze,
102 };
103
104 static char *drm_devnode(struct device *dev, umode_t *mode)
105 {
106         return kasprintf(GFP_KERNEL, "dri/%s", dev_name(dev));
107 }
108
109 static CLASS_ATTR_STRING(version, S_IRUGO,
110                 CORE_NAME " "
111                 __stringify(CORE_MAJOR) "."
112                 __stringify(CORE_MINOR) "."
113                 __stringify(CORE_PATCHLEVEL) " "
114                 CORE_DATE);
115
116 /**
117  * drm_sysfs_init - initialize sysfs helpers
118  *
119  * This is used to create the DRM class, which is the implicit parent of any
120  * other top-level DRM sysfs objects.
121  *
122  * You must call drm_sysfs_destroy() to release the allocated resources.
123  *
124  * Return: 0 on success, negative error code on failure.
125  */
126 int drm_sysfs_init(void)
127 {
128         int err;
129
130         drm_class = class_create(THIS_MODULE, "drm");
131         if (IS_ERR(drm_class))
132                 return PTR_ERR(drm_class);
133
134         drm_class->pm = &drm_class_dev_pm_ops;
135
136         err = class_create_file(drm_class, &class_attr_version.attr);
137         if (err) {
138                 class_destroy(drm_class);
139                 drm_class = NULL;
140                 return err;
141         }
142
143         drm_class->devnode = drm_devnode;
144         return 0;
145 }
146
147 /**
148  * drm_sysfs_destroy - destroys DRM class
149  *
150  * Destroy the DRM device class.
151  */
152 void drm_sysfs_destroy(void)
153 {
154         if (IS_ERR_OR_NULL(drm_class))
155                 return;
156         class_remove_file(drm_class, &class_attr_version.attr);
157         class_destroy(drm_class);
158         drm_class = NULL;
159 }
160
161 /*
162  * Connector properties
163  */
164 static ssize_t status_store(struct device *device,
165                            struct device_attribute *attr,
166                            const char *buf, size_t count)
167 {
168         struct drm_connector *connector = to_drm_connector(device);
169         struct drm_device *dev = connector->dev;
170         enum drm_connector_status old_status;
171         int ret;
172
173         ret = mutex_lock_interruptible(&dev->mode_config.mutex);
174         if (ret)
175                 return ret;
176
177         old_status = connector->status;
178
179         if (sysfs_streq(buf, "detect")) {
180                 connector->force = 0;
181                 connector->status = connector->funcs->detect(connector, true);
182         } else if (sysfs_streq(buf, "on")) {
183                 connector->force = DRM_FORCE_ON;
184         } else if (sysfs_streq(buf, "on-digital")) {
185                 connector->force = DRM_FORCE_ON_DIGITAL;
186         } else if (sysfs_streq(buf, "off")) {
187                 connector->force = DRM_FORCE_OFF;
188         } else
189                 ret = -EINVAL;
190
191         if (ret == 0 && connector->force) {
192                 if (connector->force == DRM_FORCE_ON ||
193                     connector->force == DRM_FORCE_ON_DIGITAL)
194                         connector->status = connector_status_connected;
195                 else
196                         connector->status = connector_status_disconnected;
197                 if (connector->funcs->force)
198                         connector->funcs->force(connector);
199         }
200
201         if (old_status != connector->status) {
202                 DRM_DEBUG_KMS("[CONNECTOR:%d:%s] status updated from %d to %d\n",
203                               connector->base.id,
204                               connector->name,
205                               old_status, connector->status);
206
207                 dev->mode_config.delayed_event = true;
208                 if (dev->mode_config.poll_enabled)
209                         schedule_delayed_work(&dev->mode_config.output_poll_work,
210                                               0);
211         }
212
213         mutex_unlock(&dev->mode_config.mutex);
214
215         return ret ? ret : count;
216 }
217
218 static ssize_t status_show(struct device *device,
219                            struct device_attribute *attr,
220                            char *buf)
221 {
222         struct drm_connector *connector = to_drm_connector(device);
223
224         return snprintf(buf, PAGE_SIZE, "%s\n",
225                         drm_get_connector_status_name(connector->status));
226 }
227
228 static ssize_t dpms_show(struct device *device,
229                            struct device_attribute *attr,
230                            char *buf)
231 {
232         struct drm_connector *connector = to_drm_connector(device);
233         int dpms;
234
235         dpms = READ_ONCE(connector->dpms);
236
237         return snprintf(buf, PAGE_SIZE, "%s\n",
238                         drm_get_dpms_name(dpms));
239 }
240
241 static ssize_t enabled_show(struct device *device,
242                             struct device_attribute *attr,
243                            char *buf)
244 {
245         struct drm_connector *connector = to_drm_connector(device);
246
247         return snprintf(buf, PAGE_SIZE, "%s\n", connector->encoder ? "enabled" :
248                         "disabled");
249 }
250
251 static ssize_t edid_show(struct file *filp, struct kobject *kobj,
252                          struct bin_attribute *attr, char *buf, loff_t off,
253                          size_t count)
254 {
255         struct device *connector_dev = container_of(kobj, struct device, kobj);
256         struct drm_connector *connector = to_drm_connector(connector_dev);
257         unsigned char *edid;
258         size_t size;
259
260         if (!connector->edid_blob_ptr)
261                 return 0;
262
263         edid = connector->edid_blob_ptr->data;
264         size = connector->edid_blob_ptr->length;
265         if (!edid)
266                 return 0;
267
268         if (off >= size)
269                 return 0;
270
271         if (off + count > size)
272                 count = size - off;
273         memcpy(buf, edid + off, count);
274
275         return count;
276 }
277
278 static ssize_t modes_show(struct device *device,
279                            struct device_attribute *attr,
280                            char *buf)
281 {
282         struct drm_connector *connector = to_drm_connector(device);
283         struct drm_display_mode *mode;
284         int written = 0;
285
286         list_for_each_entry(mode, &connector->modes, head) {
287                 bool interlaced = !!(mode->flags & DRM_MODE_FLAG_INTERLACE);
288
289                 written += snprintf(buf + written, PAGE_SIZE - written,
290                                     "%dx%d%s%d\n",
291                                     mode->hdisplay, mode->vdisplay,
292                                     interlaced ? "i" : "p",
293                                     drm_mode_vrefresh(mode));
294         }
295
296         return written;
297 }
298
299 static ssize_t mode_show(struct device *device,
300                            struct device_attribute *attr,
301                            char *buf)
302 {
303         struct drm_connector *connector = to_drm_connector(device);
304         struct drm_display_mode *mode;
305         struct drm_crtc_state *crtc_state;
306         bool interlaced;
307         int written = 0;
308
309         if (!connector->state || !connector->state->crtc)
310                 return written;
311
312         crtc_state = connector->state->crtc->state;
313         if (!crtc_state)
314                 return written;
315
316         mode = &crtc_state->mode;
317
318         interlaced = !!(mode->flags & DRM_MODE_FLAG_INTERLACE);
319         written += snprintf(buf + written, PAGE_SIZE - written,
320                             "%dx%d%s%d\n",
321                             mode->hdisplay, mode->vdisplay,
322                             interlaced ? "i" : "p",
323                             drm_mode_vrefresh(mode));
324
325         return written;
326 }
327
328 static ssize_t tv_subconnector_show(struct device *device,
329                                     struct device_attribute *attr,
330                                     char *buf)
331 {
332         struct drm_connector *connector = to_drm_connector(device);
333         struct drm_device *dev = connector->dev;
334         struct drm_property *prop;
335         uint64_t subconnector;
336         int ret;
337
338         prop = dev->mode_config.tv_subconnector_property;
339         if (!prop) {
340                 DRM_ERROR("Unable to find subconnector property\n");
341                 return 0;
342         }
343
344         ret = drm_object_property_get_value(&connector->base, prop, &subconnector);
345         if (ret)
346                 return 0;
347
348         return snprintf(buf, PAGE_SIZE, "%s",
349                         drm_get_tv_subconnector_name((int)subconnector));
350 }
351
352 static ssize_t tv_select_subconnector_show(struct device *device,
353                                            struct device_attribute *attr,
354                                            char *buf)
355 {
356         struct drm_connector *connector = to_drm_connector(device);
357         struct drm_device *dev = connector->dev;
358         struct drm_property *prop;
359         uint64_t subconnector;
360         int ret;
361
362         prop = dev->mode_config.tv_select_subconnector_property;
363         if (!prop) {
364                 DRM_ERROR("Unable to find select subconnector property\n");
365                 return 0;
366         }
367
368         ret = drm_object_property_get_value(&connector->base, prop, &subconnector);
369         if (ret)
370                 return 0;
371
372         return snprintf(buf, PAGE_SIZE, "%s",
373                         drm_get_tv_select_name((int)subconnector));
374 }
375
376 static ssize_t dvii_subconnector_show(struct device *device,
377                                       struct device_attribute *attr,
378                                       char *buf)
379 {
380         struct drm_connector *connector = to_drm_connector(device);
381         struct drm_device *dev = connector->dev;
382         struct drm_property *prop;
383         uint64_t subconnector;
384         int ret;
385
386         prop = dev->mode_config.dvi_i_subconnector_property;
387         if (!prop) {
388                 DRM_ERROR("Unable to find subconnector property\n");
389                 return 0;
390         }
391
392         ret = drm_object_property_get_value(&connector->base, prop, &subconnector);
393         if (ret)
394                 return 0;
395
396         return snprintf(buf, PAGE_SIZE, "%s",
397                         drm_get_dvi_i_subconnector_name((int)subconnector));
398 }
399
400 static ssize_t dvii_select_subconnector_show(struct device *device,
401                                              struct device_attribute *attr,
402                                              char *buf)
403 {
404         struct drm_connector *connector = to_drm_connector(device);
405         struct drm_device *dev = connector->dev;
406         struct drm_property *prop;
407         uint64_t subconnector;
408         int ret;
409
410         prop = dev->mode_config.dvi_i_select_subconnector_property;
411         if (!prop) {
412                 DRM_ERROR("Unable to find select subconnector property\n");
413                 return 0;
414         }
415
416         ret = drm_object_property_get_value(&connector->base, prop, &subconnector);
417         if (ret)
418                 return 0;
419
420         return snprintf(buf, PAGE_SIZE, "%s",
421                         drm_get_dvi_i_select_name((int)subconnector));
422 }
423
424 static DEVICE_ATTR_RW(status);
425 static DEVICE_ATTR_RO(enabled);
426 static DEVICE_ATTR_RO(dpms);
427 static DEVICE_ATTR_RO(modes);
428 static DEVICE_ATTR_RO(mode);
429
430 static struct attribute *connector_dev_attrs[] = {
431         &dev_attr_status.attr,
432         &dev_attr_enabled.attr,
433         &dev_attr_dpms.attr,
434         &dev_attr_modes.attr,
435         &dev_attr_mode.attr,
436         NULL
437 };
438
439 static DEVICE_ATTR_RO(tv_subconnector);
440 static DEVICE_ATTR_RO(tv_select_subconnector);
441
442 static struct attribute *connector_tv_dev_attrs[] = {
443         &dev_attr_tv_subconnector.attr,
444         &dev_attr_tv_select_subconnector.attr,
445         NULL
446 };
447
448 static DEVICE_ATTR_RO(dvii_subconnector);
449 static DEVICE_ATTR_RO(dvii_select_subconnector);
450
451 static struct attribute *connector_dvii_dev_attrs[] = {
452         &dev_attr_dvii_subconnector.attr,
453         &dev_attr_dvii_select_subconnector.attr,
454         NULL
455 };
456
457 /* Connector type related helpers */
458 static int kobj_connector_type(struct kobject *kobj)
459 {
460         struct device *dev = kobj_to_dev(kobj);
461         struct drm_connector *connector = to_drm_connector(dev);
462
463         return connector->connector_type;
464 }
465
466 static umode_t connector_is_dvii(struct kobject *kobj,
467                                  struct attribute *attr, int idx)
468 {
469         return kobj_connector_type(kobj) == DRM_MODE_CONNECTOR_DVII ?
470                 attr->mode : 0;
471 }
472
473 static umode_t connector_is_tv(struct kobject *kobj,
474                                struct attribute *attr, int idx)
475 {
476         switch (kobj_connector_type(kobj)) {
477         case DRM_MODE_CONNECTOR_Composite:
478         case DRM_MODE_CONNECTOR_SVIDEO:
479         case DRM_MODE_CONNECTOR_Component:
480         case DRM_MODE_CONNECTOR_TV:
481                 return attr->mode;
482         }
483
484         return 0;
485 }
486
487 static struct bin_attribute edid_attr = {
488         .attr.name = "edid",
489         .attr.mode = 0444,
490         .size = 0,
491         .read = edid_show,
492 };
493
494 static struct bin_attribute *connector_bin_attrs[] = {
495         &edid_attr,
496         NULL
497 };
498
499 static const struct attribute_group connector_dev_group = {
500         .attrs = connector_dev_attrs,
501         .bin_attrs = connector_bin_attrs,
502 };
503
504 static const struct attribute_group connector_tv_dev_group = {
505         .attrs = connector_tv_dev_attrs,
506         .is_visible = connector_is_tv,
507 };
508
509 static const struct attribute_group connector_dvii_dev_group = {
510         .attrs = connector_dvii_dev_attrs,
511         .is_visible = connector_is_dvii,
512 };
513
514 static const struct attribute_group *connector_dev_groups[] = {
515         &connector_dev_group,
516         &connector_tv_dev_group,
517         &connector_dvii_dev_group,
518         NULL
519 };
520
521 /**
522  * drm_sysfs_connector_add - add a connector to sysfs
523  * @connector: connector to add
524  *
525  * Create a connector device in sysfs, along with its associated connector
526  * properties (so far, connection status, dpms, mode list & edid) and
527  * generate a hotplug event so userspace knows there's a new connector
528  * available.
529  */
530 int drm_sysfs_connector_add(struct drm_connector *connector)
531 {
532         struct drm_device *dev = connector->dev;
533
534         if (connector->kdev)
535                 return 0;
536
537         connector->kdev =
538                 device_create_with_groups(drm_class, dev->primary->kdev, 0,
539                                           connector, connector_dev_groups,
540                                           "card%d-%s", dev->primary->index,
541                                           connector->name);
542         DRM_DEBUG("adding \"%s\" to sysfs\n",
543                   connector->name);
544
545         if (IS_ERR(connector->kdev)) {
546                 DRM_ERROR("failed to register connector device: %ld\n", PTR_ERR(connector->kdev));
547                 return PTR_ERR(connector->kdev);
548         }
549
550         /* Let userspace know we have a new connector */
551         drm_sysfs_hotplug_event(dev);
552
553         return 0;
554 }
555
556 /**
557  * drm_sysfs_connector_remove - remove an connector device from sysfs
558  * @connector: connector to remove
559  *
560  * Remove @connector and its associated attributes from sysfs.  Note that
561  * the device model core will take care of sending the "remove" uevent
562  * at this time, so we don't need to do it.
563  *
564  * Note:
565  * This routine should only be called if the connector was previously
566  * successfully registered.  If @connector hasn't been registered yet,
567  * you'll likely see a panic somewhere deep in sysfs code when called.
568  */
569 void drm_sysfs_connector_remove(struct drm_connector *connector)
570 {
571         if (!connector->kdev)
572                 return;
573         DRM_DEBUG("removing \"%s\" from sysfs\n",
574                   connector->name);
575
576         device_unregister(connector->kdev);
577         connector->kdev = NULL;
578 }
579
580 /**
581  * drm_sysfs_hotplug_event - generate a DRM uevent
582  * @dev: DRM device
583  *
584  * Send a uevent for the DRM device specified by @dev.  Currently we only
585  * set HOTPLUG=1 in the uevent environment, but this could be expanded to
586  * deal with other types of events.
587  */
588 void drm_sysfs_hotplug_event(struct drm_device *dev)
589 {
590         char *event_string = "HOTPLUG=1";
591         char *envp[] = { event_string, NULL };
592
593         DRM_DEBUG("generating hotplug event\n");
594
595         kobject_uevent_env(&dev->primary->kdev->kobj, KOBJ_CHANGE, envp);
596 }
597 EXPORT_SYMBOL(drm_sysfs_hotplug_event);
598
599 static void drm_sysfs_release(struct device *dev)
600 {
601         kfree(dev);
602 }
603
604 /**
605  * drm_sysfs_minor_alloc() - Allocate sysfs device for given minor
606  * @minor: minor to allocate sysfs device for
607  *
608  * This allocates a new sysfs device for @minor and returns it. The device is
609  * not registered nor linked. The caller has to use device_add() and
610  * device_del() to register and unregister it.
611  *
612  * Note that dev_get_drvdata() on the new device will return the minor.
613  * However, the device does not hold a ref-count to the minor nor to the
614  * underlying drm_device. This is unproblematic as long as you access the
615  * private data only in sysfs callbacks. device_del() disables those
616  * synchronously, so they cannot be called after you cleanup a minor.
617  */
618 struct device *drm_sysfs_minor_alloc(struct drm_minor *minor)
619 {
620         const char *minor_str;
621         struct device *kdev;
622         int r;
623
624         if (minor->type == DRM_MINOR_CONTROL)
625                 minor_str = "controlD%d";
626         else if (minor->type == DRM_MINOR_RENDER)
627                 minor_str = "renderD%d";
628         else
629                 minor_str = "card%d";
630
631         kdev = kzalloc(sizeof(*kdev), GFP_KERNEL);
632         if (!kdev)
633                 return ERR_PTR(-ENOMEM);
634
635         device_initialize(kdev);
636         kdev->devt = MKDEV(DRM_MAJOR, minor->index);
637         kdev->class = drm_class;
638         kdev->type = &drm_sysfs_device_minor;
639         kdev->parent = minor->dev->dev;
640         kdev->release = drm_sysfs_release;
641         dev_set_drvdata(kdev, minor);
642
643         r = dev_set_name(kdev, minor_str, minor->index);
644         if (r < 0)
645                 goto err_free;
646
647         return kdev;
648
649 err_free:
650         put_device(kdev);
651         return ERR_PTR(r);
652 }
653
654 /**
655  * drm_class_device_register - Register a struct device in the drm class.
656  *
657  * @dev: pointer to struct device to register.
658  *
659  * @dev should have all relevant members pre-filled with the exception
660  * of the class member. In particular, the device_type member must
661  * be set.
662  */
663
664 int drm_class_device_register(struct device *dev)
665 {
666         if (!drm_class || IS_ERR(drm_class))
667                 return -ENOENT;
668
669         dev->class = drm_class;
670         return device_register(dev);
671 }
672 EXPORT_SYMBOL_GPL(drm_class_device_register);
673
674 void drm_class_device_unregister(struct device *dev)
675 {
676         return device_unregister(dev);
677 }
678 EXPORT_SYMBOL_GPL(drm_class_device_unregister);