drivers/staging/vboxvideo/vbox_irq.c

   1 // SPDX-License-Identifier: MIT
   2 /*
   3  * Copyright (C) 2016-2017 Oracle Corporation
   4  * This file is based on qxl_irq.c
   5  * Copyright 2013 Red Hat Inc.
   6  * Authors: Dave Airlie
   7  *          Alon Levy
   8  *          Michael Thayer <michael.thayer@oracle.com,
   9  *          Hans de Goede <hdegoede@redhat.com>
  10  */
  11
  12 #include <linux/pci.h>
  13 #include <drm/drm_irq.h>
  14 #include <drm/drm_probe_helper.h>
  15
  16 #include "vbox_drv.h"
  17 #include "vboxvideo.h"
  18
  19 static void vbox_clear_irq(void)
  20 {
  21         outl((u32)~0, VGA_PORT_HGSMI_HOST);
  22 }
  23
  24 static u32 vbox_get_flags(struct vbox_private *vbox)
  25 {
  26         return readl(vbox->guest_heap + HOST_FLAGS_OFFSET);
  27 }
  28
  29 void vbox_report_hotplug(struct vbox_private *vbox)
  30 {
  31         schedule_work(&vbox->hotplug_work);
  32 }
  33
  34 irqreturn_t vbox_irq_handler(int irq, void *arg)
  35 {
  36         struct drm_device *dev = (struct drm_device *)arg;
  37         struct vbox_private *vbox = (struct vbox_private *)dev->dev_private;
  38         u32 host_flags = vbox_get_flags(vbox);
  39
  40         if (!(host_flags & HGSMIHOSTFLAGS_IRQ))
  41                 return IRQ_NONE;
  42
  43         /*
  44          * Due to a bug in the initial host implementation of hot-plug irqs,
  45          * the hot-plug and cursor capability flags were never cleared.
  46          * Fortunately we can tell when they would have been set by checking
  47          * that the VSYNC flag is not set.
  48          */
  49         if (host_flags &
  50             (HGSMIHOSTFLAGS_HOTPLUG | HGSMIHOSTFLAGS_CURSOR_CAPABILITIES) &&
  51             !(host_flags & HGSMIHOSTFLAGS_VSYNC))
  52                 vbox_report_hotplug(vbox);
  53
  54         vbox_clear_irq();
  55
  56         return IRQ_HANDLED;
  57 }
  58
  59 /*
  60  * Check that the position hints provided by the host are suitable for GNOME
  61  * shell (i.e. all screens disjoint and hints for all enabled screens) and if
  62  * not replace them with default ones.  Providing valid hints improves the
  63  * chances that we will get a known screen layout for pointer mapping.
  64  */
  65 static void validate_or_set_position_hints(struct vbox_private *vbox)
  66 {
  67         struct vbva_modehint *hintsi, *hintsj;
  68         bool valid = true;
  69         u16 currentx = 0;
  70         int i, j;
  71
  72         for (i = 0; i < vbox->num_crtcs; ++i) {
  73                 for (j = 0; j < i; ++j) {
  74                         hintsi = &vbox->last_mode_hints[i];
  75                         hintsj = &vbox->last_mode_hints[j];
  76
  77                         if (hintsi->enabled && hintsj->enabled) {
  78                                 if (hintsi->dx >= 0xffff ||
  79                                     hintsi->dy >= 0xffff ||
  80                                     hintsj->dx >= 0xffff ||
  81                                     hintsj->dy >= 0xffff ||
  82                                     (hintsi->dx <
  83                                         hintsj->dx + (hintsj->cx & 0x8fff) &&
  84                                      hintsi->dx + (hintsi->cx & 0x8fff) >
  85                                         hintsj->dx) ||
  86                                     (hintsi->dy <
  87                                         hintsj->dy + (hintsj->cy & 0x8fff) &&
  88                                      hintsi->dy + (hintsi->cy & 0x8fff) >
  89                                         hintsj->dy))
  90                                         valid = false;
  91                         }
  92                 }
  93         }
  94         if (!valid)
  95                 for (i = 0; i < vbox->num_crtcs; ++i) {
  96                         if (vbox->last_mode_hints[i].enabled) {
  97                                 vbox->last_mode_hints[i].dx = currentx;
  98                                 vbox->last_mode_hints[i].dy = 0;
  99                                 currentx +=
 100                                     vbox->last_mode_hints[i].cx & 0x8fff;
 101                         }
 102                 }
 103 }
 104
 105 /* Query the host for the most recent video mode hints. */
 106 static void vbox_update_mode_hints(struct vbox_private *vbox)
 107 {
 108         struct drm_device *dev = &vbox->ddev;
 109         struct drm_connector *connector;
 110         struct vbox_connector *vbox_conn;
 111         struct vbva_modehint *hints;
 112         u16 flags;
 113         bool disconnected;
 114         unsigned int crtc_id;
 115         int ret;
 116
 117         ret = hgsmi_get_mode_hints(vbox->guest_pool, vbox->num_crtcs,
 118                                    vbox->last_mode_hints);
 119         if (ret) {
 120                 DRM_ERROR("vboxvideo: hgsmi_get_mode_hints failed: %d\n", ret);
 121                 return;
 122         }
 123
 124         validate_or_set_position_hints(vbox);
 125         drm_modeset_lock_all(dev);
 126         list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
 127                 vbox_conn = to_vbox_connector(connector);
 128
 129                 hints = &vbox->last_mode_hints[vbox_conn->vbox_crtc->crtc_id];
 130                 if (hints->magic != VBVAMODEHINT_MAGIC)
 131                         continue;
 132
 133                 disconnected = !(hints->enabled);
 134                 crtc_id = vbox_conn->vbox_crtc->crtc_id;
 135                 vbox_conn->mode_hint.width = hints->cx;
 136                 vbox_conn->mode_hint.height = hints->cy;
 137                 vbox_conn->vbox_crtc->x_hint = hints->dx;
 138                 vbox_conn->vbox_crtc->y_hint = hints->dy;
 139                 vbox_conn->mode_hint.disconnected = disconnected;
 140
 141                 if (vbox_conn->vbox_crtc->disconnected == disconnected)
 142                         continue;
 143
 144                 if (disconnected)
 145                         flags = VBVA_SCREEN_F_ACTIVE | VBVA_SCREEN_F_DISABLED;
 146                 else
 147                         flags = VBVA_SCREEN_F_ACTIVE | VBVA_SCREEN_F_BLANK;
 148
 149                 hgsmi_process_display_info(vbox->guest_pool, crtc_id, 0, 0, 0,
 150                                            hints->cx * 4, hints->cx,
 151                                            hints->cy, 0, flags);
 152
 153                 vbox_conn->vbox_crtc->disconnected = disconnected;
 154         }
 155         drm_modeset_unlock_all(dev);
 156 }
 157
 158 static void vbox_hotplug_worker(struct work_struct *work)
 159 {
 160         struct vbox_private *vbox = container_of(work, struct vbox_private,
 161                                                  hotplug_work);
 162
 163         vbox_update_mode_hints(vbox);
 164         drm_kms_helper_hotplug_event(&vbox->ddev);
 165 }
 166
 167 int vbox_irq_init(struct vbox_private *vbox)
 168 {
 169         INIT_WORK(&vbox->hotplug_work, vbox_hotplug_worker);
 170         vbox_update_mode_hints(vbox);
 171
 172         return drm_irq_install(&vbox->ddev, vbox->ddev.pdev->irq);
 173 }
 174
 175 void vbox_irq_fini(struct vbox_private *vbox)
 176 {
 177         drm_irq_uninstall(&vbox->ddev);
 178         flush_work(&vbox->hotplug_work);
 179 }