src/tdm_vc4.c

   1 #ifdef HAVE_CONFIG_H
   2 #include "config.h"
   3 #endif
   4
   5 #if HAVE_UDEV
   6 #include <libudev.h>
   7 #endif
   8
   9 #include "tdm_vc4.h"
  10 #include <tdm_helper.h>
  11 #include <tbm_drm_helper.h>
  12
  13 #define TDM_DRM_NAME "vc4-drm"
  14
  15 static tdm_vc4_data *vc4_data;
  16
  17 #ifdef HAVE_UDEV
  18 static struct udev_device *
  19 _tdm_find_primary_gpu(void)
  20 {
  21         struct udev *udev;
  22         struct udev_enumerate *e;
  23         struct udev_list_entry *entry;
  24         const char *path, *id;
  25         struct udev_device *device, *drm_device, *pci;
  26
  27         udev = udev_new();
  28         if (!udev) {
  29                 TDM_ERR("fail to initialize udev context\n");
  30                 return NULL;
  31         }
  32
  33         e = udev_enumerate_new(udev);
  34         udev_enumerate_add_match_subsystem(e, "drm");
  35         udev_enumerate_add_match_sysname(e, "card[0-9]*");
  36
  37         udev_enumerate_scan_devices(e);
  38         drm_device = NULL;
  39         udev_list_entry_foreach(entry, udev_enumerate_get_list_entry(e)) {
  40                 path = udev_list_entry_get_name(entry);
  41                 device = udev_device_new_from_syspath(udev, path);
  42                 if (!device)
  43                         continue;
  44
  45                 pci = udev_device_get_parent_with_subsystem_devtype(device, "pci", NULL);
  46                 if (pci) {
  47                         id = udev_device_get_sysattr_value(pci, "boot_vga");
  48                         if (id && !strcmp(id, "1")) {
  49                                 if (drm_device)
  50                                         udev_device_unref(drm_device);
  51                                 drm_device = device;
  52                                 break;
  53                         }
  54                 }
  55
  56                 if (!drm_device)
  57                         drm_device = device;
  58                 else
  59                         udev_device_unref(device);
  60         }
  61
  62         udev_enumerate_unref(e);
  63         return drm_device;
  64 }
  65
  66 static tdm_error
  67 _tdm_vc4_udev_fd_handler(int fd, tdm_event_loop_mask mask, void *user_data)
  68 {
  69         tdm_vc4_data *edata = (tdm_vc4_data*)user_data;
  70         struct udev_device *dev;
  71         const char *hotplug;
  72         struct stat s;
  73         dev_t udev_devnum;
  74         int ret;
  75
  76         dev = udev_monitor_receive_device(edata->uevent_monitor);
  77         if (!dev) {
  78                 TDM_ERR("couldn't receive device");
  79                 return TDM_ERROR_OPERATION_FAILED;
  80         }
  81
  82         udev_devnum = udev_device_get_devnum(dev);
  83
  84         ret = fstat(edata->drm_fd, &s);
  85         if (ret == -1) {
  86                 TDM_ERR("fstat failed");
  87                 return TDM_ERROR_OPERATION_FAILED;
  88         }
  89
  90         hotplug = udev_device_get_property_value(dev, "HOTPLUG");
  91
  92         if (memcmp(&s.st_rdev, &udev_devnum, sizeof(dev_t)) == 0 &&
  93                         hotplug && atoi(hotplug) == 1) {
  94                 TDM_INFO("HotPlug");
  95                 tdm_vc4_display_update_output_status(edata);
  96         }
  97
  98         udev_device_unref(dev);
  99
 100         return TDM_ERROR_NONE;
 101 }
 102
 103 static void
 104 _tdm_vc4_udev_init(tdm_vc4_data *edata)
 105 {
 106         struct udev *u = NULL;
 107         struct udev_monitor *mon = NULL;
 108
 109         u = udev_new();
 110         if (!u) {
 111                 TDM_ERR("couldn't create udev");
 112                 goto failed;
 113         }
 114
 115         mon = udev_monitor_new_from_netlink(u, "udev");
 116         if (!mon) {
 117                 TDM_ERR("couldn't create udev monitor");
 118                 goto failed;
 119         }
 120
 121         if (udev_monitor_filter_add_match_subsystem_devtype(mon, "drm", "drm_minor") > 0 ||
 122                 udev_monitor_enable_receiving(mon) < 0) {
 123                 TDM_ERR("add match subsystem failed");
 124                 goto failed;
 125         }
 126
 127         edata->uevent_source =
 128                 tdm_event_loop_add_fd_handler(edata->dpy, udev_monitor_get_fd(mon),
 129                                                                           TDM_EVENT_LOOP_READABLE,
 130                                                                           _tdm_vc4_udev_fd_handler,
 131                                                                           edata, NULL);
 132         if (!edata->uevent_source) {
 133                 TDM_ERR("couldn't create udev event source");
 134                 goto failed;
 135         }
 136
 137         edata->uevent_monitor = mon;
 138
 139         TDM_INFO("hotplug monitor created");
 140
 141         return;
 142 failed:
 143         if (mon)
 144                 udev_monitor_unref(mon);
 145         if (u)
 146                 udev_unref(u);
 147 }
 148
 149 static void
 150 _tdm_vc4_udev_deinit(tdm_vc4_data *edata)
 151 {
 152         if (edata->uevent_source) {
 153                 tdm_event_loop_source_remove(edata->uevent_source);
 154                 edata->uevent_source = NULL;
 155         }
 156
 157         if (edata->uevent_monitor) {
 158                 struct udev *u = udev_monitor_get_udev(edata->uevent_monitor);
 159                 udev_monitor_unref(edata->uevent_monitor);
 160                 udev_unref(u);
 161                 edata->uevent_monitor = NULL;
 162                 TDM_INFO("hotplug monitor destroyed");
 163         }
 164 }
 165 #endif
 166
 167 static int
 168 _tdm_vc4_open_drm(void)
 169 {
 170         int fd = -1;
 171
 172         fd = drmOpen(TDM_DRM_NAME, NULL);
 173         if (fd < 0)
 174                 TDM_WRN("Cannot open '%s' drm", TDM_DRM_NAME);
 175
 176 #ifdef HAVE_UDEV
 177         if (fd < 0) {
 178                 struct udev_device *drm_device = NULL;
 179                 const char *filename;
 180                 TDM_WRN("Cannot open drm device.. search by udev");
 181
 182                 drm_device = _tdm_find_primary_gpu();
 183                 if (drm_device == NULL) {
 184                         TDM_ERR("fail to find drm device\n");
 185                         goto close_l;
 186                 }
 187
 188                 filename = udev_device_get_devnode(drm_device);
 189
 190                 fd = open(filename, O_RDWR | O_CLOEXEC);
 191                 if (fd < 0)
 192                         TDM_ERR("Cannot open drm device(%s)\n", filename);
 193
 194                 TDM_DBG("open drm device (name:%s, fd:%d)", filename, fd);
 195
 196                 udev_device_unref(drm_device);
 197         }
 198 close_l:
 199 #endif
 200         return fd;
 201 }
 202
 203 void
 204 tdm_vc4_deinit(tdm_backend_data *bdata)
 205 {
 206         if (vc4_data != bdata)
 207                 return;
 208
 209         TDM_INFO("deinit");
 210
 211 #ifdef HAVE_UDEV
 212         _tdm_vc4_udev_deinit(vc4_data);
 213 #endif
 214
 215         tdm_vc4_display_destroy_output_list(vc4_data);
 216
 217         if (vc4_data->plane_res)
 218                 drmModeFreePlaneResources(vc4_data->plane_res);
 219         if (vc4_data->mode_res)
 220                 drmModeFreeResources(vc4_data->mode_res);
 221         if (vc4_data->drm_fd >= 0)
 222                 close(vc4_data->drm_fd);
 223
 224         free(vc4_data);
 225         vc4_data = NULL;
 226 }
 227
 228 tdm_backend_data *
 229 tdm_vc4_init(tdm_display *dpy, tdm_error *error)
 230 {
 231         tdm_func_display vc4_func_display;
 232         tdm_func_output vc4_func_output;
 233         tdm_func_layer vc4_func_layer;
 234         tdm_error ret;
 235
 236         if (!dpy) {
 237                 TDM_ERR("display is null");
 238                 if (error)
 239                         *error = TDM_ERROR_INVALID_PARAMETER;
 240                 return NULL;
 241         }
 242
 243         if (vc4_data) {
 244                 TDM_ERR("failed: init twice");
 245                 if (error)
 246                         *error = TDM_ERROR_BAD_REQUEST;
 247                 return NULL;
 248         }
 249
 250         vc4_data = calloc(1, sizeof(tdm_vc4_data));
 251         if (!vc4_data) {
 252                 TDM_ERR("alloc failed");
 253                 if (error)
 254                         *error = TDM_ERROR_OUT_OF_MEMORY;
 255                 return NULL;
 256         }
 257
 258         LIST_INITHEAD(&vc4_data->output_list);
 259         LIST_INITHEAD(&vc4_data->buffer_list);
 260
 261         memset(&vc4_func_display, 0, sizeof(vc4_func_display));
 262         vc4_func_display.display_get_capability = vc4_display_get_capability;
 263         vc4_func_display.display_get_outputs = vc4_display_get_outputs;
 264         vc4_func_display.display_get_fd = vc4_display_get_fd;
 265         vc4_func_display.display_handle_events = vc4_display_handle_events;
 266
 267         memset(&vc4_func_output, 0, sizeof(vc4_func_output));
 268         vc4_func_output.output_get_capability = vc4_output_get_capability;
 269         vc4_func_output.output_get_layers = vc4_output_get_layers;
 270         vc4_func_output.output_set_property = vc4_output_set_property;
 271         vc4_func_output.output_get_property = vc4_output_get_property;
 272         vc4_func_output.output_wait_vblank = vc4_output_wait_vblank;
 273         vc4_func_output.output_set_vblank_handler = vc4_output_set_vblank_handler;
 274         vc4_func_output.output_commit = vc4_output_commit;
 275         vc4_func_output.output_set_commit_handler = vc4_output_set_commit_handler;
 276         vc4_func_output.output_set_dpms = vc4_output_set_dpms;
 277         vc4_func_output.output_get_dpms = vc4_output_get_dpms;
 278         vc4_func_output.output_set_mode = vc4_output_set_mode;
 279         vc4_func_output.output_get_mode = vc4_output_get_mode;
 280 #ifdef HAVE_UDEV
 281         vc4_func_output.output_set_status_handler = vc4_output_set_status_handler;
 282 #endif
 283
 284         memset(&vc4_func_layer, 0, sizeof(vc4_func_layer));
 285         vc4_func_layer.layer_get_capability = vc4_layer_get_capability;
 286         vc4_func_layer.layer_set_property = vc4_layer_set_property;
 287         vc4_func_layer.layer_get_property = vc4_layer_get_property;
 288         vc4_func_layer.layer_set_info = vc4_layer_set_info;
 289         vc4_func_layer.layer_get_info = vc4_layer_get_info;
 290         vc4_func_layer.layer_set_buffer = vc4_layer_set_buffer;
 291         vc4_func_layer.layer_unset_buffer = vc4_layer_unset_buffer;
 292
 293         ret = tdm_backend_register_func_display(dpy, &vc4_func_display);
 294         if (ret != TDM_ERROR_NONE)
 295                 goto failed;
 296
 297         ret = tdm_backend_register_func_output(dpy, &vc4_func_output);
 298         if (ret != TDM_ERROR_NONE)
 299                 goto failed;
 300
 301         ret = tdm_backend_register_func_layer(dpy, &vc4_func_layer);
 302         if (ret != TDM_ERROR_NONE)
 303                 goto failed;
 304
 305         vc4_data->dpy = dpy;
 306
 307         /* The drm master fd can be opened by a tbm backend module in
 308          * tbm_bufmgr_init() time. In this case, we just get it from tbm.
 309          */
 310         vc4_data->drm_fd = tbm_drm_helper_get_master_fd();
 311         if (vc4_data->drm_fd < 0) {
 312                 vc4_data->drm_fd = _tdm_vc4_open_drm();
 313
 314                 if (vc4_data->drm_fd < 0) {
 315                         ret = TDM_ERROR_OPERATION_FAILED;
 316                         goto failed;
 317                 }
 318
 319                 tbm_drm_helper_set_tbm_master_fd(vc4_data->drm_fd);
 320         }
 321
 322         TDM_INFO("master fd(%d)", vc4_data->drm_fd);
 323
 324 #ifdef HAVE_UDEV
 325         _tdm_vc4_udev_init(vc4_data);
 326 #endif
 327
 328 #if LIBDRM_MAJOR_VERSION >= 2 && LIBDRM_MINOR_VERSION >= 4  && LIBDRM_MICRO_VERSION >= 47
 329         if (drmSetClientCap(vc4_data->drm_fd, DRM_CLIENT_CAP_UNIVERSAL_PLANES, 1) < 0) {
 330                 TDM_WRN("Set DRM_CLIENT_CAP_UNIVERSAL_PLANES failed");
 331         } else {
 332                 TDM_INFO("has universal planes");
 333                 vc4_data->has_universal_plane = 1;
 334         }
 335 #endif
 336
 337         vc4_data->mode_res = drmModeGetResources(vc4_data->drm_fd);
 338         if (!vc4_data->mode_res) {
 339                 TDM_ERR("no drm resource: %m");
 340                 ret = TDM_ERROR_OPERATION_FAILED;
 341                 goto failed;
 342         }
 343
 344         vc4_data->plane_res = drmModeGetPlaneResources(vc4_data->drm_fd);
 345         if (!vc4_data->plane_res) {
 346                 TDM_ERR("no drm plane resource: %m");
 347                 ret = TDM_ERROR_OPERATION_FAILED;
 348                 goto failed;
 349         }
 350
 351         if (vc4_data->plane_res->count_planes <= 0) {
 352                 TDM_ERR("no drm plane resource");
 353                 ret = TDM_ERROR_OPERATION_FAILED;
 354                 goto failed;
 355         }
 356
 357         ret = tdm_vc4_display_create_output_list(vc4_data);
 358         if (ret != TDM_ERROR_NONE)
 359                 goto failed;
 360
 361         ret = tdm_vc4_display_create_layer_list(vc4_data);
 362         if (ret != TDM_ERROR_NONE)
 363                 goto failed;
 364
 365         if (error)
 366                 *error = TDM_ERROR_NONE;
 367
 368         TDM_INFO("init success!");
 369
 370         return (tdm_backend_data *)vc4_data;
 371 failed:
 372         if (error)
 373                 *error = ret;
 374
 375         tdm_vc4_deinit(vc4_data);
 376
 377         TDM_ERR("init failed!");
 378         return NULL;
 379 }
 380
 381 tdm_backend_module tdm_backend_module_data = {
 382         "drm",
 383         "Samsung",
 384         TDM_BACKEND_SET_ABI_VERSION(1, 1),
 385         tdm_vc4_init,
 386         tdm_vc4_deinit
 387 };