0001
0002
0003
0004
0005
0006
0007
0008
0009
0010
0011 #include <linux/pci.h>
0012 #include <linux/vbox_err.h>
0013
0014 #include <drm/drm_fb_helper.h>
0015 #include <drm/drm_crtc_helper.h>
0016 #include <drm/drm_damage_helper.h>
0017
0018 #include "vbox_drv.h"
0019 #include "vboxvideo_guest.h"
0020 #include "vboxvideo_vbe.h"
0021
0022 void vbox_report_caps(struct vbox_private *vbox)
0023 {
0024 u32 caps = VBVACAPS_DISABLE_CURSOR_INTEGRATION |
0025 VBVACAPS_IRQ | VBVACAPS_USE_VBVA_ONLY;
0026
0027
0028 hgsmi_send_caps_info(vbox->guest_pool, caps);
0029 caps |= VBVACAPS_VIDEO_MODE_HINTS;
0030 hgsmi_send_caps_info(vbox->guest_pool, caps);
0031 }
0032
0033 static int vbox_accel_init(struct vbox_private *vbox)
0034 {
0035 struct pci_dev *pdev = to_pci_dev(vbox->ddev.dev);
0036 struct vbva_buffer *vbva;
0037 unsigned int i;
0038
0039 vbox->vbva_info = devm_kcalloc(vbox->ddev.dev, vbox->num_crtcs,
0040 sizeof(*vbox->vbva_info), GFP_KERNEL);
0041 if (!vbox->vbva_info)
0042 return -ENOMEM;
0043
0044
0045 vbox->available_vram_size -= vbox->num_crtcs * VBVA_MIN_BUFFER_SIZE;
0046
0047 vbox->vbva_buffers = pci_iomap_range(pdev, 0,
0048 vbox->available_vram_size,
0049 vbox->num_crtcs *
0050 VBVA_MIN_BUFFER_SIZE);
0051 if (!vbox->vbva_buffers)
0052 return -ENOMEM;
0053
0054 for (i = 0; i < vbox->num_crtcs; ++i) {
0055 vbva_setup_buffer_context(&vbox->vbva_info[i],
0056 vbox->available_vram_size +
0057 i * VBVA_MIN_BUFFER_SIZE,
0058 VBVA_MIN_BUFFER_SIZE);
0059 vbva = (void __force *)vbox->vbva_buffers +
0060 i * VBVA_MIN_BUFFER_SIZE;
0061 if (!vbva_enable(&vbox->vbva_info[i],
0062 vbox->guest_pool, vbva, i)) {
0063
0064 DRM_ERROR("vboxvideo: vbva_enable failed\n");
0065 }
0066 }
0067
0068 return 0;
0069 }
0070
0071 static void vbox_accel_fini(struct vbox_private *vbox)
0072 {
0073 unsigned int i;
0074
0075 for (i = 0; i < vbox->num_crtcs; ++i)
0076 vbva_disable(&vbox->vbva_info[i], vbox->guest_pool, i);
0077 }
0078
0079
0080 static bool have_hgsmi_mode_hints(struct vbox_private *vbox)
0081 {
0082 u32 have_hints, have_cursor;
0083 int ret;
0084
0085 ret = hgsmi_query_conf(vbox->guest_pool,
0086 VBOX_VBVA_CONF32_MODE_HINT_REPORTING,
0087 &have_hints);
0088 if (ret)
0089 return false;
0090
0091 ret = hgsmi_query_conf(vbox->guest_pool,
0092 VBOX_VBVA_CONF32_GUEST_CURSOR_REPORTING,
0093 &have_cursor);
0094 if (ret)
0095 return false;
0096
0097 return have_hints == VINF_SUCCESS && have_cursor == VINF_SUCCESS;
0098 }
0099
0100 bool vbox_check_supported(u16 id)
0101 {
0102 u16 dispi_id;
0103
0104 vbox_write_ioport(VBE_DISPI_INDEX_ID, id);
0105 dispi_id = inw(VBE_DISPI_IOPORT_DATA);
0106
0107 return dispi_id == id;
0108 }
0109
0110 int vbox_hw_init(struct vbox_private *vbox)
0111 {
0112 struct pci_dev *pdev = to_pci_dev(vbox->ddev.dev);
0113 int ret = -ENOMEM;
0114
0115 vbox->full_vram_size = inl(VBE_DISPI_IOPORT_DATA);
0116 vbox->any_pitch = vbox_check_supported(VBE_DISPI_ID_ANYX);
0117
0118 DRM_INFO("VRAM %08x\n", vbox->full_vram_size);
0119
0120
0121 vbox->guest_heap =
0122 pci_iomap_range(pdev, 0, GUEST_HEAP_OFFSET(vbox),
0123 GUEST_HEAP_SIZE);
0124 if (!vbox->guest_heap)
0125 return -ENOMEM;
0126
0127
0128 vbox->guest_pool = devm_gen_pool_create(vbox->ddev.dev, 4, -1,
0129 "vboxvideo-accel");
0130 if (IS_ERR(vbox->guest_pool))
0131 return PTR_ERR(vbox->guest_pool);
0132
0133 ret = gen_pool_add_virt(vbox->guest_pool,
0134 (unsigned long)vbox->guest_heap,
0135 GUEST_HEAP_OFFSET(vbox),
0136 GUEST_HEAP_USABLE_SIZE, -1);
0137 if (ret)
0138 return ret;
0139
0140 ret = hgsmi_test_query_conf(vbox->guest_pool);
0141 if (ret) {
0142 DRM_ERROR("vboxvideo: hgsmi_test_query_conf failed\n");
0143 return ret;
0144 }
0145
0146
0147 vbox->available_vram_size = GUEST_HEAP_OFFSET(vbox);
0148
0149 hgsmi_query_conf(vbox->guest_pool, VBOX_VBVA_CONF32_MONITOR_COUNT,
0150 &vbox->num_crtcs);
0151 vbox->num_crtcs = clamp_t(u32, vbox->num_crtcs, 1, VBOX_MAX_SCREENS);
0152
0153 if (!have_hgsmi_mode_hints(vbox)) {
0154 ret = -ENOTSUPP;
0155 return ret;
0156 }
0157
0158 vbox->last_mode_hints = devm_kcalloc(vbox->ddev.dev, vbox->num_crtcs,
0159 sizeof(struct vbva_modehint),
0160 GFP_KERNEL);
0161 if (!vbox->last_mode_hints)
0162 return -ENOMEM;
0163
0164 ret = vbox_accel_init(vbox);
0165 if (ret)
0166 return ret;
0167
0168 return 0;
0169 }
0170
0171 void vbox_hw_fini(struct vbox_private *vbox)
0172 {
0173 vbox_accel_fini(vbox);
0174 }