14d60c5fdSZhi Wang /* 24d60c5fdSZhi Wang * Copyright(c) 2011-2016 Intel Corporation. All rights reserved. 34d60c5fdSZhi Wang * 44d60c5fdSZhi Wang * Permission is hereby granted, free of charge, to any person obtaining a 54d60c5fdSZhi Wang * copy of this software and associated documentation files (the "Software"), 64d60c5fdSZhi Wang * to deal in the Software without restriction, including without limitation 74d60c5fdSZhi Wang * the rights to use, copy, modify, merge, publish, distribute, sublicense, 84d60c5fdSZhi Wang * and/or sell copies of the Software, and to permit persons to whom the 94d60c5fdSZhi Wang * Software is furnished to do so, subject to the following conditions: 104d60c5fdSZhi Wang * 114d60c5fdSZhi Wang * The above copyright notice and this permission notice (including the next 124d60c5fdSZhi Wang * paragraph) shall be included in all copies or substantial portions of the 134d60c5fdSZhi Wang * Software. 144d60c5fdSZhi Wang * 154d60c5fdSZhi Wang * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR 164d60c5fdSZhi Wang * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, 174d60c5fdSZhi Wang * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL 184d60c5fdSZhi Wang * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER 194d60c5fdSZhi Wang * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, 204d60c5fdSZhi Wang * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE 214d60c5fdSZhi Wang * SOFTWARE. 224d60c5fdSZhi Wang * 234d60c5fdSZhi Wang * Authors: 244d60c5fdSZhi Wang * Eddie Dong <eddie.dong@intel.com> 254d60c5fdSZhi Wang * Jike Song <jike.song@intel.com> 264d60c5fdSZhi Wang * 274d60c5fdSZhi Wang * Contributors: 284d60c5fdSZhi Wang * Zhi Wang <zhi.a.wang@intel.com> 294d60c5fdSZhi Wang * Min He <min.he@intel.com> 304d60c5fdSZhi Wang * Bing Niu <bing.niu@intel.com> 314d60c5fdSZhi Wang * 324d60c5fdSZhi Wang */ 334d60c5fdSZhi Wang 344d60c5fdSZhi Wang #include "i915_drv.h" 35feddf6e8SZhenyu Wang #include "gvt.h" 364d60c5fdSZhi Wang 374d60c5fdSZhi Wang enum { 384d60c5fdSZhi Wang INTEL_GVT_PCI_BAR_GTTMMIO = 0, 394d60c5fdSZhi Wang INTEL_GVT_PCI_BAR_APERTURE, 404d60c5fdSZhi Wang INTEL_GVT_PCI_BAR_PIO, 414d60c5fdSZhi Wang INTEL_GVT_PCI_BAR_MAX, 424d60c5fdSZhi Wang }; 434d60c5fdSZhi Wang 44c2e04fdaSChangbin Du /* bitmap for writable bits (RW or RW1C bits, but cannot co-exist in one 45c2e04fdaSChangbin Du * byte) byte by byte in standard pci configuration space. (not the full 46c2e04fdaSChangbin Du * 256 bytes.) 47c2e04fdaSChangbin Du */ 48c2e04fdaSChangbin Du static const u8 pci_cfg_space_rw_bmp[PCI_INTERRUPT_LINE + 4] = { 49c2e04fdaSChangbin Du [PCI_COMMAND] = 0xff, 0x07, 50c2e04fdaSChangbin Du [PCI_STATUS] = 0x00, 0xf9, /* the only one RW1C byte */ 51c2e04fdaSChangbin Du [PCI_CACHE_LINE_SIZE] = 0xff, 52c2e04fdaSChangbin Du [PCI_BASE_ADDRESS_0 ... PCI_CARDBUS_CIS - 1] = 0xff, 53c2e04fdaSChangbin Du [PCI_ROM_ADDRESS] = 0x01, 0xf8, 0xff, 0xff, 54c2e04fdaSChangbin Du [PCI_INTERRUPT_LINE] = 0xff, 55c2e04fdaSChangbin Du }; 56c2e04fdaSChangbin Du 57c2e04fdaSChangbin Du /** 58c2e04fdaSChangbin Du * vgpu_pci_cfg_mem_write - write virtual cfg space memory 59c2e04fdaSChangbin Du * 60c2e04fdaSChangbin Du * Use this function to write virtual cfg space memory. 61c2e04fdaSChangbin Du * For standard cfg space, only RW bits can be changed, 62c2e04fdaSChangbin Du * and we emulates the RW1C behavior of PCI_STATUS register. 63c2e04fdaSChangbin Du */ 64c2e04fdaSChangbin Du static void vgpu_pci_cfg_mem_write(struct intel_vgpu *vgpu, unsigned int off, 65c2e04fdaSChangbin Du u8 *src, unsigned int bytes) 66c2e04fdaSChangbin Du { 67c2e04fdaSChangbin Du u8 *cfg_base = vgpu_cfg_space(vgpu); 68c2e04fdaSChangbin Du u8 mask, new, old; 69c2e04fdaSChangbin Du int i = 0; 70c2e04fdaSChangbin Du 71c2e04fdaSChangbin Du for (; i < bytes && (off + i < sizeof(pci_cfg_space_rw_bmp)); i++) { 72c2e04fdaSChangbin Du mask = pci_cfg_space_rw_bmp[off + i]; 73c2e04fdaSChangbin Du old = cfg_base[off + i]; 74c2e04fdaSChangbin Du new = src[i] & mask; 75c2e04fdaSChangbin Du 76c2e04fdaSChangbin Du /** 77c2e04fdaSChangbin Du * The PCI_STATUS high byte has RW1C bits, here 78c2e04fdaSChangbin Du * emulates clear by writing 1 for these bits. 79c2e04fdaSChangbin Du * Writing a 0b to RW1C bits has no effect. 80c2e04fdaSChangbin Du */ 81c2e04fdaSChangbin Du if (off + i == PCI_STATUS + 1) 82c2e04fdaSChangbin Du new = (~new & old) & mask; 83c2e04fdaSChangbin Du 84c2e04fdaSChangbin Du cfg_base[off + i] = (old & ~mask) | new; 85c2e04fdaSChangbin Du } 86c2e04fdaSChangbin Du 87c2e04fdaSChangbin Du /* For other configuration space directly copy as it is. */ 88c2e04fdaSChangbin Du if (i < bytes) 89c2e04fdaSChangbin Du memcpy(cfg_base + off + i, src + i, bytes - i); 90c2e04fdaSChangbin Du } 91c2e04fdaSChangbin Du 924d60c5fdSZhi Wang /** 934d60c5fdSZhi Wang * intel_vgpu_emulate_cfg_read - emulate vGPU configuration space read 944d60c5fdSZhi Wang * 954d60c5fdSZhi Wang * Returns: 964d60c5fdSZhi Wang * Zero on success, negative error code if failed. 974d60c5fdSZhi Wang */ 989ec1e66bSJike Song int intel_vgpu_emulate_cfg_read(struct intel_vgpu *vgpu, unsigned int offset, 994d60c5fdSZhi Wang void *p_data, unsigned int bytes) 1004d60c5fdSZhi Wang { 1014d60c5fdSZhi Wang if (WARN_ON(bytes > 4)) 1024d60c5fdSZhi Wang return -EINVAL; 1034d60c5fdSZhi Wang 1044d60c5fdSZhi Wang if (WARN_ON(offset + bytes > INTEL_GVT_MAX_CFG_SPACE_SZ)) 1054d60c5fdSZhi Wang return -EINVAL; 1064d60c5fdSZhi Wang 1074d60c5fdSZhi Wang memcpy(p_data, vgpu_cfg_space(vgpu) + offset, bytes); 1084d60c5fdSZhi Wang return 0; 1094d60c5fdSZhi Wang } 1104d60c5fdSZhi Wang 1114d60c5fdSZhi Wang static int map_aperture(struct intel_vgpu *vgpu, bool map) 1124d60c5fdSZhi Wang { 1134d60c5fdSZhi Wang u64 first_gfn, first_mfn; 1144d60c5fdSZhi Wang u64 val; 1154d60c5fdSZhi Wang int ret; 1164d60c5fdSZhi Wang 1174d60c5fdSZhi Wang if (map == vgpu->cfg_space.bar[INTEL_GVT_PCI_BAR_APERTURE].tracked) 1184d60c5fdSZhi Wang return 0; 1194d60c5fdSZhi Wang 1204d60c5fdSZhi Wang val = vgpu_cfg_space(vgpu)[PCI_BASE_ADDRESS_2]; 1214d60c5fdSZhi Wang if (val & PCI_BASE_ADDRESS_MEM_TYPE_64) 1224d60c5fdSZhi Wang val = *(u64 *)(vgpu_cfg_space(vgpu) + PCI_BASE_ADDRESS_2); 1234d60c5fdSZhi Wang else 1244d60c5fdSZhi Wang val = *(u32 *)(vgpu_cfg_space(vgpu) + PCI_BASE_ADDRESS_2); 1254d60c5fdSZhi Wang 1264d60c5fdSZhi Wang first_gfn = (val + vgpu_aperture_offset(vgpu)) >> PAGE_SHIFT; 1274d60c5fdSZhi Wang first_mfn = vgpu_aperture_pa_base(vgpu) >> PAGE_SHIFT; 1284d60c5fdSZhi Wang 1294d60c5fdSZhi Wang ret = intel_gvt_hypervisor_map_gfn_to_mfn(vgpu, first_gfn, 1304d60c5fdSZhi Wang first_mfn, 1318f89743bSJike Song vgpu_aperture_sz(vgpu) >> 1328f89743bSJike Song PAGE_SHIFT, map); 1334d60c5fdSZhi Wang if (ret) 1344d60c5fdSZhi Wang return ret; 1354d60c5fdSZhi Wang 1364d60c5fdSZhi Wang vgpu->cfg_space.bar[INTEL_GVT_PCI_BAR_APERTURE].tracked = map; 1374d60c5fdSZhi Wang return 0; 1384d60c5fdSZhi Wang } 1394d60c5fdSZhi Wang 1404d60c5fdSZhi Wang static int trap_gttmmio(struct intel_vgpu *vgpu, bool trap) 1414d60c5fdSZhi Wang { 1424d60c5fdSZhi Wang u64 start, end; 1434d60c5fdSZhi Wang u64 val; 1444d60c5fdSZhi Wang int ret; 1454d60c5fdSZhi Wang 1464d60c5fdSZhi Wang if (trap == vgpu->cfg_space.bar[INTEL_GVT_PCI_BAR_GTTMMIO].tracked) 1474d60c5fdSZhi Wang return 0; 1484d60c5fdSZhi Wang 1494d60c5fdSZhi Wang val = vgpu_cfg_space(vgpu)[PCI_BASE_ADDRESS_0]; 1504d60c5fdSZhi Wang if (val & PCI_BASE_ADDRESS_MEM_TYPE_64) 1514d60c5fdSZhi Wang start = *(u64 *)(vgpu_cfg_space(vgpu) + PCI_BASE_ADDRESS_0); 1524d60c5fdSZhi Wang else 1534d60c5fdSZhi Wang start = *(u32 *)(vgpu_cfg_space(vgpu) + PCI_BASE_ADDRESS_0); 1544d60c5fdSZhi Wang 1554d60c5fdSZhi Wang start &= ~GENMASK(3, 0); 1564d60c5fdSZhi Wang end = start + vgpu->cfg_space.bar[INTEL_GVT_PCI_BAR_GTTMMIO].size - 1; 1574d60c5fdSZhi Wang 1584d60c5fdSZhi Wang ret = intel_gvt_hypervisor_set_trap_area(vgpu, start, end, trap); 1594d60c5fdSZhi Wang if (ret) 1604d60c5fdSZhi Wang return ret; 1614d60c5fdSZhi Wang 1624d60c5fdSZhi Wang vgpu->cfg_space.bar[INTEL_GVT_PCI_BAR_GTTMMIO].tracked = trap; 1634d60c5fdSZhi Wang return 0; 1644d60c5fdSZhi Wang } 1654d60c5fdSZhi Wang 1664d60c5fdSZhi Wang static int emulate_pci_command_write(struct intel_vgpu *vgpu, 1674d60c5fdSZhi Wang unsigned int offset, void *p_data, unsigned int bytes) 1684d60c5fdSZhi Wang { 1694d60c5fdSZhi Wang u8 old = vgpu_cfg_space(vgpu)[offset]; 1704d60c5fdSZhi Wang u8 new = *(u8 *)p_data; 1714d60c5fdSZhi Wang u8 changed = old ^ new; 1724d60c5fdSZhi Wang int ret; 1734d60c5fdSZhi Wang 174c2e04fdaSChangbin Du vgpu_pci_cfg_mem_write(vgpu, offset, p_data, bytes); 1754d60c5fdSZhi Wang if (!(changed & PCI_COMMAND_MEMORY)) 1764d60c5fdSZhi Wang return 0; 1774d60c5fdSZhi Wang 1784d60c5fdSZhi Wang if (old & PCI_COMMAND_MEMORY) { 1794d60c5fdSZhi Wang ret = trap_gttmmio(vgpu, false); 1804d60c5fdSZhi Wang if (ret) 1814d60c5fdSZhi Wang return ret; 1824d60c5fdSZhi Wang ret = map_aperture(vgpu, false); 1834d60c5fdSZhi Wang if (ret) 1844d60c5fdSZhi Wang return ret; 1854d60c5fdSZhi Wang } else { 1864d60c5fdSZhi Wang ret = trap_gttmmio(vgpu, true); 1874d60c5fdSZhi Wang if (ret) 1884d60c5fdSZhi Wang return ret; 1894d60c5fdSZhi Wang ret = map_aperture(vgpu, true); 1904d60c5fdSZhi Wang if (ret) 1914d60c5fdSZhi Wang return ret; 1924d60c5fdSZhi Wang } 1934d60c5fdSZhi Wang 1944d60c5fdSZhi Wang return 0; 1954d60c5fdSZhi Wang } 1964d60c5fdSZhi Wang 1974d60c5fdSZhi Wang static int emulate_pci_bar_write(struct intel_vgpu *vgpu, unsigned int offset, 1984d60c5fdSZhi Wang void *p_data, unsigned int bytes) 1994d60c5fdSZhi Wang { 2004d60c5fdSZhi Wang unsigned int bar_index = 2014d60c5fdSZhi Wang (rounddown(offset, 8) % PCI_BASE_ADDRESS_0) / 8; 2024d60c5fdSZhi Wang u32 new = *(u32 *)(p_data); 2034d60c5fdSZhi Wang bool lo = IS_ALIGNED(offset, 8); 2044d60c5fdSZhi Wang u64 size; 2054d60c5fdSZhi Wang int ret = 0; 2064d60c5fdSZhi Wang bool mmio_enabled = 2074d60c5fdSZhi Wang vgpu_cfg_space(vgpu)[PCI_COMMAND] & PCI_COMMAND_MEMORY; 2084d60c5fdSZhi Wang 2094d60c5fdSZhi Wang if (WARN_ON(bar_index >= INTEL_GVT_PCI_BAR_MAX)) 2104d60c5fdSZhi Wang return -EINVAL; 2114d60c5fdSZhi Wang 2124d60c5fdSZhi Wang if (new == 0xffffffff) { 2134d60c5fdSZhi Wang /* 2144d60c5fdSZhi Wang * Power-up software can determine how much address 2154d60c5fdSZhi Wang * space the device requires by writing a value of 2164d60c5fdSZhi Wang * all 1's to the register and then reading the value 2174d60c5fdSZhi Wang * back. The device will return 0's in all don't-care 2184d60c5fdSZhi Wang * address bits. 2194d60c5fdSZhi Wang */ 2204d60c5fdSZhi Wang size = vgpu->cfg_space.bar[bar_index].size; 2214d60c5fdSZhi Wang if (lo) { 2224d60c5fdSZhi Wang new = rounddown(new, size); 2234d60c5fdSZhi Wang } else { 2244d60c5fdSZhi Wang u32 val = vgpu_cfg_space(vgpu)[rounddown(offset, 8)]; 2254d60c5fdSZhi Wang /* for 32bit mode bar it returns all-0 in upper 32 2264d60c5fdSZhi Wang * bit, for 64bit mode bar it will calculate the 2274d60c5fdSZhi Wang * size with lower 32bit and return the corresponding 2284d60c5fdSZhi Wang * value 2294d60c5fdSZhi Wang */ 2304d60c5fdSZhi Wang if (val & PCI_BASE_ADDRESS_MEM_TYPE_64) 2314d60c5fdSZhi Wang new &= (~(size-1)) >> 32; 2324d60c5fdSZhi Wang else 2334d60c5fdSZhi Wang new = 0; 2344d60c5fdSZhi Wang } 2354d60c5fdSZhi Wang /* 2364d60c5fdSZhi Wang * Unmapp & untrap the BAR, since guest hasn't configured a 2374d60c5fdSZhi Wang * valid GPA 2384d60c5fdSZhi Wang */ 2394d60c5fdSZhi Wang switch (bar_index) { 2404d60c5fdSZhi Wang case INTEL_GVT_PCI_BAR_GTTMMIO: 2414d60c5fdSZhi Wang ret = trap_gttmmio(vgpu, false); 2424d60c5fdSZhi Wang break; 2434d60c5fdSZhi Wang case INTEL_GVT_PCI_BAR_APERTURE: 2444d60c5fdSZhi Wang ret = map_aperture(vgpu, false); 2454d60c5fdSZhi Wang break; 2464d60c5fdSZhi Wang } 2474d60c5fdSZhi Wang intel_vgpu_write_pci_bar(vgpu, offset, new, lo); 2484d60c5fdSZhi Wang } else { 2494d60c5fdSZhi Wang /* 2504d60c5fdSZhi Wang * Unmapp & untrap the old BAR first, since guest has 2514d60c5fdSZhi Wang * re-configured the BAR 2524d60c5fdSZhi Wang */ 2534d60c5fdSZhi Wang switch (bar_index) { 2544d60c5fdSZhi Wang case INTEL_GVT_PCI_BAR_GTTMMIO: 2554d60c5fdSZhi Wang ret = trap_gttmmio(vgpu, false); 2564d60c5fdSZhi Wang break; 2574d60c5fdSZhi Wang case INTEL_GVT_PCI_BAR_APERTURE: 2584d60c5fdSZhi Wang ret = map_aperture(vgpu, false); 2594d60c5fdSZhi Wang break; 2604d60c5fdSZhi Wang } 2614d60c5fdSZhi Wang intel_vgpu_write_pci_bar(vgpu, offset, new, lo); 2624d60c5fdSZhi Wang /* Track the new BAR */ 2634d60c5fdSZhi Wang if (mmio_enabled) { 2644d60c5fdSZhi Wang switch (bar_index) { 2654d60c5fdSZhi Wang case INTEL_GVT_PCI_BAR_GTTMMIO: 2664d60c5fdSZhi Wang ret = trap_gttmmio(vgpu, true); 2674d60c5fdSZhi Wang break; 2684d60c5fdSZhi Wang case INTEL_GVT_PCI_BAR_APERTURE: 2694d60c5fdSZhi Wang ret = map_aperture(vgpu, true); 2704d60c5fdSZhi Wang break; 2714d60c5fdSZhi Wang } 2724d60c5fdSZhi Wang } 2734d60c5fdSZhi Wang } 2744d60c5fdSZhi Wang return ret; 2754d60c5fdSZhi Wang } 2764d60c5fdSZhi Wang 2774d60c5fdSZhi Wang /** 2784d60c5fdSZhi Wang * intel_vgpu_emulate_cfg_read - emulate vGPU configuration space write 2794d60c5fdSZhi Wang * 2804d60c5fdSZhi Wang * Returns: 2814d60c5fdSZhi Wang * Zero on success, negative error code if failed. 2824d60c5fdSZhi Wang */ 2839ec1e66bSJike Song int intel_vgpu_emulate_cfg_write(struct intel_vgpu *vgpu, unsigned int offset, 2844d60c5fdSZhi Wang void *p_data, unsigned int bytes) 2854d60c5fdSZhi Wang { 2864d60c5fdSZhi Wang int ret; 2874d60c5fdSZhi Wang 288fd64be63SMin He if (vgpu->failsafe) 289fd64be63SMin He return 0; 290fd64be63SMin He 2914d60c5fdSZhi Wang if (WARN_ON(bytes > 4)) 2924d60c5fdSZhi Wang return -EINVAL; 2934d60c5fdSZhi Wang 2944e0203baSPei Zhang if (WARN_ON(offset + bytes > INTEL_GVT_MAX_CFG_SPACE_SZ)) 2954d60c5fdSZhi Wang return -EINVAL; 2964d60c5fdSZhi Wang 2974d60c5fdSZhi Wang /* First check if it's PCI_COMMAND */ 2984d60c5fdSZhi Wang if (IS_ALIGNED(offset, 2) && offset == PCI_COMMAND) { 2994d60c5fdSZhi Wang if (WARN_ON(bytes > 2)) 3004d60c5fdSZhi Wang return -EINVAL; 3014d60c5fdSZhi Wang return emulate_pci_command_write(vgpu, offset, p_data, bytes); 3024d60c5fdSZhi Wang } 3034d60c5fdSZhi Wang 3044d60c5fdSZhi Wang switch (rounddown(offset, 4)) { 3054d60c5fdSZhi Wang case PCI_BASE_ADDRESS_0: 3064d60c5fdSZhi Wang case PCI_BASE_ADDRESS_1: 3074d60c5fdSZhi Wang case PCI_BASE_ADDRESS_2: 3084d60c5fdSZhi Wang case PCI_BASE_ADDRESS_3: 3094d60c5fdSZhi Wang if (WARN_ON(!IS_ALIGNED(offset, 4))) 3104d60c5fdSZhi Wang return -EINVAL; 3114d60c5fdSZhi Wang return emulate_pci_bar_write(vgpu, offset, p_data, bytes); 3124d60c5fdSZhi Wang 3134d60c5fdSZhi Wang case INTEL_GVT_PCI_SWSCI: 3144d60c5fdSZhi Wang if (WARN_ON(!IS_ALIGNED(offset, 4))) 3154d60c5fdSZhi Wang return -EINVAL; 3164d60c5fdSZhi Wang ret = intel_vgpu_emulate_opregion_request(vgpu, *(u32 *)p_data); 3174d60c5fdSZhi Wang if (ret) 3184d60c5fdSZhi Wang return ret; 3194d60c5fdSZhi Wang break; 3204d60c5fdSZhi Wang 3214d60c5fdSZhi Wang case INTEL_GVT_PCI_OPREGION: 3224d60c5fdSZhi Wang if (WARN_ON(!IS_ALIGNED(offset, 4))) 3234d60c5fdSZhi Wang return -EINVAL; 3244d60c5fdSZhi Wang ret = intel_vgpu_init_opregion(vgpu, *(u32 *)p_data); 3254d60c5fdSZhi Wang if (ret) 3264d60c5fdSZhi Wang return ret; 3274d60c5fdSZhi Wang 328c2e04fdaSChangbin Du vgpu_pci_cfg_mem_write(vgpu, offset, p_data, bytes); 3294d60c5fdSZhi Wang break; 3304d60c5fdSZhi Wang default: 331c2e04fdaSChangbin Du vgpu_pci_cfg_mem_write(vgpu, offset, p_data, bytes); 3324d60c5fdSZhi Wang break; 3334d60c5fdSZhi Wang } 3344d60c5fdSZhi Wang return 0; 3354d60c5fdSZhi Wang } 336536fc234SChangbin Du 337536fc234SChangbin Du /** 338536fc234SChangbin Du * intel_vgpu_init_cfg_space - init vGPU configuration space when create vGPU 339536fc234SChangbin Du * 340536fc234SChangbin Du * @vgpu: a vGPU 341536fc234SChangbin Du * @primary: is the vGPU presented as primary 342536fc234SChangbin Du * 343536fc234SChangbin Du */ 344536fc234SChangbin Du void intel_vgpu_init_cfg_space(struct intel_vgpu *vgpu, 345536fc234SChangbin Du bool primary) 346536fc234SChangbin Du { 347536fc234SChangbin Du struct intel_gvt *gvt = vgpu->gvt; 348536fc234SChangbin Du const struct intel_gvt_device_info *info = &gvt->device_info; 349536fc234SChangbin Du u16 *gmch_ctl; 350536fc234SChangbin Du int i; 351536fc234SChangbin Du 352536fc234SChangbin Du memcpy(vgpu_cfg_space(vgpu), gvt->firmware.cfg_space, 353536fc234SChangbin Du info->cfg_space_size); 354536fc234SChangbin Du 355536fc234SChangbin Du if (!primary) { 356536fc234SChangbin Du vgpu_cfg_space(vgpu)[PCI_CLASS_DEVICE] = 357536fc234SChangbin Du INTEL_GVT_PCI_CLASS_VGA_OTHER; 358536fc234SChangbin Du vgpu_cfg_space(vgpu)[PCI_CLASS_PROG] = 359536fc234SChangbin Du INTEL_GVT_PCI_CLASS_VGA_OTHER; 360536fc234SChangbin Du } 361536fc234SChangbin Du 362536fc234SChangbin Du /* Show guest that there isn't any stolen memory.*/ 363536fc234SChangbin Du gmch_ctl = (u16 *)(vgpu_cfg_space(vgpu) + INTEL_GVT_PCI_GMCH_CONTROL); 364536fc234SChangbin Du *gmch_ctl &= ~(BDW_GMCH_GMS_MASK << BDW_GMCH_GMS_SHIFT); 365536fc234SChangbin Du 366536fc234SChangbin Du intel_vgpu_write_pci_bar(vgpu, PCI_BASE_ADDRESS_2, 367536fc234SChangbin Du gvt_aperture_pa_base(gvt), true); 368536fc234SChangbin Du 369536fc234SChangbin Du vgpu_cfg_space(vgpu)[PCI_COMMAND] &= ~(PCI_COMMAND_IO 370536fc234SChangbin Du | PCI_COMMAND_MEMORY 371536fc234SChangbin Du | PCI_COMMAND_MASTER); 372536fc234SChangbin Du /* 373536fc234SChangbin Du * Clear the bar upper 32bit and let guest to assign the new value 374536fc234SChangbin Du */ 375536fc234SChangbin Du memset(vgpu_cfg_space(vgpu) + PCI_BASE_ADDRESS_1, 0, 4); 376536fc234SChangbin Du memset(vgpu_cfg_space(vgpu) + PCI_BASE_ADDRESS_3, 0, 4); 377536fc234SChangbin Du memset(vgpu_cfg_space(vgpu) + INTEL_GVT_PCI_OPREGION, 0, 4); 378536fc234SChangbin Du 379536fc234SChangbin Du for (i = 0; i < INTEL_GVT_MAX_BAR_NUM; i++) { 380536fc234SChangbin Du vgpu->cfg_space.bar[i].size = pci_resource_len( 381536fc234SChangbin Du gvt->dev_priv->drm.pdev, i * 2); 382536fc234SChangbin Du vgpu->cfg_space.bar[i].tracked = false; 383536fc234SChangbin Du } 384536fc234SChangbin Du } 385c64ff6c7SChangbin Du 386c64ff6c7SChangbin Du /** 387c64ff6c7SChangbin Du * intel_vgpu_reset_cfg_space - reset vGPU configuration space 388c64ff6c7SChangbin Du * 389c64ff6c7SChangbin Du * @vgpu: a vGPU 390c64ff6c7SChangbin Du * 391c64ff6c7SChangbin Du */ 392c64ff6c7SChangbin Du void intel_vgpu_reset_cfg_space(struct intel_vgpu *vgpu) 393c64ff6c7SChangbin Du { 394c64ff6c7SChangbin Du u8 cmd = vgpu_cfg_space(vgpu)[PCI_COMMAND]; 395c64ff6c7SChangbin Du bool primary = vgpu_cfg_space(vgpu)[PCI_CLASS_DEVICE] != 396c64ff6c7SChangbin Du INTEL_GVT_PCI_CLASS_VGA_OTHER; 397c64ff6c7SChangbin Du 398c64ff6c7SChangbin Du if (cmd & PCI_COMMAND_MEMORY) { 399c64ff6c7SChangbin Du trap_gttmmio(vgpu, false); 400c64ff6c7SChangbin Du map_aperture(vgpu, false); 401c64ff6c7SChangbin Du } 402c64ff6c7SChangbin Du 403c64ff6c7SChangbin Du /** 404c64ff6c7SChangbin Du * Currently we only do such reset when vGPU is not 405c64ff6c7SChangbin Du * owned by any VM, so we simply restore entire cfg 406c64ff6c7SChangbin Du * space to default value. 407c64ff6c7SChangbin Du */ 408c64ff6c7SChangbin Du intel_vgpu_init_cfg_space(vgpu, primary); 409c64ff6c7SChangbin Du } 410