Statistics
| Branch: | Revision:

root / hw / xen_pt_config_init.c @ c13a9e61

History | View | Annotate | Download (57.1 kB)

1 93d7ae8e Allen Kay
/*
2 93d7ae8e Allen Kay
 * Copyright (c) 2007, Neocleus Corporation.
3 93d7ae8e Allen Kay
 * Copyright (c) 2007, Intel Corporation.
4 93d7ae8e Allen Kay
 *
5 93d7ae8e Allen Kay
 * This work is licensed under the terms of the GNU GPL, version 2.  See
6 93d7ae8e Allen Kay
 * the COPYING file in the top-level directory.
7 93d7ae8e Allen Kay
 *
8 93d7ae8e Allen Kay
 * Alex Novik <alex@neocleus.com>
9 93d7ae8e Allen Kay
 * Allen Kay <allen.m.kay@intel.com>
10 93d7ae8e Allen Kay
 * Guy Zana <guy@neocleus.com>
11 93d7ae8e Allen Kay
 *
12 93d7ae8e Allen Kay
 * This file implements direct PCI assignment to a HVM guest
13 93d7ae8e Allen Kay
 */
14 93d7ae8e Allen Kay
15 93d7ae8e Allen Kay
#include "qemu-timer.h"
16 93d7ae8e Allen Kay
#include "xen_backend.h"
17 eaab4d60 Allen Kay
#include "xen_pt.h"
18 eaab4d60 Allen Kay
19 93d7ae8e Allen Kay
#define XEN_PT_MERGE_VALUE(value, data, val_mask) \
20 93d7ae8e Allen Kay
    (((value) & (val_mask)) | ((data) & ~(val_mask)))
21 93d7ae8e Allen Kay
22 93d7ae8e Allen Kay
#define XEN_PT_INVALID_REG          0xFFFFFFFF      /* invalid register value */
23 93d7ae8e Allen Kay
24 93d7ae8e Allen Kay
/* prototype */
25 93d7ae8e Allen Kay
26 93d7ae8e Allen Kay
static int xen_pt_ptr_reg_init(XenPCIPassthroughState *s, XenPTRegInfo *reg,
27 93d7ae8e Allen Kay
                               uint32_t real_offset, uint32_t *data);
28 93d7ae8e Allen Kay
29 93d7ae8e Allen Kay
30 93d7ae8e Allen Kay
/* helper */
31 93d7ae8e Allen Kay
32 93d7ae8e Allen Kay
/* A return value of 1 means the capability should NOT be exposed to guest. */
33 93d7ae8e Allen Kay
static int xen_pt_hide_dev_cap(const XenHostPCIDevice *d, uint8_t grp_id)
34 93d7ae8e Allen Kay
{
35 93d7ae8e Allen Kay
    switch (grp_id) {
36 93d7ae8e Allen Kay
    case PCI_CAP_ID_EXP:
37 93d7ae8e Allen Kay
        /* The PCI Express Capability Structure of the VF of Intel 82599 10GbE
38 93d7ae8e Allen Kay
         * Controller looks trivial, e.g., the PCI Express Capabilities
39 93d7ae8e Allen Kay
         * Register is 0. We should not try to expose it to guest.
40 93d7ae8e Allen Kay
         *
41 93d7ae8e Allen Kay
         * The datasheet is available at
42 93d7ae8e Allen Kay
         * http://download.intel.com/design/network/datashts/82599_datasheet.pdf
43 93d7ae8e Allen Kay
         *
44 93d7ae8e Allen Kay
         * See 'Table 9.7. VF PCIe Configuration Space' of the datasheet, the
45 93d7ae8e Allen Kay
         * PCI Express Capability Structure of the VF of Intel 82599 10GbE
46 93d7ae8e Allen Kay
         * Controller looks trivial, e.g., the PCI Express Capabilities
47 93d7ae8e Allen Kay
         * Register is 0, so the Capability Version is 0 and
48 93d7ae8e Allen Kay
         * xen_pt_pcie_size_init() would fail.
49 93d7ae8e Allen Kay
         */
50 93d7ae8e Allen Kay
        if (d->vendor_id == PCI_VENDOR_ID_INTEL &&
51 93d7ae8e Allen Kay
            d->device_id == PCI_DEVICE_ID_INTEL_82599_SFP_VF) {
52 93d7ae8e Allen Kay
            return 1;
53 93d7ae8e Allen Kay
        }
54 93d7ae8e Allen Kay
        break;
55 93d7ae8e Allen Kay
    }
56 93d7ae8e Allen Kay
    return 0;
57 93d7ae8e Allen Kay
}
58 93d7ae8e Allen Kay
59 93d7ae8e Allen Kay
/*   find emulate register group entry */
60 eaab4d60 Allen Kay
XenPTRegGroup *xen_pt_find_reg_grp(XenPCIPassthroughState *s, uint32_t address)
61 eaab4d60 Allen Kay
{
62 93d7ae8e Allen Kay
    XenPTRegGroup *entry = NULL;
63 93d7ae8e Allen Kay
64 93d7ae8e Allen Kay
    /* find register group entry */
65 93d7ae8e Allen Kay
    QLIST_FOREACH(entry, &s->reg_grps, entries) {
66 93d7ae8e Allen Kay
        /* check address */
67 93d7ae8e Allen Kay
        if ((entry->base_offset <= address)
68 93d7ae8e Allen Kay
            && ((entry->base_offset + entry->size) > address)) {
69 93d7ae8e Allen Kay
            return entry;
70 93d7ae8e Allen Kay
        }
71 93d7ae8e Allen Kay
    }
72 93d7ae8e Allen Kay
73 93d7ae8e Allen Kay
    /* group entry not found */
74 eaab4d60 Allen Kay
    return NULL;
75 eaab4d60 Allen Kay
}
76 eaab4d60 Allen Kay
77 93d7ae8e Allen Kay
/* find emulate register entry */
78 eaab4d60 Allen Kay
XenPTReg *xen_pt_find_reg(XenPTRegGroup *reg_grp, uint32_t address)
79 eaab4d60 Allen Kay
{
80 93d7ae8e Allen Kay
    XenPTReg *reg_entry = NULL;
81 93d7ae8e Allen Kay
    XenPTRegInfo *reg = NULL;
82 93d7ae8e Allen Kay
    uint32_t real_offset = 0;
83 93d7ae8e Allen Kay
84 93d7ae8e Allen Kay
    /* find register entry */
85 93d7ae8e Allen Kay
    QLIST_FOREACH(reg_entry, &reg_grp->reg_tbl_list, entries) {
86 93d7ae8e Allen Kay
        reg = reg_entry->reg;
87 93d7ae8e Allen Kay
        real_offset = reg_grp->base_offset + reg->offset;
88 93d7ae8e Allen Kay
        /* check address */
89 93d7ae8e Allen Kay
        if ((real_offset <= address)
90 93d7ae8e Allen Kay
            && ((real_offset + reg->size) > address)) {
91 93d7ae8e Allen Kay
            return reg_entry;
92 93d7ae8e Allen Kay
        }
93 93d7ae8e Allen Kay
    }
94 93d7ae8e Allen Kay
95 eaab4d60 Allen Kay
    return NULL;
96 eaab4d60 Allen Kay
}
97 93d7ae8e Allen Kay
98 93d7ae8e Allen Kay
99 93d7ae8e Allen Kay
/****************
100 93d7ae8e Allen Kay
 * general register functions
101 93d7ae8e Allen Kay
 */
102 93d7ae8e Allen Kay
103 93d7ae8e Allen Kay
/* register initialization function */
104 93d7ae8e Allen Kay
105 93d7ae8e Allen Kay
static int xen_pt_common_reg_init(XenPCIPassthroughState *s,
106 93d7ae8e Allen Kay
                                  XenPTRegInfo *reg, uint32_t real_offset,
107 93d7ae8e Allen Kay
                                  uint32_t *data)
108 93d7ae8e Allen Kay
{
109 93d7ae8e Allen Kay
    *data = reg->init_val;
110 93d7ae8e Allen Kay
    return 0;
111 93d7ae8e Allen Kay
}
112 93d7ae8e Allen Kay
113 93d7ae8e Allen Kay
/* Read register functions */
114 93d7ae8e Allen Kay
115 93d7ae8e Allen Kay
static int xen_pt_byte_reg_read(XenPCIPassthroughState *s, XenPTReg *cfg_entry,
116 93d7ae8e Allen Kay
                                uint8_t *value, uint8_t valid_mask)
117 93d7ae8e Allen Kay
{
118 93d7ae8e Allen Kay
    XenPTRegInfo *reg = cfg_entry->reg;
119 93d7ae8e Allen Kay
    uint8_t valid_emu_mask = 0;
120 93d7ae8e Allen Kay
121 93d7ae8e Allen Kay
    /* emulate byte register */
122 93d7ae8e Allen Kay
    valid_emu_mask = reg->emu_mask & valid_mask;
123 93d7ae8e Allen Kay
    *value = XEN_PT_MERGE_VALUE(*value, cfg_entry->data, ~valid_emu_mask);
124 93d7ae8e Allen Kay
125 93d7ae8e Allen Kay
    return 0;
126 93d7ae8e Allen Kay
}
127 93d7ae8e Allen Kay
static int xen_pt_word_reg_read(XenPCIPassthroughState *s, XenPTReg *cfg_entry,
128 93d7ae8e Allen Kay
                                uint16_t *value, uint16_t valid_mask)
129 93d7ae8e Allen Kay
{
130 93d7ae8e Allen Kay
    XenPTRegInfo *reg = cfg_entry->reg;
131 93d7ae8e Allen Kay
    uint16_t valid_emu_mask = 0;
132 93d7ae8e Allen Kay
133 93d7ae8e Allen Kay
    /* emulate word register */
134 93d7ae8e Allen Kay
    valid_emu_mask = reg->emu_mask & valid_mask;
135 93d7ae8e Allen Kay
    *value = XEN_PT_MERGE_VALUE(*value, cfg_entry->data, ~valid_emu_mask);
136 93d7ae8e Allen Kay
137 93d7ae8e Allen Kay
    return 0;
138 93d7ae8e Allen Kay
}
139 93d7ae8e Allen Kay
static int xen_pt_long_reg_read(XenPCIPassthroughState *s, XenPTReg *cfg_entry,
140 93d7ae8e Allen Kay
                                uint32_t *value, uint32_t valid_mask)
141 93d7ae8e Allen Kay
{
142 93d7ae8e Allen Kay
    XenPTRegInfo *reg = cfg_entry->reg;
143 93d7ae8e Allen Kay
    uint32_t valid_emu_mask = 0;
144 93d7ae8e Allen Kay
145 93d7ae8e Allen Kay
    /* emulate long register */
146 93d7ae8e Allen Kay
    valid_emu_mask = reg->emu_mask & valid_mask;
147 93d7ae8e Allen Kay
    *value = XEN_PT_MERGE_VALUE(*value, cfg_entry->data, ~valid_emu_mask);
148 93d7ae8e Allen Kay
149 93d7ae8e Allen Kay
    return 0;
150 93d7ae8e Allen Kay
}
151 93d7ae8e Allen Kay
152 93d7ae8e Allen Kay
/* Write register functions */
153 93d7ae8e Allen Kay
154 93d7ae8e Allen Kay
static int xen_pt_byte_reg_write(XenPCIPassthroughState *s, XenPTReg *cfg_entry,
155 93d7ae8e Allen Kay
                                 uint8_t *val, uint8_t dev_value,
156 93d7ae8e Allen Kay
                                 uint8_t valid_mask)
157 93d7ae8e Allen Kay
{
158 93d7ae8e Allen Kay
    XenPTRegInfo *reg = cfg_entry->reg;
159 93d7ae8e Allen Kay
    uint8_t writable_mask = 0;
160 93d7ae8e Allen Kay
    uint8_t throughable_mask = 0;
161 93d7ae8e Allen Kay
162 93d7ae8e Allen Kay
    /* modify emulate register */
163 93d7ae8e Allen Kay
    writable_mask = reg->emu_mask & ~reg->ro_mask & valid_mask;
164 93d7ae8e Allen Kay
    cfg_entry->data = XEN_PT_MERGE_VALUE(*val, cfg_entry->data, writable_mask);
165 93d7ae8e Allen Kay
166 93d7ae8e Allen Kay
    /* create value for writing to I/O device register */
167 93d7ae8e Allen Kay
    throughable_mask = ~reg->emu_mask & valid_mask;
168 93d7ae8e Allen Kay
    *val = XEN_PT_MERGE_VALUE(*val, dev_value, throughable_mask);
169 93d7ae8e Allen Kay
170 93d7ae8e Allen Kay
    return 0;
171 93d7ae8e Allen Kay
}
172 93d7ae8e Allen Kay
static int xen_pt_word_reg_write(XenPCIPassthroughState *s, XenPTReg *cfg_entry,
173 93d7ae8e Allen Kay
                                 uint16_t *val, uint16_t dev_value,
174 93d7ae8e Allen Kay
                                 uint16_t valid_mask)
175 93d7ae8e Allen Kay
{
176 93d7ae8e Allen Kay
    XenPTRegInfo *reg = cfg_entry->reg;
177 93d7ae8e Allen Kay
    uint16_t writable_mask = 0;
178 93d7ae8e Allen Kay
    uint16_t throughable_mask = 0;
179 93d7ae8e Allen Kay
180 93d7ae8e Allen Kay
    /* modify emulate register */
181 93d7ae8e Allen Kay
    writable_mask = reg->emu_mask & ~reg->ro_mask & valid_mask;
182 93d7ae8e Allen Kay
    cfg_entry->data = XEN_PT_MERGE_VALUE(*val, cfg_entry->data, writable_mask);
183 93d7ae8e Allen Kay
184 93d7ae8e Allen Kay
    /* create value for writing to I/O device register */
185 93d7ae8e Allen Kay
    throughable_mask = ~reg->emu_mask & valid_mask;
186 93d7ae8e Allen Kay
    *val = XEN_PT_MERGE_VALUE(*val, dev_value, throughable_mask);
187 93d7ae8e Allen Kay
188 93d7ae8e Allen Kay
    return 0;
189 93d7ae8e Allen Kay
}
190 93d7ae8e Allen Kay
static int xen_pt_long_reg_write(XenPCIPassthroughState *s, XenPTReg *cfg_entry,
191 93d7ae8e Allen Kay
                                 uint32_t *val, uint32_t dev_value,
192 93d7ae8e Allen Kay
                                 uint32_t valid_mask)
193 93d7ae8e Allen Kay
{
194 93d7ae8e Allen Kay
    XenPTRegInfo *reg = cfg_entry->reg;
195 93d7ae8e Allen Kay
    uint32_t writable_mask = 0;
196 93d7ae8e Allen Kay
    uint32_t throughable_mask = 0;
197 93d7ae8e Allen Kay
198 93d7ae8e Allen Kay
    /* modify emulate register */
199 93d7ae8e Allen Kay
    writable_mask = reg->emu_mask & ~reg->ro_mask & valid_mask;
200 93d7ae8e Allen Kay
    cfg_entry->data = XEN_PT_MERGE_VALUE(*val, cfg_entry->data, writable_mask);
201 93d7ae8e Allen Kay
202 93d7ae8e Allen Kay
    /* create value for writing to I/O device register */
203 93d7ae8e Allen Kay
    throughable_mask = ~reg->emu_mask & valid_mask;
204 93d7ae8e Allen Kay
    *val = XEN_PT_MERGE_VALUE(*val, dev_value, throughable_mask);
205 93d7ae8e Allen Kay
206 93d7ae8e Allen Kay
    return 0;
207 93d7ae8e Allen Kay
}
208 93d7ae8e Allen Kay
209 93d7ae8e Allen Kay
210 93d7ae8e Allen Kay
/* XenPTRegInfo declaration
211 93d7ae8e Allen Kay
 * - only for emulated register (either a part or whole bit).
212 93d7ae8e Allen Kay
 * - for passthrough register that need special behavior (like interacting with
213 93d7ae8e Allen Kay
 *   other component), set emu_mask to all 0 and specify r/w func properly.
214 93d7ae8e Allen Kay
 * - do NOT use ALL F for init_val, otherwise the tbl will not be registered.
215 93d7ae8e Allen Kay
 */
216 93d7ae8e Allen Kay
217 93d7ae8e Allen Kay
/********************
218 93d7ae8e Allen Kay
 * Header Type0
219 93d7ae8e Allen Kay
 */
220 93d7ae8e Allen Kay
221 93d7ae8e Allen Kay
static int xen_pt_vendor_reg_init(XenPCIPassthroughState *s,
222 93d7ae8e Allen Kay
                                  XenPTRegInfo *reg, uint32_t real_offset,
223 93d7ae8e Allen Kay
                                  uint32_t *data)
224 93d7ae8e Allen Kay
{
225 93d7ae8e Allen Kay
    *data = s->real_device.vendor_id;
226 93d7ae8e Allen Kay
    return 0;
227 93d7ae8e Allen Kay
}
228 93d7ae8e Allen Kay
static int xen_pt_device_reg_init(XenPCIPassthroughState *s,
229 93d7ae8e Allen Kay
                                  XenPTRegInfo *reg, uint32_t real_offset,
230 93d7ae8e Allen Kay
                                  uint32_t *data)
231 93d7ae8e Allen Kay
{
232 93d7ae8e Allen Kay
    *data = s->real_device.device_id;
233 93d7ae8e Allen Kay
    return 0;
234 93d7ae8e Allen Kay
}
235 93d7ae8e Allen Kay
static int xen_pt_status_reg_init(XenPCIPassthroughState *s,
236 93d7ae8e Allen Kay
                                  XenPTRegInfo *reg, uint32_t real_offset,
237 93d7ae8e Allen Kay
                                  uint32_t *data)
238 93d7ae8e Allen Kay
{
239 93d7ae8e Allen Kay
    XenPTRegGroup *reg_grp_entry = NULL;
240 93d7ae8e Allen Kay
    XenPTReg *reg_entry = NULL;
241 93d7ae8e Allen Kay
    uint32_t reg_field = 0;
242 93d7ae8e Allen Kay
243 93d7ae8e Allen Kay
    /* find Header register group */
244 93d7ae8e Allen Kay
    reg_grp_entry = xen_pt_find_reg_grp(s, PCI_CAPABILITY_LIST);
245 93d7ae8e Allen Kay
    if (reg_grp_entry) {
246 93d7ae8e Allen Kay
        /* find Capabilities Pointer register */
247 93d7ae8e Allen Kay
        reg_entry = xen_pt_find_reg(reg_grp_entry, PCI_CAPABILITY_LIST);
248 93d7ae8e Allen Kay
        if (reg_entry) {
249 93d7ae8e Allen Kay
            /* check Capabilities Pointer register */
250 93d7ae8e Allen Kay
            if (reg_entry->data) {
251 93d7ae8e Allen Kay
                reg_field |= PCI_STATUS_CAP_LIST;
252 93d7ae8e Allen Kay
            } else {
253 93d7ae8e Allen Kay
                reg_field &= ~PCI_STATUS_CAP_LIST;
254 93d7ae8e Allen Kay
            }
255 93d7ae8e Allen Kay
        } else {
256 93d7ae8e Allen Kay
            xen_shutdown_fatal_error("Internal error: Couldn't find XenPTReg*"
257 93d7ae8e Allen Kay
                                     " for Capabilities Pointer register."
258 93d7ae8e Allen Kay
                                     " (%s)\n", __func__);
259 93d7ae8e Allen Kay
            return -1;
260 93d7ae8e Allen Kay
        }
261 93d7ae8e Allen Kay
    } else {
262 93d7ae8e Allen Kay
        xen_shutdown_fatal_error("Internal error: Couldn't find XenPTRegGroup"
263 93d7ae8e Allen Kay
                                 " for Header. (%s)\n", __func__);
264 93d7ae8e Allen Kay
        return -1;
265 93d7ae8e Allen Kay
    }
266 93d7ae8e Allen Kay
267 93d7ae8e Allen Kay
    *data = reg_field;
268 93d7ae8e Allen Kay
    return 0;
269 93d7ae8e Allen Kay
}
270 93d7ae8e Allen Kay
static int xen_pt_header_type_reg_init(XenPCIPassthroughState *s,
271 93d7ae8e Allen Kay
                                       XenPTRegInfo *reg, uint32_t real_offset,
272 93d7ae8e Allen Kay
                                       uint32_t *data)
273 93d7ae8e Allen Kay
{
274 93d7ae8e Allen Kay
    /* read PCI_HEADER_TYPE */
275 93d7ae8e Allen Kay
    *data = reg->init_val | 0x80;
276 93d7ae8e Allen Kay
    return 0;
277 93d7ae8e Allen Kay
}
278 93d7ae8e Allen Kay
279 93d7ae8e Allen Kay
/* initialize Interrupt Pin register */
280 93d7ae8e Allen Kay
static int xen_pt_irqpin_reg_init(XenPCIPassthroughState *s,
281 93d7ae8e Allen Kay
                                  XenPTRegInfo *reg, uint32_t real_offset,
282 93d7ae8e Allen Kay
                                  uint32_t *data)
283 93d7ae8e Allen Kay
{
284 93d7ae8e Allen Kay
    *data = xen_pt_pci_read_intx(s);
285 93d7ae8e Allen Kay
    return 0;
286 93d7ae8e Allen Kay
}
287 93d7ae8e Allen Kay
288 93d7ae8e Allen Kay
/* Command register */
289 93d7ae8e Allen Kay
static int xen_pt_cmd_reg_read(XenPCIPassthroughState *s, XenPTReg *cfg_entry,
290 93d7ae8e Allen Kay
                               uint16_t *value, uint16_t valid_mask)
291 93d7ae8e Allen Kay
{
292 93d7ae8e Allen Kay
    XenPTRegInfo *reg = cfg_entry->reg;
293 93d7ae8e Allen Kay
    uint16_t valid_emu_mask = 0;
294 93d7ae8e Allen Kay
    uint16_t emu_mask = reg->emu_mask;
295 93d7ae8e Allen Kay
296 93d7ae8e Allen Kay
    if (s->is_virtfn) {
297 93d7ae8e Allen Kay
        emu_mask |= PCI_COMMAND_MEMORY;
298 93d7ae8e Allen Kay
    }
299 93d7ae8e Allen Kay
300 93d7ae8e Allen Kay
    /* emulate word register */
301 93d7ae8e Allen Kay
    valid_emu_mask = emu_mask & valid_mask;
302 93d7ae8e Allen Kay
    *value = XEN_PT_MERGE_VALUE(*value, cfg_entry->data, ~valid_emu_mask);
303 93d7ae8e Allen Kay
304 93d7ae8e Allen Kay
    return 0;
305 93d7ae8e Allen Kay
}
306 93d7ae8e Allen Kay
static int xen_pt_cmd_reg_write(XenPCIPassthroughState *s, XenPTReg *cfg_entry,
307 93d7ae8e Allen Kay
                                uint16_t *val, uint16_t dev_value,
308 93d7ae8e Allen Kay
                                uint16_t valid_mask)
309 93d7ae8e Allen Kay
{
310 93d7ae8e Allen Kay
    XenPTRegInfo *reg = cfg_entry->reg;
311 93d7ae8e Allen Kay
    uint16_t writable_mask = 0;
312 93d7ae8e Allen Kay
    uint16_t throughable_mask = 0;
313 93d7ae8e Allen Kay
    uint16_t emu_mask = reg->emu_mask;
314 93d7ae8e Allen Kay
315 93d7ae8e Allen Kay
    if (s->is_virtfn) {
316 93d7ae8e Allen Kay
        emu_mask |= PCI_COMMAND_MEMORY;
317 93d7ae8e Allen Kay
    }
318 93d7ae8e Allen Kay
319 93d7ae8e Allen Kay
    /* modify emulate register */
320 93d7ae8e Allen Kay
    writable_mask = ~reg->ro_mask & valid_mask;
321 93d7ae8e Allen Kay
    cfg_entry->data = XEN_PT_MERGE_VALUE(*val, cfg_entry->data, writable_mask);
322 93d7ae8e Allen Kay
323 93d7ae8e Allen Kay
    /* create value for writing to I/O device register */
324 93d7ae8e Allen Kay
    throughable_mask = ~emu_mask & valid_mask;
325 93d7ae8e Allen Kay
326 93d7ae8e Allen Kay
    if (*val & PCI_COMMAND_INTX_DISABLE) {
327 93d7ae8e Allen Kay
        throughable_mask |= PCI_COMMAND_INTX_DISABLE;
328 93d7ae8e Allen Kay
    } else {
329 93d7ae8e Allen Kay
        if (s->machine_irq) {
330 93d7ae8e Allen Kay
            throughable_mask |= PCI_COMMAND_INTX_DISABLE;
331 93d7ae8e Allen Kay
        }
332 93d7ae8e Allen Kay
    }
333 93d7ae8e Allen Kay
334 93d7ae8e Allen Kay
    *val = XEN_PT_MERGE_VALUE(*val, dev_value, throughable_mask);
335 93d7ae8e Allen Kay
336 93d7ae8e Allen Kay
    return 0;
337 93d7ae8e Allen Kay
}
338 93d7ae8e Allen Kay
339 93d7ae8e Allen Kay
/* BAR */
340 93d7ae8e Allen Kay
#define XEN_PT_BAR_MEM_RO_MASK    0x0000000F  /* BAR ReadOnly mask(Memory) */
341 93d7ae8e Allen Kay
#define XEN_PT_BAR_MEM_EMU_MASK   0xFFFFFFF0  /* BAR emul mask(Memory) */
342 93d7ae8e Allen Kay
#define XEN_PT_BAR_IO_RO_MASK     0x00000003  /* BAR ReadOnly mask(I/O) */
343 93d7ae8e Allen Kay
#define XEN_PT_BAR_IO_EMU_MASK    0xFFFFFFFC  /* BAR emul mask(I/O) */
344 93d7ae8e Allen Kay
345 93d7ae8e Allen Kay
static XenPTBarFlag xen_pt_bar_reg_parse(XenPCIPassthroughState *s,
346 93d7ae8e Allen Kay
                                         XenPTRegInfo *reg)
347 93d7ae8e Allen Kay
{
348 93d7ae8e Allen Kay
    PCIDevice *d = &s->dev;
349 93d7ae8e Allen Kay
    XenPTRegion *region = NULL;
350 93d7ae8e Allen Kay
    PCIIORegion *r;
351 93d7ae8e Allen Kay
    int index = 0;
352 93d7ae8e Allen Kay
353 93d7ae8e Allen Kay
    /* check 64bit BAR */
354 93d7ae8e Allen Kay
    index = xen_pt_bar_offset_to_index(reg->offset);
355 93d7ae8e Allen Kay
    if ((0 < index) && (index < PCI_ROM_SLOT)) {
356 93d7ae8e Allen Kay
        int type = s->real_device.io_regions[index - 1].type;
357 93d7ae8e Allen Kay
358 93d7ae8e Allen Kay
        if ((type & XEN_HOST_PCI_REGION_TYPE_MEM)
359 93d7ae8e Allen Kay
            && (type & XEN_HOST_PCI_REGION_TYPE_MEM_64)) {
360 93d7ae8e Allen Kay
            region = &s->bases[index - 1];
361 93d7ae8e Allen Kay
            if (region->bar_flag != XEN_PT_BAR_FLAG_UPPER) {
362 93d7ae8e Allen Kay
                return XEN_PT_BAR_FLAG_UPPER;
363 93d7ae8e Allen Kay
            }
364 93d7ae8e Allen Kay
        }
365 93d7ae8e Allen Kay
    }
366 93d7ae8e Allen Kay
367 93d7ae8e Allen Kay
    /* check unused BAR */
368 93d7ae8e Allen Kay
    r = &d->io_regions[index];
369 93d7ae8e Allen Kay
    if (r->size == 0) {
370 93d7ae8e Allen Kay
        return XEN_PT_BAR_FLAG_UNUSED;
371 93d7ae8e Allen Kay
    }
372 93d7ae8e Allen Kay
373 93d7ae8e Allen Kay
    /* for ExpROM BAR */
374 93d7ae8e Allen Kay
    if (index == PCI_ROM_SLOT) {
375 93d7ae8e Allen Kay
        return XEN_PT_BAR_FLAG_MEM;
376 93d7ae8e Allen Kay
    }
377 93d7ae8e Allen Kay
378 93d7ae8e Allen Kay
    /* check BAR I/O indicator */
379 93d7ae8e Allen Kay
    if (s->real_device.io_regions[index].type & XEN_HOST_PCI_REGION_TYPE_IO) {
380 93d7ae8e Allen Kay
        return XEN_PT_BAR_FLAG_IO;
381 93d7ae8e Allen Kay
    } else {
382 93d7ae8e Allen Kay
        return XEN_PT_BAR_FLAG_MEM;
383 93d7ae8e Allen Kay
    }
384 93d7ae8e Allen Kay
}
385 93d7ae8e Allen Kay
386 93d7ae8e Allen Kay
static inline uint32_t base_address_with_flags(XenHostPCIIORegion *hr)
387 93d7ae8e Allen Kay
{
388 93d7ae8e Allen Kay
    if (hr->type & XEN_HOST_PCI_REGION_TYPE_IO) {
389 93d7ae8e Allen Kay
        return hr->base_addr | (hr->bus_flags & ~PCI_BASE_ADDRESS_IO_MASK);
390 93d7ae8e Allen Kay
    } else {
391 93d7ae8e Allen Kay
        return hr->base_addr | (hr->bus_flags & ~PCI_BASE_ADDRESS_MEM_MASK);
392 93d7ae8e Allen Kay
    }
393 93d7ae8e Allen Kay
}
394 93d7ae8e Allen Kay
395 93d7ae8e Allen Kay
static int xen_pt_bar_reg_init(XenPCIPassthroughState *s, XenPTRegInfo *reg,
396 93d7ae8e Allen Kay
                               uint32_t real_offset, uint32_t *data)
397 93d7ae8e Allen Kay
{
398 93d7ae8e Allen Kay
    uint32_t reg_field = 0;
399 93d7ae8e Allen Kay
    int index;
400 93d7ae8e Allen Kay
401 93d7ae8e Allen Kay
    index = xen_pt_bar_offset_to_index(reg->offset);
402 93d7ae8e Allen Kay
    if (index < 0 || index >= PCI_NUM_REGIONS) {
403 93d7ae8e Allen Kay
        XEN_PT_ERR(&s->dev, "Internal error: Invalid BAR index [%d].\n", index);
404 93d7ae8e Allen Kay
        return -1;
405 93d7ae8e Allen Kay
    }
406 93d7ae8e Allen Kay
407 93d7ae8e Allen Kay
    /* set BAR flag */
408 93d7ae8e Allen Kay
    s->bases[index].bar_flag = xen_pt_bar_reg_parse(s, reg);
409 93d7ae8e Allen Kay
    if (s->bases[index].bar_flag == XEN_PT_BAR_FLAG_UNUSED) {
410 93d7ae8e Allen Kay
        reg_field = XEN_PT_INVALID_REG;
411 93d7ae8e Allen Kay
    }
412 93d7ae8e Allen Kay
413 93d7ae8e Allen Kay
    *data = reg_field;
414 93d7ae8e Allen Kay
    return 0;
415 93d7ae8e Allen Kay
}
416 93d7ae8e Allen Kay
static int xen_pt_bar_reg_read(XenPCIPassthroughState *s, XenPTReg *cfg_entry,
417 93d7ae8e Allen Kay
                               uint32_t *value, uint32_t valid_mask)
418 93d7ae8e Allen Kay
{
419 93d7ae8e Allen Kay
    XenPTRegInfo *reg = cfg_entry->reg;
420 93d7ae8e Allen Kay
    uint32_t valid_emu_mask = 0;
421 93d7ae8e Allen Kay
    uint32_t bar_emu_mask = 0;
422 93d7ae8e Allen Kay
    int index;
423 93d7ae8e Allen Kay
424 93d7ae8e Allen Kay
    /* get BAR index */
425 93d7ae8e Allen Kay
    index = xen_pt_bar_offset_to_index(reg->offset);
426 93d7ae8e Allen Kay
    if (index < 0 || index >= PCI_NUM_REGIONS) {
427 93d7ae8e Allen Kay
        XEN_PT_ERR(&s->dev, "Internal error: Invalid BAR index [%d].\n", index);
428 93d7ae8e Allen Kay
        return -1;
429 93d7ae8e Allen Kay
    }
430 93d7ae8e Allen Kay
431 93d7ae8e Allen Kay
    /* use fixed-up value from kernel sysfs */
432 93d7ae8e Allen Kay
    *value = base_address_with_flags(&s->real_device.io_regions[index]);
433 93d7ae8e Allen Kay
434 93d7ae8e Allen Kay
    /* set emulate mask depend on BAR flag */
435 93d7ae8e Allen Kay
    switch (s->bases[index].bar_flag) {
436 93d7ae8e Allen Kay
    case XEN_PT_BAR_FLAG_MEM:
437 93d7ae8e Allen Kay
        bar_emu_mask = XEN_PT_BAR_MEM_EMU_MASK;
438 93d7ae8e Allen Kay
        break;
439 93d7ae8e Allen Kay
    case XEN_PT_BAR_FLAG_IO:
440 93d7ae8e Allen Kay
        bar_emu_mask = XEN_PT_BAR_IO_EMU_MASK;
441 93d7ae8e Allen Kay
        break;
442 93d7ae8e Allen Kay
    case XEN_PT_BAR_FLAG_UPPER:
443 93d7ae8e Allen Kay
        bar_emu_mask = XEN_PT_BAR_ALLF;
444 93d7ae8e Allen Kay
        break;
445 93d7ae8e Allen Kay
    default:
446 93d7ae8e Allen Kay
        break;
447 93d7ae8e Allen Kay
    }
448 93d7ae8e Allen Kay
449 93d7ae8e Allen Kay
    /* emulate BAR */
450 93d7ae8e Allen Kay
    valid_emu_mask = bar_emu_mask & valid_mask;
451 93d7ae8e Allen Kay
    *value = XEN_PT_MERGE_VALUE(*value, cfg_entry->data, ~valid_emu_mask);
452 93d7ae8e Allen Kay
453 93d7ae8e Allen Kay
    return 0;
454 93d7ae8e Allen Kay
}
455 93d7ae8e Allen Kay
static int xen_pt_bar_reg_write(XenPCIPassthroughState *s, XenPTReg *cfg_entry,
456 93d7ae8e Allen Kay
                                uint32_t *val, uint32_t dev_value,
457 93d7ae8e Allen Kay
                                uint32_t valid_mask)
458 93d7ae8e Allen Kay
{
459 93d7ae8e Allen Kay
    XenPTRegInfo *reg = cfg_entry->reg;
460 93d7ae8e Allen Kay
    XenPTRegion *base = NULL;
461 93d7ae8e Allen Kay
    PCIDevice *d = &s->dev;
462 93d7ae8e Allen Kay
    const PCIIORegion *r;
463 93d7ae8e Allen Kay
    uint32_t writable_mask = 0;
464 93d7ae8e Allen Kay
    uint32_t throughable_mask = 0;
465 93d7ae8e Allen Kay
    uint32_t bar_emu_mask = 0;
466 93d7ae8e Allen Kay
    uint32_t bar_ro_mask = 0;
467 93d7ae8e Allen Kay
    uint32_t r_size = 0;
468 93d7ae8e Allen Kay
    int index = 0;
469 93d7ae8e Allen Kay
470 93d7ae8e Allen Kay
    index = xen_pt_bar_offset_to_index(reg->offset);
471 93d7ae8e Allen Kay
    if (index < 0 || index >= PCI_NUM_REGIONS) {
472 93d7ae8e Allen Kay
        XEN_PT_ERR(d, "Internal error: Invalid BAR index [%d].\n", index);
473 93d7ae8e Allen Kay
        return -1;
474 93d7ae8e Allen Kay
    }
475 93d7ae8e Allen Kay
476 93d7ae8e Allen Kay
    r = &d->io_regions[index];
477 93d7ae8e Allen Kay
    base = &s->bases[index];
478 93d7ae8e Allen Kay
    r_size = xen_pt_get_emul_size(base->bar_flag, r->size);
479 93d7ae8e Allen Kay
480 93d7ae8e Allen Kay
    /* set emulate mask and read-only mask values depend on the BAR flag */
481 93d7ae8e Allen Kay
    switch (s->bases[index].bar_flag) {
482 93d7ae8e Allen Kay
    case XEN_PT_BAR_FLAG_MEM:
483 93d7ae8e Allen Kay
        bar_emu_mask = XEN_PT_BAR_MEM_EMU_MASK;
484 93d7ae8e Allen Kay
        bar_ro_mask = XEN_PT_BAR_MEM_RO_MASK | (r_size - 1);
485 93d7ae8e Allen Kay
        break;
486 93d7ae8e Allen Kay
    case XEN_PT_BAR_FLAG_IO:
487 93d7ae8e Allen Kay
        bar_emu_mask = XEN_PT_BAR_IO_EMU_MASK;
488 93d7ae8e Allen Kay
        bar_ro_mask = XEN_PT_BAR_IO_RO_MASK | (r_size - 1);
489 93d7ae8e Allen Kay
        break;
490 93d7ae8e Allen Kay
    case XEN_PT_BAR_FLAG_UPPER:
491 93d7ae8e Allen Kay
        bar_emu_mask = XEN_PT_BAR_ALLF;
492 93d7ae8e Allen Kay
        bar_ro_mask = 0;    /* all upper 32bit are R/W */
493 93d7ae8e Allen Kay
        break;
494 93d7ae8e Allen Kay
    default:
495 93d7ae8e Allen Kay
        break;
496 93d7ae8e Allen Kay
    }
497 93d7ae8e Allen Kay
498 93d7ae8e Allen Kay
    /* modify emulate register */
499 93d7ae8e Allen Kay
    writable_mask = bar_emu_mask & ~bar_ro_mask & valid_mask;
500 93d7ae8e Allen Kay
    cfg_entry->data = XEN_PT_MERGE_VALUE(*val, cfg_entry->data, writable_mask);
501 93d7ae8e Allen Kay
502 93d7ae8e Allen Kay
    /* check whether we need to update the virtual region address or not */
503 93d7ae8e Allen Kay
    switch (s->bases[index].bar_flag) {
504 93d7ae8e Allen Kay
    case XEN_PT_BAR_FLAG_MEM:
505 93d7ae8e Allen Kay
        /* nothing to do */
506 93d7ae8e Allen Kay
        break;
507 93d7ae8e Allen Kay
    case XEN_PT_BAR_FLAG_IO:
508 93d7ae8e Allen Kay
        /* nothing to do */
509 93d7ae8e Allen Kay
        break;
510 93d7ae8e Allen Kay
    case XEN_PT_BAR_FLAG_UPPER:
511 93d7ae8e Allen Kay
        if (cfg_entry->data) {
512 93d7ae8e Allen Kay
            if (cfg_entry->data != (XEN_PT_BAR_ALLF & ~bar_ro_mask)) {
513 93d7ae8e Allen Kay
                XEN_PT_WARN(d, "Guest attempt to set high MMIO Base Address. "
514 93d7ae8e Allen Kay
                            "Ignore mapping. "
515 93d7ae8e Allen Kay
                            "(offset: 0x%02x, high address: 0x%08x)\n",
516 93d7ae8e Allen Kay
                            reg->offset, cfg_entry->data);
517 93d7ae8e Allen Kay
            }
518 93d7ae8e Allen Kay
        }
519 93d7ae8e Allen Kay
        break;
520 93d7ae8e Allen Kay
    default:
521 93d7ae8e Allen Kay
        break;
522 93d7ae8e Allen Kay
    }
523 93d7ae8e Allen Kay
524 93d7ae8e Allen Kay
    /* create value for writing to I/O device register */
525 93d7ae8e Allen Kay
    throughable_mask = ~bar_emu_mask & valid_mask;
526 93d7ae8e Allen Kay
    *val = XEN_PT_MERGE_VALUE(*val, dev_value, throughable_mask);
527 93d7ae8e Allen Kay
528 93d7ae8e Allen Kay
    return 0;
529 93d7ae8e Allen Kay
}
530 93d7ae8e Allen Kay
531 93d7ae8e Allen Kay
/* write Exp ROM BAR */
532 93d7ae8e Allen Kay
static int xen_pt_exp_rom_bar_reg_write(XenPCIPassthroughState *s,
533 93d7ae8e Allen Kay
                                        XenPTReg *cfg_entry, uint32_t *val,
534 93d7ae8e Allen Kay
                                        uint32_t dev_value, uint32_t valid_mask)
535 93d7ae8e Allen Kay
{
536 93d7ae8e Allen Kay
    XenPTRegInfo *reg = cfg_entry->reg;
537 93d7ae8e Allen Kay
    XenPTRegion *base = NULL;
538 93d7ae8e Allen Kay
    PCIDevice *d = (PCIDevice *)&s->dev;
539 93d7ae8e Allen Kay
    uint32_t writable_mask = 0;
540 93d7ae8e Allen Kay
    uint32_t throughable_mask = 0;
541 93d7ae8e Allen Kay
    pcibus_t r_size = 0;
542 93d7ae8e Allen Kay
    uint32_t bar_emu_mask = 0;
543 93d7ae8e Allen Kay
    uint32_t bar_ro_mask = 0;
544 93d7ae8e Allen Kay
545 93d7ae8e Allen Kay
    r_size = d->io_regions[PCI_ROM_SLOT].size;
546 93d7ae8e Allen Kay
    base = &s->bases[PCI_ROM_SLOT];
547 93d7ae8e Allen Kay
    /* align memory type resource size */
548 93d7ae8e Allen Kay
    r_size = xen_pt_get_emul_size(base->bar_flag, r_size);
549 93d7ae8e Allen Kay
550 93d7ae8e Allen Kay
    /* set emulate mask and read-only mask */
551 93d7ae8e Allen Kay
    bar_emu_mask = reg->emu_mask;
552 93d7ae8e Allen Kay
    bar_ro_mask = (reg->ro_mask | (r_size - 1)) & ~PCI_ROM_ADDRESS_ENABLE;
553 93d7ae8e Allen Kay
554 93d7ae8e Allen Kay
    /* modify emulate register */
555 93d7ae8e Allen Kay
    writable_mask = ~bar_ro_mask & valid_mask;
556 93d7ae8e Allen Kay
    cfg_entry->data = XEN_PT_MERGE_VALUE(*val, cfg_entry->data, writable_mask);
557 93d7ae8e Allen Kay
558 93d7ae8e Allen Kay
    /* create value for writing to I/O device register */
559 93d7ae8e Allen Kay
    throughable_mask = ~bar_emu_mask & valid_mask;
560 93d7ae8e Allen Kay
    *val = XEN_PT_MERGE_VALUE(*val, dev_value, throughable_mask);
561 93d7ae8e Allen Kay
562 93d7ae8e Allen Kay
    return 0;
563 93d7ae8e Allen Kay
}
564 93d7ae8e Allen Kay
565 93d7ae8e Allen Kay
/* Header Type0 reg static infomation table */
566 93d7ae8e Allen Kay
static XenPTRegInfo xen_pt_emu_reg_header0[] = {
567 93d7ae8e Allen Kay
    /* Vendor ID reg */
568 93d7ae8e Allen Kay
    {
569 93d7ae8e Allen Kay
        .offset     = PCI_VENDOR_ID,
570 93d7ae8e Allen Kay
        .size       = 2,
571 93d7ae8e Allen Kay
        .init_val   = 0x0000,
572 93d7ae8e Allen Kay
        .ro_mask    = 0xFFFF,
573 93d7ae8e Allen Kay
        .emu_mask   = 0xFFFF,
574 93d7ae8e Allen Kay
        .init       = xen_pt_vendor_reg_init,
575 93d7ae8e Allen Kay
        .u.w.read   = xen_pt_word_reg_read,
576 93d7ae8e Allen Kay
        .u.w.write  = xen_pt_word_reg_write,
577 93d7ae8e Allen Kay
    },
578 93d7ae8e Allen Kay
    /* Device ID reg */
579 93d7ae8e Allen Kay
    {
580 93d7ae8e Allen Kay
        .offset     = PCI_DEVICE_ID,
581 93d7ae8e Allen Kay
        .size       = 2,
582 93d7ae8e Allen Kay
        .init_val   = 0x0000,
583 93d7ae8e Allen Kay
        .ro_mask    = 0xFFFF,
584 93d7ae8e Allen Kay
        .emu_mask   = 0xFFFF,
585 93d7ae8e Allen Kay
        .init       = xen_pt_device_reg_init,
586 93d7ae8e Allen Kay
        .u.w.read   = xen_pt_word_reg_read,
587 93d7ae8e Allen Kay
        .u.w.write  = xen_pt_word_reg_write,
588 93d7ae8e Allen Kay
    },
589 93d7ae8e Allen Kay
    /* Command reg */
590 93d7ae8e Allen Kay
    {
591 93d7ae8e Allen Kay
        .offset     = PCI_COMMAND,
592 93d7ae8e Allen Kay
        .size       = 2,
593 93d7ae8e Allen Kay
        .init_val   = 0x0000,
594 93d7ae8e Allen Kay
        .ro_mask    = 0xF880,
595 93d7ae8e Allen Kay
        .emu_mask   = 0x0740,
596 93d7ae8e Allen Kay
        .init       = xen_pt_common_reg_init,
597 93d7ae8e Allen Kay
        .u.w.read   = xen_pt_cmd_reg_read,
598 93d7ae8e Allen Kay
        .u.w.write  = xen_pt_cmd_reg_write,
599 93d7ae8e Allen Kay
    },
600 93d7ae8e Allen Kay
    /* Capabilities Pointer reg */
601 93d7ae8e Allen Kay
    {
602 93d7ae8e Allen Kay
        .offset     = PCI_CAPABILITY_LIST,
603 93d7ae8e Allen Kay
        .size       = 1,
604 93d7ae8e Allen Kay
        .init_val   = 0x00,
605 93d7ae8e Allen Kay
        .ro_mask    = 0xFF,
606 93d7ae8e Allen Kay
        .emu_mask   = 0xFF,
607 93d7ae8e Allen Kay
        .init       = xen_pt_ptr_reg_init,
608 93d7ae8e Allen Kay
        .u.b.read   = xen_pt_byte_reg_read,
609 93d7ae8e Allen Kay
        .u.b.write  = xen_pt_byte_reg_write,
610 93d7ae8e Allen Kay
    },
611 93d7ae8e Allen Kay
    /* Status reg */
612 93d7ae8e Allen Kay
    /* use emulated Cap Ptr value to initialize,
613 93d7ae8e Allen Kay
     * so need to be declared after Cap Ptr reg
614 93d7ae8e Allen Kay
     */
615 93d7ae8e Allen Kay
    {
616 93d7ae8e Allen Kay
        .offset     = PCI_STATUS,
617 93d7ae8e Allen Kay
        .size       = 2,
618 93d7ae8e Allen Kay
        .init_val   = 0x0000,
619 93d7ae8e Allen Kay
        .ro_mask    = 0x06FF,
620 93d7ae8e Allen Kay
        .emu_mask   = 0x0010,
621 93d7ae8e Allen Kay
        .init       = xen_pt_status_reg_init,
622 93d7ae8e Allen Kay
        .u.w.read   = xen_pt_word_reg_read,
623 93d7ae8e Allen Kay
        .u.w.write  = xen_pt_word_reg_write,
624 93d7ae8e Allen Kay
    },
625 93d7ae8e Allen Kay
    /* Cache Line Size reg */
626 93d7ae8e Allen Kay
    {
627 93d7ae8e Allen Kay
        .offset     = PCI_CACHE_LINE_SIZE,
628 93d7ae8e Allen Kay
        .size       = 1,
629 93d7ae8e Allen Kay
        .init_val   = 0x00,
630 93d7ae8e Allen Kay
        .ro_mask    = 0x00,
631 93d7ae8e Allen Kay
        .emu_mask   = 0xFF,
632 93d7ae8e Allen Kay
        .init       = xen_pt_common_reg_init,
633 93d7ae8e Allen Kay
        .u.b.read   = xen_pt_byte_reg_read,
634 93d7ae8e Allen Kay
        .u.b.write  = xen_pt_byte_reg_write,
635 93d7ae8e Allen Kay
    },
636 93d7ae8e Allen Kay
    /* Latency Timer reg */
637 93d7ae8e Allen Kay
    {
638 93d7ae8e Allen Kay
        .offset     = PCI_LATENCY_TIMER,
639 93d7ae8e Allen Kay
        .size       = 1,
640 93d7ae8e Allen Kay
        .init_val   = 0x00,
641 93d7ae8e Allen Kay
        .ro_mask    = 0x00,
642 93d7ae8e Allen Kay
        .emu_mask   = 0xFF,
643 93d7ae8e Allen Kay
        .init       = xen_pt_common_reg_init,
644 93d7ae8e Allen Kay
        .u.b.read   = xen_pt_byte_reg_read,
645 93d7ae8e Allen Kay
        .u.b.write  = xen_pt_byte_reg_write,
646 93d7ae8e Allen Kay
    },
647 93d7ae8e Allen Kay
    /* Header Type reg */
648 93d7ae8e Allen Kay
    {
649 93d7ae8e Allen Kay
        .offset     = PCI_HEADER_TYPE,
650 93d7ae8e Allen Kay
        .size       = 1,
651 93d7ae8e Allen Kay
        .init_val   = 0x00,
652 93d7ae8e Allen Kay
        .ro_mask    = 0xFF,
653 93d7ae8e Allen Kay
        .emu_mask   = 0x00,
654 93d7ae8e Allen Kay
        .init       = xen_pt_header_type_reg_init,
655 93d7ae8e Allen Kay
        .u.b.read   = xen_pt_byte_reg_read,
656 93d7ae8e Allen Kay
        .u.b.write  = xen_pt_byte_reg_write,
657 93d7ae8e Allen Kay
    },
658 93d7ae8e Allen Kay
    /* Interrupt Line reg */
659 93d7ae8e Allen Kay
    {
660 93d7ae8e Allen Kay
        .offset     = PCI_INTERRUPT_LINE,
661 93d7ae8e Allen Kay
        .size       = 1,
662 93d7ae8e Allen Kay
        .init_val   = 0x00,
663 93d7ae8e Allen Kay
        .ro_mask    = 0x00,
664 93d7ae8e Allen Kay
        .emu_mask   = 0xFF,
665 93d7ae8e Allen Kay
        .init       = xen_pt_common_reg_init,
666 93d7ae8e Allen Kay
        .u.b.read   = xen_pt_byte_reg_read,
667 93d7ae8e Allen Kay
        .u.b.write  = xen_pt_byte_reg_write,
668 93d7ae8e Allen Kay
    },
669 93d7ae8e Allen Kay
    /* Interrupt Pin reg */
670 93d7ae8e Allen Kay
    {
671 93d7ae8e Allen Kay
        .offset     = PCI_INTERRUPT_PIN,
672 93d7ae8e Allen Kay
        .size       = 1,
673 93d7ae8e Allen Kay
        .init_val   = 0x00,
674 93d7ae8e Allen Kay
        .ro_mask    = 0xFF,
675 93d7ae8e Allen Kay
        .emu_mask   = 0xFF,
676 93d7ae8e Allen Kay
        .init       = xen_pt_irqpin_reg_init,
677 93d7ae8e Allen Kay
        .u.b.read   = xen_pt_byte_reg_read,
678 93d7ae8e Allen Kay
        .u.b.write  = xen_pt_byte_reg_write,
679 93d7ae8e Allen Kay
    },
680 93d7ae8e Allen Kay
    /* BAR 0 reg */
681 93d7ae8e Allen Kay
    /* mask of BAR need to be decided later, depends on IO/MEM type */
682 93d7ae8e Allen Kay
    {
683 93d7ae8e Allen Kay
        .offset     = PCI_BASE_ADDRESS_0,
684 93d7ae8e Allen Kay
        .size       = 4,
685 93d7ae8e Allen Kay
        .init_val   = 0x00000000,
686 93d7ae8e Allen Kay
        .init       = xen_pt_bar_reg_init,
687 93d7ae8e Allen Kay
        .u.dw.read  = xen_pt_bar_reg_read,
688 93d7ae8e Allen Kay
        .u.dw.write = xen_pt_bar_reg_write,
689 93d7ae8e Allen Kay
    },
690 93d7ae8e Allen Kay
    /* BAR 1 reg */
691 93d7ae8e Allen Kay
    {
692 93d7ae8e Allen Kay
        .offset     = PCI_BASE_ADDRESS_1,
693 93d7ae8e Allen Kay
        .size       = 4,
694 93d7ae8e Allen Kay
        .init_val   = 0x00000000,
695 93d7ae8e Allen Kay
        .init       = xen_pt_bar_reg_init,
696 93d7ae8e Allen Kay
        .u.dw.read  = xen_pt_bar_reg_read,
697 93d7ae8e Allen Kay
        .u.dw.write = xen_pt_bar_reg_write,
698 93d7ae8e Allen Kay
    },
699 93d7ae8e Allen Kay
    /* BAR 2 reg */
700 93d7ae8e Allen Kay
    {
701 93d7ae8e Allen Kay
        .offset     = PCI_BASE_ADDRESS_2,
702 93d7ae8e Allen Kay
        .size       = 4,
703 93d7ae8e Allen Kay
        .init_val   = 0x00000000,
704 93d7ae8e Allen Kay
        .init       = xen_pt_bar_reg_init,
705 93d7ae8e Allen Kay
        .u.dw.read  = xen_pt_bar_reg_read,
706 93d7ae8e Allen Kay
        .u.dw.write = xen_pt_bar_reg_write,
707 93d7ae8e Allen Kay
    },
708 93d7ae8e Allen Kay
    /* BAR 3 reg */
709 93d7ae8e Allen Kay
    {
710 93d7ae8e Allen Kay
        .offset     = PCI_BASE_ADDRESS_3,
711 93d7ae8e Allen Kay
        .size       = 4,
712 93d7ae8e Allen Kay
        .init_val   = 0x00000000,
713 93d7ae8e Allen Kay
        .init       = xen_pt_bar_reg_init,
714 93d7ae8e Allen Kay
        .u.dw.read  = xen_pt_bar_reg_read,
715 93d7ae8e Allen Kay
        .u.dw.write = xen_pt_bar_reg_write,
716 93d7ae8e Allen Kay
    },
717 93d7ae8e Allen Kay
    /* BAR 4 reg */
718 93d7ae8e Allen Kay
    {
719 93d7ae8e Allen Kay
        .offset     = PCI_BASE_ADDRESS_4,
720 93d7ae8e Allen Kay
        .size       = 4,
721 93d7ae8e Allen Kay
        .init_val   = 0x00000000,
722 93d7ae8e Allen Kay
        .init       = xen_pt_bar_reg_init,
723 93d7ae8e Allen Kay
        .u.dw.read  = xen_pt_bar_reg_read,
724 93d7ae8e Allen Kay
        .u.dw.write = xen_pt_bar_reg_write,
725 93d7ae8e Allen Kay
    },
726 93d7ae8e Allen Kay
    /* BAR 5 reg */
727 93d7ae8e Allen Kay
    {
728 93d7ae8e Allen Kay
        .offset     = PCI_BASE_ADDRESS_5,
729 93d7ae8e Allen Kay
        .size       = 4,
730 93d7ae8e Allen Kay
        .init_val   = 0x00000000,
731 93d7ae8e Allen Kay
        .init       = xen_pt_bar_reg_init,
732 93d7ae8e Allen Kay
        .u.dw.read  = xen_pt_bar_reg_read,
733 93d7ae8e Allen Kay
        .u.dw.write = xen_pt_bar_reg_write,
734 93d7ae8e Allen Kay
    },
735 93d7ae8e Allen Kay
    /* Expansion ROM BAR reg */
736 93d7ae8e Allen Kay
    {
737 93d7ae8e Allen Kay
        .offset     = PCI_ROM_ADDRESS,
738 93d7ae8e Allen Kay
        .size       = 4,
739 93d7ae8e Allen Kay
        .init_val   = 0x00000000,
740 93d7ae8e Allen Kay
        .ro_mask    = 0x000007FE,
741 93d7ae8e Allen Kay
        .emu_mask   = 0xFFFFF800,
742 93d7ae8e Allen Kay
        .init       = xen_pt_bar_reg_init,
743 93d7ae8e Allen Kay
        .u.dw.read  = xen_pt_long_reg_read,
744 93d7ae8e Allen Kay
        .u.dw.write = xen_pt_exp_rom_bar_reg_write,
745 93d7ae8e Allen Kay
    },
746 93d7ae8e Allen Kay
    {
747 93d7ae8e Allen Kay
        .size = 0,
748 93d7ae8e Allen Kay
    },
749 93d7ae8e Allen Kay
};
750 93d7ae8e Allen Kay
751 93d7ae8e Allen Kay
752 93d7ae8e Allen Kay
/*********************************
753 93d7ae8e Allen Kay
 * Vital Product Data Capability
754 93d7ae8e Allen Kay
 */
755 93d7ae8e Allen Kay
756 93d7ae8e Allen Kay
/* Vital Product Data Capability Structure reg static infomation table */
757 93d7ae8e Allen Kay
static XenPTRegInfo xen_pt_emu_reg_vpd[] = {
758 93d7ae8e Allen Kay
    {
759 93d7ae8e Allen Kay
        .offset     = PCI_CAP_LIST_NEXT,
760 93d7ae8e Allen Kay
        .size       = 1,
761 93d7ae8e Allen Kay
        .init_val   = 0x00,
762 93d7ae8e Allen Kay
        .ro_mask    = 0xFF,
763 93d7ae8e Allen Kay
        .emu_mask   = 0xFF,
764 93d7ae8e Allen Kay
        .init       = xen_pt_ptr_reg_init,
765 93d7ae8e Allen Kay
        .u.b.read   = xen_pt_byte_reg_read,
766 93d7ae8e Allen Kay
        .u.b.write  = xen_pt_byte_reg_write,
767 93d7ae8e Allen Kay
    },
768 93d7ae8e Allen Kay
    {
769 93d7ae8e Allen Kay
        .size = 0,
770 93d7ae8e Allen Kay
    },
771 93d7ae8e Allen Kay
};
772 93d7ae8e Allen Kay
773 93d7ae8e Allen Kay
774 93d7ae8e Allen Kay
/**************************************
775 93d7ae8e Allen Kay
 * Vendor Specific Capability
776 93d7ae8e Allen Kay
 */
777 93d7ae8e Allen Kay
778 93d7ae8e Allen Kay
/* Vendor Specific Capability Structure reg static infomation table */
779 93d7ae8e Allen Kay
static XenPTRegInfo xen_pt_emu_reg_vendor[] = {
780 93d7ae8e Allen Kay
    {
781 93d7ae8e Allen Kay
        .offset     = PCI_CAP_LIST_NEXT,
782 93d7ae8e Allen Kay
        .size       = 1,
783 93d7ae8e Allen Kay
        .init_val   = 0x00,
784 93d7ae8e Allen Kay
        .ro_mask    = 0xFF,
785 93d7ae8e Allen Kay
        .emu_mask   = 0xFF,
786 93d7ae8e Allen Kay
        .init       = xen_pt_ptr_reg_init,
787 93d7ae8e Allen Kay
        .u.b.read   = xen_pt_byte_reg_read,
788 93d7ae8e Allen Kay
        .u.b.write  = xen_pt_byte_reg_write,
789 93d7ae8e Allen Kay
    },
790 93d7ae8e Allen Kay
    {
791 93d7ae8e Allen Kay
        .size = 0,
792 93d7ae8e Allen Kay
    },
793 93d7ae8e Allen Kay
};
794 93d7ae8e Allen Kay
795 93d7ae8e Allen Kay
796 93d7ae8e Allen Kay
/*****************************
797 93d7ae8e Allen Kay
 * PCI Express Capability
798 93d7ae8e Allen Kay
 */
799 93d7ae8e Allen Kay
800 93d7ae8e Allen Kay
static inline uint8_t get_capability_version(XenPCIPassthroughState *s,
801 93d7ae8e Allen Kay
                                             uint32_t offset)
802 93d7ae8e Allen Kay
{
803 93d7ae8e Allen Kay
    uint8_t flags = pci_get_byte(s->dev.config + offset + PCI_EXP_FLAGS);
804 93d7ae8e Allen Kay
    return flags & PCI_EXP_FLAGS_VERS;
805 93d7ae8e Allen Kay
}
806 93d7ae8e Allen Kay
807 93d7ae8e Allen Kay
static inline uint8_t get_device_type(XenPCIPassthroughState *s,
808 93d7ae8e Allen Kay
                                      uint32_t offset)
809 93d7ae8e Allen Kay
{
810 93d7ae8e Allen Kay
    uint8_t flags = pci_get_byte(s->dev.config + offset + PCI_EXP_FLAGS);
811 93d7ae8e Allen Kay
    return (flags & PCI_EXP_FLAGS_TYPE) >> 4;
812 93d7ae8e Allen Kay
}
813 93d7ae8e Allen Kay
814 93d7ae8e Allen Kay
/* initialize Link Control register */
815 93d7ae8e Allen Kay
static int xen_pt_linkctrl_reg_init(XenPCIPassthroughState *s,
816 93d7ae8e Allen Kay
                                    XenPTRegInfo *reg, uint32_t real_offset,
817 93d7ae8e Allen Kay
                                    uint32_t *data)
818 93d7ae8e Allen Kay
{
819 93d7ae8e Allen Kay
    uint8_t cap_ver = get_capability_version(s, real_offset - reg->offset);
820 93d7ae8e Allen Kay
    uint8_t dev_type = get_device_type(s, real_offset - reg->offset);
821 93d7ae8e Allen Kay
822 93d7ae8e Allen Kay
    /* no need to initialize in case of Root Complex Integrated Endpoint
823 93d7ae8e Allen Kay
     * with cap_ver 1.x
824 93d7ae8e Allen Kay
     */
825 93d7ae8e Allen Kay
    if ((dev_type == PCI_EXP_TYPE_RC_END) && (cap_ver == 1)) {
826 93d7ae8e Allen Kay
        *data = XEN_PT_INVALID_REG;
827 93d7ae8e Allen Kay
    }
828 93d7ae8e Allen Kay
829 93d7ae8e Allen Kay
    *data = reg->init_val;
830 93d7ae8e Allen Kay
    return 0;
831 93d7ae8e Allen Kay
}
832 93d7ae8e Allen Kay
/* initialize Device Control 2 register */
833 93d7ae8e Allen Kay
static int xen_pt_devctrl2_reg_init(XenPCIPassthroughState *s,
834 93d7ae8e Allen Kay
                                    XenPTRegInfo *reg, uint32_t real_offset,
835 93d7ae8e Allen Kay
                                    uint32_t *data)
836 93d7ae8e Allen Kay
{
837 93d7ae8e Allen Kay
    uint8_t cap_ver = get_capability_version(s, real_offset - reg->offset);
838 93d7ae8e Allen Kay
839 93d7ae8e Allen Kay
    /* no need to initialize in case of cap_ver 1.x */
840 93d7ae8e Allen Kay
    if (cap_ver == 1) {
841 93d7ae8e Allen Kay
        *data = XEN_PT_INVALID_REG;
842 93d7ae8e Allen Kay
    }
843 93d7ae8e Allen Kay
844 93d7ae8e Allen Kay
    *data = reg->init_val;
845 93d7ae8e Allen Kay
    return 0;
846 93d7ae8e Allen Kay
}
847 93d7ae8e Allen Kay
/* initialize Link Control 2 register */
848 93d7ae8e Allen Kay
static int xen_pt_linkctrl2_reg_init(XenPCIPassthroughState *s,
849 93d7ae8e Allen Kay
                                     XenPTRegInfo *reg, uint32_t real_offset,
850 93d7ae8e Allen Kay
                                     uint32_t *data)
851 93d7ae8e Allen Kay
{
852 93d7ae8e Allen Kay
    uint8_t cap_ver = get_capability_version(s, real_offset - reg->offset);
853 93d7ae8e Allen Kay
    uint32_t reg_field = 0;
854 93d7ae8e Allen Kay
855 93d7ae8e Allen Kay
    /* no need to initialize in case of cap_ver 1.x */
856 93d7ae8e Allen Kay
    if (cap_ver == 1) {
857 93d7ae8e Allen Kay
        reg_field = XEN_PT_INVALID_REG;
858 93d7ae8e Allen Kay
    } else {
859 93d7ae8e Allen Kay
        /* set Supported Link Speed */
860 93d7ae8e Allen Kay
        uint8_t lnkcap = pci_get_byte(s->dev.config + real_offset - reg->offset
861 93d7ae8e Allen Kay
                                      + PCI_EXP_LNKCAP);
862 93d7ae8e Allen Kay
        reg_field |= PCI_EXP_LNKCAP_SLS & lnkcap;
863 93d7ae8e Allen Kay
    }
864 93d7ae8e Allen Kay
865 93d7ae8e Allen Kay
    *data = reg_field;
866 93d7ae8e Allen Kay
    return 0;
867 93d7ae8e Allen Kay
}
868 93d7ae8e Allen Kay
869 93d7ae8e Allen Kay
/* PCI Express Capability Structure reg static infomation table */
870 93d7ae8e Allen Kay
static XenPTRegInfo xen_pt_emu_reg_pcie[] = {
871 93d7ae8e Allen Kay
    /* Next Pointer reg */
872 93d7ae8e Allen Kay
    {
873 93d7ae8e Allen Kay
        .offset     = PCI_CAP_LIST_NEXT,
874 93d7ae8e Allen Kay
        .size       = 1,
875 93d7ae8e Allen Kay
        .init_val   = 0x00,
876 93d7ae8e Allen Kay
        .ro_mask    = 0xFF,
877 93d7ae8e Allen Kay
        .emu_mask   = 0xFF,
878 93d7ae8e Allen Kay
        .init       = xen_pt_ptr_reg_init,
879 93d7ae8e Allen Kay
        .u.b.read   = xen_pt_byte_reg_read,
880 93d7ae8e Allen Kay
        .u.b.write  = xen_pt_byte_reg_write,
881 93d7ae8e Allen Kay
    },
882 93d7ae8e Allen Kay
    /* Device Capabilities reg */
883 93d7ae8e Allen Kay
    {
884 93d7ae8e Allen Kay
        .offset     = PCI_EXP_DEVCAP,
885 93d7ae8e Allen Kay
        .size       = 4,
886 93d7ae8e Allen Kay
        .init_val   = 0x00000000,
887 93d7ae8e Allen Kay
        .ro_mask    = 0x1FFCFFFF,
888 93d7ae8e Allen Kay
        .emu_mask   = 0x10000000,
889 93d7ae8e Allen Kay
        .init       = xen_pt_common_reg_init,
890 93d7ae8e Allen Kay
        .u.dw.read  = xen_pt_long_reg_read,
891 93d7ae8e Allen Kay
        .u.dw.write = xen_pt_long_reg_write,
892 93d7ae8e Allen Kay
    },
893 93d7ae8e Allen Kay
    /* Device Control reg */
894 93d7ae8e Allen Kay
    {
895 93d7ae8e Allen Kay
        .offset     = PCI_EXP_DEVCTL,
896 93d7ae8e Allen Kay
        .size       = 2,
897 93d7ae8e Allen Kay
        .init_val   = 0x2810,
898 93d7ae8e Allen Kay
        .ro_mask    = 0x8400,
899 93d7ae8e Allen Kay
        .emu_mask   = 0xFFFF,
900 93d7ae8e Allen Kay
        .init       = xen_pt_common_reg_init,
901 93d7ae8e Allen Kay
        .u.w.read   = xen_pt_word_reg_read,
902 93d7ae8e Allen Kay
        .u.w.write  = xen_pt_word_reg_write,
903 93d7ae8e Allen Kay
    },
904 93d7ae8e Allen Kay
    /* Link Control reg */
905 93d7ae8e Allen Kay
    {
906 93d7ae8e Allen Kay
        .offset     = PCI_EXP_LNKCTL,
907 93d7ae8e Allen Kay
        .size       = 2,
908 93d7ae8e Allen Kay
        .init_val   = 0x0000,
909 93d7ae8e Allen Kay
        .ro_mask    = 0xFC34,
910 93d7ae8e Allen Kay
        .emu_mask   = 0xFFFF,
911 93d7ae8e Allen Kay
        .init       = xen_pt_linkctrl_reg_init,
912 93d7ae8e Allen Kay
        .u.w.read   = xen_pt_word_reg_read,
913 93d7ae8e Allen Kay
        .u.w.write  = xen_pt_word_reg_write,
914 93d7ae8e Allen Kay
    },
915 93d7ae8e Allen Kay
    /* Device Control 2 reg */
916 93d7ae8e Allen Kay
    {
917 93d7ae8e Allen Kay
        .offset     = 0x28,
918 93d7ae8e Allen Kay
        .size       = 2,
919 93d7ae8e Allen Kay
        .init_val   = 0x0000,
920 93d7ae8e Allen Kay
        .ro_mask    = 0xFFE0,
921 93d7ae8e Allen Kay
        .emu_mask   = 0xFFFF,
922 93d7ae8e Allen Kay
        .init       = xen_pt_devctrl2_reg_init,
923 93d7ae8e Allen Kay
        .u.w.read   = xen_pt_word_reg_read,
924 93d7ae8e Allen Kay
        .u.w.write  = xen_pt_word_reg_write,
925 93d7ae8e Allen Kay
    },
926 93d7ae8e Allen Kay
    /* Link Control 2 reg */
927 93d7ae8e Allen Kay
    {
928 93d7ae8e Allen Kay
        .offset     = 0x30,
929 93d7ae8e Allen Kay
        .size       = 2,
930 93d7ae8e Allen Kay
        .init_val   = 0x0000,
931 93d7ae8e Allen Kay
        .ro_mask    = 0xE040,
932 93d7ae8e Allen Kay
        .emu_mask   = 0xFFFF,
933 93d7ae8e Allen Kay
        .init       = xen_pt_linkctrl2_reg_init,
934 93d7ae8e Allen Kay
        .u.w.read   = xen_pt_word_reg_read,
935 93d7ae8e Allen Kay
        .u.w.write  = xen_pt_word_reg_write,
936 93d7ae8e Allen Kay
    },
937 93d7ae8e Allen Kay
    {
938 93d7ae8e Allen Kay
        .size = 0,
939 93d7ae8e Allen Kay
    },
940 93d7ae8e Allen Kay
};
941 93d7ae8e Allen Kay
942 93d7ae8e Allen Kay
943 93d7ae8e Allen Kay
/*********************************
944 93d7ae8e Allen Kay
 * Power Management Capability
945 93d7ae8e Allen Kay
 */
946 93d7ae8e Allen Kay
947 93d7ae8e Allen Kay
/* read Power Management Control/Status register */
948 93d7ae8e Allen Kay
static int xen_pt_pmcsr_reg_read(XenPCIPassthroughState *s, XenPTReg *cfg_entry,
949 93d7ae8e Allen Kay
                                 uint16_t *value, uint16_t valid_mask)
950 93d7ae8e Allen Kay
{
951 93d7ae8e Allen Kay
    XenPTRegInfo *reg = cfg_entry->reg;
952 93d7ae8e Allen Kay
    uint16_t valid_emu_mask = reg->emu_mask;
953 93d7ae8e Allen Kay
954 93d7ae8e Allen Kay
    valid_emu_mask |= PCI_PM_CTRL_STATE_MASK | PCI_PM_CTRL_NO_SOFT_RESET;
955 93d7ae8e Allen Kay
956 93d7ae8e Allen Kay
    valid_emu_mask = valid_emu_mask & valid_mask;
957 93d7ae8e Allen Kay
    *value = XEN_PT_MERGE_VALUE(*value, cfg_entry->data, ~valid_emu_mask);
958 93d7ae8e Allen Kay
959 93d7ae8e Allen Kay
    return 0;
960 93d7ae8e Allen Kay
}
961 93d7ae8e Allen Kay
/* write Power Management Control/Status register */
962 93d7ae8e Allen Kay
static int xen_pt_pmcsr_reg_write(XenPCIPassthroughState *s,
963 93d7ae8e Allen Kay
                                  XenPTReg *cfg_entry, uint16_t *val,
964 93d7ae8e Allen Kay
                                  uint16_t dev_value, uint16_t valid_mask)
965 93d7ae8e Allen Kay
{
966 93d7ae8e Allen Kay
    XenPTRegInfo *reg = cfg_entry->reg;
967 93d7ae8e Allen Kay
    uint16_t emu_mask = reg->emu_mask;
968 93d7ae8e Allen Kay
    uint16_t writable_mask = 0;
969 93d7ae8e Allen Kay
    uint16_t throughable_mask = 0;
970 93d7ae8e Allen Kay
971 93d7ae8e Allen Kay
    emu_mask |= PCI_PM_CTRL_STATE_MASK | PCI_PM_CTRL_NO_SOFT_RESET;
972 93d7ae8e Allen Kay
973 93d7ae8e Allen Kay
    /* modify emulate register */
974 93d7ae8e Allen Kay
    writable_mask = emu_mask & ~reg->ro_mask & valid_mask;
975 93d7ae8e Allen Kay
    cfg_entry->data = XEN_PT_MERGE_VALUE(*val, cfg_entry->data, writable_mask);
976 93d7ae8e Allen Kay
977 93d7ae8e Allen Kay
    /* create value for writing to I/O device register */
978 93d7ae8e Allen Kay
    throughable_mask = ~emu_mask & valid_mask;
979 93d7ae8e Allen Kay
    *val = XEN_PT_MERGE_VALUE(*val, dev_value, throughable_mask);
980 93d7ae8e Allen Kay
981 93d7ae8e Allen Kay
    return 0;
982 93d7ae8e Allen Kay
}
983 93d7ae8e Allen Kay
984 93d7ae8e Allen Kay
/* Power Management Capability reg static infomation table */
985 93d7ae8e Allen Kay
static XenPTRegInfo xen_pt_emu_reg_pm[] = {
986 93d7ae8e Allen Kay
    /* Next Pointer reg */
987 93d7ae8e Allen Kay
    {
988 93d7ae8e Allen Kay
        .offset     = PCI_CAP_LIST_NEXT,
989 93d7ae8e Allen Kay
        .size       = 1,
990 93d7ae8e Allen Kay
        .init_val   = 0x00,
991 93d7ae8e Allen Kay
        .ro_mask    = 0xFF,
992 93d7ae8e Allen Kay
        .emu_mask   = 0xFF,
993 93d7ae8e Allen Kay
        .init       = xen_pt_ptr_reg_init,
994 93d7ae8e Allen Kay
        .u.b.read   = xen_pt_byte_reg_read,
995 93d7ae8e Allen Kay
        .u.b.write  = xen_pt_byte_reg_write,
996 93d7ae8e Allen Kay
    },
997 93d7ae8e Allen Kay
    /* Power Management Capabilities reg */
998 93d7ae8e Allen Kay
    {
999 93d7ae8e Allen Kay
        .offset     = PCI_CAP_FLAGS,
1000 93d7ae8e Allen Kay
        .size       = 2,
1001 93d7ae8e Allen Kay
        .init_val   = 0x0000,
1002 93d7ae8e Allen Kay
        .ro_mask    = 0xFFFF,
1003 93d7ae8e Allen Kay
        .emu_mask   = 0xF9C8,
1004 93d7ae8e Allen Kay
        .init       = xen_pt_common_reg_init,
1005 93d7ae8e Allen Kay
        .u.w.read   = xen_pt_word_reg_read,
1006 93d7ae8e Allen Kay
        .u.w.write  = xen_pt_word_reg_write,
1007 93d7ae8e Allen Kay
    },
1008 93d7ae8e Allen Kay
    /* PCI Power Management Control/Status reg */
1009 93d7ae8e Allen Kay
    {
1010 93d7ae8e Allen Kay
        .offset     = PCI_PM_CTRL,
1011 93d7ae8e Allen Kay
        .size       = 2,
1012 93d7ae8e Allen Kay
        .init_val   = 0x0008,
1013 93d7ae8e Allen Kay
        .ro_mask    = 0xE1FC,
1014 93d7ae8e Allen Kay
        .emu_mask   = 0x8100,
1015 93d7ae8e Allen Kay
        .init       = xen_pt_common_reg_init,
1016 93d7ae8e Allen Kay
        .u.w.read   = xen_pt_pmcsr_reg_read,
1017 93d7ae8e Allen Kay
        .u.w.write  = xen_pt_pmcsr_reg_write,
1018 93d7ae8e Allen Kay
    },
1019 93d7ae8e Allen Kay
    {
1020 93d7ae8e Allen Kay
        .size = 0,
1021 93d7ae8e Allen Kay
    },
1022 93d7ae8e Allen Kay
};
1023 93d7ae8e Allen Kay
1024 93d7ae8e Allen Kay
1025 3854ca57 Jiang Yunhong
/********************************
1026 3854ca57 Jiang Yunhong
 * MSI Capability
1027 3854ca57 Jiang Yunhong
 */
1028 3854ca57 Jiang Yunhong
1029 3854ca57 Jiang Yunhong
/* Helper */
1030 3854ca57 Jiang Yunhong
static bool xen_pt_msgdata_check_type(uint32_t offset, uint16_t flags)
1031 3854ca57 Jiang Yunhong
{
1032 3854ca57 Jiang Yunhong
    /* check the offset whether matches the type or not */
1033 3854ca57 Jiang Yunhong
    bool is_32 = (offset == PCI_MSI_DATA_32) && !(flags & PCI_MSI_FLAGS_64BIT);
1034 3854ca57 Jiang Yunhong
    bool is_64 = (offset == PCI_MSI_DATA_64) &&  (flags & PCI_MSI_FLAGS_64BIT);
1035 3854ca57 Jiang Yunhong
    return is_32 || is_64;
1036 3854ca57 Jiang Yunhong
}
1037 3854ca57 Jiang Yunhong
1038 3854ca57 Jiang Yunhong
/* Message Control register */
1039 3854ca57 Jiang Yunhong
static int xen_pt_msgctrl_reg_init(XenPCIPassthroughState *s,
1040 3854ca57 Jiang Yunhong
                                   XenPTRegInfo *reg, uint32_t real_offset,
1041 3854ca57 Jiang Yunhong
                                   uint32_t *data)
1042 3854ca57 Jiang Yunhong
{
1043 3854ca57 Jiang Yunhong
    PCIDevice *d = &s->dev;
1044 3854ca57 Jiang Yunhong
    XenPTMSI *msi = s->msi;
1045 3854ca57 Jiang Yunhong
    uint16_t reg_field = 0;
1046 3854ca57 Jiang Yunhong
1047 3854ca57 Jiang Yunhong
    /* use I/O device register's value as initial value */
1048 3854ca57 Jiang Yunhong
    reg_field = pci_get_word(d->config + real_offset);
1049 3854ca57 Jiang Yunhong
1050 3854ca57 Jiang Yunhong
    if (reg_field & PCI_MSI_FLAGS_ENABLE) {
1051 3854ca57 Jiang Yunhong
        XEN_PT_LOG(&s->dev, "MSI already enabled, disabling it first\n");
1052 3854ca57 Jiang Yunhong
        xen_host_pci_set_word(&s->real_device, real_offset,
1053 3854ca57 Jiang Yunhong
                              reg_field & ~PCI_MSI_FLAGS_ENABLE);
1054 3854ca57 Jiang Yunhong
    }
1055 3854ca57 Jiang Yunhong
    msi->flags |= reg_field;
1056 3854ca57 Jiang Yunhong
    msi->ctrl_offset = real_offset;
1057 3854ca57 Jiang Yunhong
    msi->initialized = false;
1058 3854ca57 Jiang Yunhong
    msi->mapped = false;
1059 3854ca57 Jiang Yunhong
1060 3854ca57 Jiang Yunhong
    *data = reg->init_val;
1061 3854ca57 Jiang Yunhong
    return 0;
1062 3854ca57 Jiang Yunhong
}
1063 3854ca57 Jiang Yunhong
static int xen_pt_msgctrl_reg_write(XenPCIPassthroughState *s,
1064 3854ca57 Jiang Yunhong
                                    XenPTReg *cfg_entry, uint16_t *val,
1065 3854ca57 Jiang Yunhong
                                    uint16_t dev_value, uint16_t valid_mask)
1066 3854ca57 Jiang Yunhong
{
1067 3854ca57 Jiang Yunhong
    XenPTRegInfo *reg = cfg_entry->reg;
1068 3854ca57 Jiang Yunhong
    XenPTMSI *msi = s->msi;
1069 3854ca57 Jiang Yunhong
    uint16_t writable_mask = 0;
1070 3854ca57 Jiang Yunhong
    uint16_t throughable_mask = 0;
1071 3854ca57 Jiang Yunhong
    uint16_t raw_val;
1072 3854ca57 Jiang Yunhong
1073 3854ca57 Jiang Yunhong
    /* Currently no support for multi-vector */
1074 3854ca57 Jiang Yunhong
    if (*val & PCI_MSI_FLAGS_QSIZE) {
1075 3854ca57 Jiang Yunhong
        XEN_PT_WARN(&s->dev, "Tries to set more than 1 vector ctrl %x\n", *val);
1076 3854ca57 Jiang Yunhong
    }
1077 3854ca57 Jiang Yunhong
1078 3854ca57 Jiang Yunhong
    /* modify emulate register */
1079 3854ca57 Jiang Yunhong
    writable_mask = reg->emu_mask & ~reg->ro_mask & valid_mask;
1080 3854ca57 Jiang Yunhong
    cfg_entry->data = XEN_PT_MERGE_VALUE(*val, cfg_entry->data, writable_mask);
1081 3854ca57 Jiang Yunhong
    msi->flags |= cfg_entry->data & ~PCI_MSI_FLAGS_ENABLE;
1082 3854ca57 Jiang Yunhong
1083 3854ca57 Jiang Yunhong
    /* create value for writing to I/O device register */
1084 3854ca57 Jiang Yunhong
    raw_val = *val;
1085 3854ca57 Jiang Yunhong
    throughable_mask = ~reg->emu_mask & valid_mask;
1086 3854ca57 Jiang Yunhong
    *val = XEN_PT_MERGE_VALUE(*val, dev_value, throughable_mask);
1087 3854ca57 Jiang Yunhong
1088 3854ca57 Jiang Yunhong
    /* update MSI */
1089 3854ca57 Jiang Yunhong
    if (raw_val & PCI_MSI_FLAGS_ENABLE) {
1090 3854ca57 Jiang Yunhong
        /* setup MSI pirq for the first time */
1091 3854ca57 Jiang Yunhong
        if (!msi->initialized) {
1092 3854ca57 Jiang Yunhong
            /* Init physical one */
1093 3854ca57 Jiang Yunhong
            XEN_PT_LOG(&s->dev, "setup MSI\n");
1094 3854ca57 Jiang Yunhong
            if (xen_pt_msi_setup(s)) {
1095 3854ca57 Jiang Yunhong
                /* We do not broadcast the error to the framework code, so
1096 3854ca57 Jiang Yunhong
                 * that MSI errors are contained in MSI emulation code and
1097 3854ca57 Jiang Yunhong
                 * QEMU can go on running.
1098 3854ca57 Jiang Yunhong
                 * Guest MSI would be actually not working.
1099 3854ca57 Jiang Yunhong
                 */
1100 3854ca57 Jiang Yunhong
                *val &= ~PCI_MSI_FLAGS_ENABLE;
1101 3854ca57 Jiang Yunhong
                XEN_PT_WARN(&s->dev, "Can not map MSI.\n");
1102 3854ca57 Jiang Yunhong
                return 0;
1103 3854ca57 Jiang Yunhong
            }
1104 3854ca57 Jiang Yunhong
            if (xen_pt_msi_update(s)) {
1105 3854ca57 Jiang Yunhong
                *val &= ~PCI_MSI_FLAGS_ENABLE;
1106 3854ca57 Jiang Yunhong
                XEN_PT_WARN(&s->dev, "Can not bind MSI\n");
1107 3854ca57 Jiang Yunhong
                return 0;
1108 3854ca57 Jiang Yunhong
            }
1109 3854ca57 Jiang Yunhong
            msi->initialized = true;
1110 3854ca57 Jiang Yunhong
            msi->mapped = true;
1111 3854ca57 Jiang Yunhong
        }
1112 3854ca57 Jiang Yunhong
        msi->flags |= PCI_MSI_FLAGS_ENABLE;
1113 3854ca57 Jiang Yunhong
    } else {
1114 3854ca57 Jiang Yunhong
        msi->flags &= ~PCI_MSI_FLAGS_ENABLE;
1115 3854ca57 Jiang Yunhong
    }
1116 3854ca57 Jiang Yunhong
1117 3854ca57 Jiang Yunhong
    /* pass through MSI_ENABLE bit */
1118 3854ca57 Jiang Yunhong
    *val &= ~PCI_MSI_FLAGS_ENABLE;
1119 3854ca57 Jiang Yunhong
    *val |= raw_val & PCI_MSI_FLAGS_ENABLE;
1120 3854ca57 Jiang Yunhong
1121 3854ca57 Jiang Yunhong
    return 0;
1122 3854ca57 Jiang Yunhong
}
1123 3854ca57 Jiang Yunhong
1124 3854ca57 Jiang Yunhong
/* initialize Message Upper Address register */
1125 3854ca57 Jiang Yunhong
static int xen_pt_msgaddr64_reg_init(XenPCIPassthroughState *s,
1126 3854ca57 Jiang Yunhong
                                     XenPTRegInfo *reg, uint32_t real_offset,
1127 3854ca57 Jiang Yunhong
                                     uint32_t *data)
1128 3854ca57 Jiang Yunhong
{
1129 3854ca57 Jiang Yunhong
    /* no need to initialize in case of 32 bit type */
1130 3854ca57 Jiang Yunhong
    if (!(s->msi->flags & PCI_MSI_FLAGS_64BIT)) {
1131 3854ca57 Jiang Yunhong
        *data = XEN_PT_INVALID_REG;
1132 3854ca57 Jiang Yunhong
    } else {
1133 3854ca57 Jiang Yunhong
        *data = reg->init_val;
1134 3854ca57 Jiang Yunhong
    }
1135 3854ca57 Jiang Yunhong
1136 3854ca57 Jiang Yunhong
    return 0;
1137 3854ca57 Jiang Yunhong
}
1138 3854ca57 Jiang Yunhong
/* this function will be called twice (for 32 bit and 64 bit type) */
1139 3854ca57 Jiang Yunhong
/* initialize Message Data register */
1140 3854ca57 Jiang Yunhong
static int xen_pt_msgdata_reg_init(XenPCIPassthroughState *s,
1141 3854ca57 Jiang Yunhong
                                   XenPTRegInfo *reg, uint32_t real_offset,
1142 3854ca57 Jiang Yunhong
                                   uint32_t *data)
1143 3854ca57 Jiang Yunhong
{
1144 3854ca57 Jiang Yunhong
    uint32_t flags = s->msi->flags;
1145 3854ca57 Jiang Yunhong
    uint32_t offset = reg->offset;
1146 3854ca57 Jiang Yunhong
1147 3854ca57 Jiang Yunhong
    /* check the offset whether matches the type or not */
1148 3854ca57 Jiang Yunhong
    if (xen_pt_msgdata_check_type(offset, flags)) {
1149 3854ca57 Jiang Yunhong
        *data = reg->init_val;
1150 3854ca57 Jiang Yunhong
    } else {
1151 3854ca57 Jiang Yunhong
        *data = XEN_PT_INVALID_REG;
1152 3854ca57 Jiang Yunhong
    }
1153 3854ca57 Jiang Yunhong
    return 0;
1154 3854ca57 Jiang Yunhong
}
1155 3854ca57 Jiang Yunhong
1156 3854ca57 Jiang Yunhong
/* write Message Address register */
1157 3854ca57 Jiang Yunhong
static int xen_pt_msgaddr32_reg_write(XenPCIPassthroughState *s,
1158 3854ca57 Jiang Yunhong
                                      XenPTReg *cfg_entry, uint32_t *val,
1159 3854ca57 Jiang Yunhong
                                      uint32_t dev_value, uint32_t valid_mask)
1160 3854ca57 Jiang Yunhong
{
1161 3854ca57 Jiang Yunhong
    XenPTRegInfo *reg = cfg_entry->reg;
1162 3854ca57 Jiang Yunhong
    uint32_t writable_mask = 0;
1163 3854ca57 Jiang Yunhong
    uint32_t throughable_mask = 0;
1164 3854ca57 Jiang Yunhong
    uint32_t old_addr = cfg_entry->data;
1165 3854ca57 Jiang Yunhong
1166 3854ca57 Jiang Yunhong
    /* modify emulate register */
1167 3854ca57 Jiang Yunhong
    writable_mask = reg->emu_mask & ~reg->ro_mask & valid_mask;
1168 3854ca57 Jiang Yunhong
    cfg_entry->data = XEN_PT_MERGE_VALUE(*val, cfg_entry->data, writable_mask);
1169 3854ca57 Jiang Yunhong
    s->msi->addr_lo = cfg_entry->data;
1170 3854ca57 Jiang Yunhong
1171 3854ca57 Jiang Yunhong
    /* create value for writing to I/O device register */
1172 3854ca57 Jiang Yunhong
    throughable_mask = ~reg->emu_mask & valid_mask;
1173 3854ca57 Jiang Yunhong
    *val = XEN_PT_MERGE_VALUE(*val, dev_value, throughable_mask);
1174 3854ca57 Jiang Yunhong
1175 3854ca57 Jiang Yunhong
    /* update MSI */
1176 3854ca57 Jiang Yunhong
    if (cfg_entry->data != old_addr) {
1177 3854ca57 Jiang Yunhong
        if (s->msi->mapped) {
1178 3854ca57 Jiang Yunhong
            xen_pt_msi_update(s);
1179 3854ca57 Jiang Yunhong
        }
1180 3854ca57 Jiang Yunhong
    }
1181 3854ca57 Jiang Yunhong
1182 3854ca57 Jiang Yunhong
    return 0;
1183 3854ca57 Jiang Yunhong
}
1184 3854ca57 Jiang Yunhong
/* write Message Upper Address register */
1185 3854ca57 Jiang Yunhong
static int xen_pt_msgaddr64_reg_write(XenPCIPassthroughState *s,
1186 3854ca57 Jiang Yunhong
                                      XenPTReg *cfg_entry, uint32_t *val,
1187 3854ca57 Jiang Yunhong
                                      uint32_t dev_value, uint32_t valid_mask)
1188 3854ca57 Jiang Yunhong
{
1189 3854ca57 Jiang Yunhong
    XenPTRegInfo *reg = cfg_entry->reg;
1190 3854ca57 Jiang Yunhong
    uint32_t writable_mask = 0;
1191 3854ca57 Jiang Yunhong
    uint32_t throughable_mask = 0;
1192 3854ca57 Jiang Yunhong
    uint32_t old_addr = cfg_entry->data;
1193 3854ca57 Jiang Yunhong
1194 3854ca57 Jiang Yunhong
    /* check whether the type is 64 bit or not */
1195 3854ca57 Jiang Yunhong
    if (!(s->msi->flags & PCI_MSI_FLAGS_64BIT)) {
1196 3854ca57 Jiang Yunhong
        XEN_PT_ERR(&s->dev,
1197 3854ca57 Jiang Yunhong
                   "Can't write to the upper address without 64 bit support\n");
1198 3854ca57 Jiang Yunhong
        return -1;
1199 3854ca57 Jiang Yunhong
    }
1200 3854ca57 Jiang Yunhong
1201 3854ca57 Jiang Yunhong
    /* modify emulate register */
1202 3854ca57 Jiang Yunhong
    writable_mask = reg->emu_mask & ~reg->ro_mask & valid_mask;
1203 3854ca57 Jiang Yunhong
    cfg_entry->data = XEN_PT_MERGE_VALUE(*val, cfg_entry->data, writable_mask);
1204 3854ca57 Jiang Yunhong
    /* update the msi_info too */
1205 3854ca57 Jiang Yunhong
    s->msi->addr_hi = cfg_entry->data;
1206 3854ca57 Jiang Yunhong
1207 3854ca57 Jiang Yunhong
    /* create value for writing to I/O device register */
1208 3854ca57 Jiang Yunhong
    throughable_mask = ~reg->emu_mask & valid_mask;
1209 3854ca57 Jiang Yunhong
    *val = XEN_PT_MERGE_VALUE(*val, dev_value, throughable_mask);
1210 3854ca57 Jiang Yunhong
1211 3854ca57 Jiang Yunhong
    /* update MSI */
1212 3854ca57 Jiang Yunhong
    if (cfg_entry->data != old_addr) {
1213 3854ca57 Jiang Yunhong
        if (s->msi->mapped) {
1214 3854ca57 Jiang Yunhong
            xen_pt_msi_update(s);
1215 3854ca57 Jiang Yunhong
        }
1216 3854ca57 Jiang Yunhong
    }
1217 3854ca57 Jiang Yunhong
1218 3854ca57 Jiang Yunhong
    return 0;
1219 3854ca57 Jiang Yunhong
}
1220 3854ca57 Jiang Yunhong
1221 3854ca57 Jiang Yunhong
1222 3854ca57 Jiang Yunhong
/* this function will be called twice (for 32 bit and 64 bit type) */
1223 3854ca57 Jiang Yunhong
/* write Message Data register */
1224 3854ca57 Jiang Yunhong
static int xen_pt_msgdata_reg_write(XenPCIPassthroughState *s,
1225 3854ca57 Jiang Yunhong
                                    XenPTReg *cfg_entry, uint16_t *val,
1226 3854ca57 Jiang Yunhong
                                    uint16_t dev_value, uint16_t valid_mask)
1227 3854ca57 Jiang Yunhong
{
1228 3854ca57 Jiang Yunhong
    XenPTRegInfo *reg = cfg_entry->reg;
1229 3854ca57 Jiang Yunhong
    XenPTMSI *msi = s->msi;
1230 3854ca57 Jiang Yunhong
    uint16_t writable_mask = 0;
1231 3854ca57 Jiang Yunhong
    uint16_t throughable_mask = 0;
1232 3854ca57 Jiang Yunhong
    uint16_t old_data = cfg_entry->data;
1233 3854ca57 Jiang Yunhong
    uint32_t offset = reg->offset;
1234 3854ca57 Jiang Yunhong
1235 3854ca57 Jiang Yunhong
    /* check the offset whether matches the type or not */
1236 3854ca57 Jiang Yunhong
    if (!xen_pt_msgdata_check_type(offset, msi->flags)) {
1237 3854ca57 Jiang Yunhong
        /* exit I/O emulator */
1238 3854ca57 Jiang Yunhong
        XEN_PT_ERR(&s->dev, "the offset does not match the 32/64 bit type!\n");
1239 3854ca57 Jiang Yunhong
        return -1;
1240 3854ca57 Jiang Yunhong
    }
1241 3854ca57 Jiang Yunhong
1242 3854ca57 Jiang Yunhong
    /* modify emulate register */
1243 3854ca57 Jiang Yunhong
    writable_mask = reg->emu_mask & ~reg->ro_mask & valid_mask;
1244 3854ca57 Jiang Yunhong
    cfg_entry->data = XEN_PT_MERGE_VALUE(*val, cfg_entry->data, writable_mask);
1245 3854ca57 Jiang Yunhong
    /* update the msi_info too */
1246 3854ca57 Jiang Yunhong
    msi->data = cfg_entry->data;
1247 3854ca57 Jiang Yunhong
1248 3854ca57 Jiang Yunhong
    /* create value for writing to I/O device register */
1249 3854ca57 Jiang Yunhong
    throughable_mask = ~reg->emu_mask & valid_mask;
1250 3854ca57 Jiang Yunhong
    *val = XEN_PT_MERGE_VALUE(*val, dev_value, throughable_mask);
1251 3854ca57 Jiang Yunhong
1252 3854ca57 Jiang Yunhong
    /* update MSI */
1253 3854ca57 Jiang Yunhong
    if (cfg_entry->data != old_data) {
1254 3854ca57 Jiang Yunhong
        if (msi->mapped) {
1255 3854ca57 Jiang Yunhong
            xen_pt_msi_update(s);
1256 3854ca57 Jiang Yunhong
        }
1257 3854ca57 Jiang Yunhong
    }
1258 3854ca57 Jiang Yunhong
1259 3854ca57 Jiang Yunhong
    return 0;
1260 3854ca57 Jiang Yunhong
}
1261 3854ca57 Jiang Yunhong
1262 3854ca57 Jiang Yunhong
/* MSI Capability Structure reg static infomation table */
1263 3854ca57 Jiang Yunhong
static XenPTRegInfo xen_pt_emu_reg_msi[] = {
1264 3854ca57 Jiang Yunhong
    /* Next Pointer reg */
1265 3854ca57 Jiang Yunhong
    {
1266 3854ca57 Jiang Yunhong
        .offset     = PCI_CAP_LIST_NEXT,
1267 3854ca57 Jiang Yunhong
        .size       = 1,
1268 3854ca57 Jiang Yunhong
        .init_val   = 0x00,
1269 3854ca57 Jiang Yunhong
        .ro_mask    = 0xFF,
1270 3854ca57 Jiang Yunhong
        .emu_mask   = 0xFF,
1271 3854ca57 Jiang Yunhong
        .init       = xen_pt_ptr_reg_init,
1272 3854ca57 Jiang Yunhong
        .u.b.read   = xen_pt_byte_reg_read,
1273 3854ca57 Jiang Yunhong
        .u.b.write  = xen_pt_byte_reg_write,
1274 3854ca57 Jiang Yunhong
    },
1275 3854ca57 Jiang Yunhong
    /* Message Control reg */
1276 3854ca57 Jiang Yunhong
    {
1277 3854ca57 Jiang Yunhong
        .offset     = PCI_MSI_FLAGS,
1278 3854ca57 Jiang Yunhong
        .size       = 2,
1279 3854ca57 Jiang Yunhong
        .init_val   = 0x0000,
1280 3854ca57 Jiang Yunhong
        .ro_mask    = 0xFF8E,
1281 3854ca57 Jiang Yunhong
        .emu_mask   = 0x007F,
1282 3854ca57 Jiang Yunhong
        .init       = xen_pt_msgctrl_reg_init,
1283 3854ca57 Jiang Yunhong
        .u.w.read   = xen_pt_word_reg_read,
1284 3854ca57 Jiang Yunhong
        .u.w.write  = xen_pt_msgctrl_reg_write,
1285 3854ca57 Jiang Yunhong
    },
1286 3854ca57 Jiang Yunhong
    /* Message Address reg */
1287 3854ca57 Jiang Yunhong
    {
1288 3854ca57 Jiang Yunhong
        .offset     = PCI_MSI_ADDRESS_LO,
1289 3854ca57 Jiang Yunhong
        .size       = 4,
1290 3854ca57 Jiang Yunhong
        .init_val   = 0x00000000,
1291 3854ca57 Jiang Yunhong
        .ro_mask    = 0x00000003,
1292 3854ca57 Jiang Yunhong
        .emu_mask   = 0xFFFFFFFF,
1293 3854ca57 Jiang Yunhong
        .no_wb      = 1,
1294 3854ca57 Jiang Yunhong
        .init       = xen_pt_common_reg_init,
1295 3854ca57 Jiang Yunhong
        .u.dw.read  = xen_pt_long_reg_read,
1296 3854ca57 Jiang Yunhong
        .u.dw.write = xen_pt_msgaddr32_reg_write,
1297 3854ca57 Jiang Yunhong
    },
1298 3854ca57 Jiang Yunhong
    /* Message Upper Address reg (if PCI_MSI_FLAGS_64BIT set) */
1299 3854ca57 Jiang Yunhong
    {
1300 3854ca57 Jiang Yunhong
        .offset     = PCI_MSI_ADDRESS_HI,
1301 3854ca57 Jiang Yunhong
        .size       = 4,
1302 3854ca57 Jiang Yunhong
        .init_val   = 0x00000000,
1303 3854ca57 Jiang Yunhong
        .ro_mask    = 0x00000000,
1304 3854ca57 Jiang Yunhong
        .emu_mask   = 0xFFFFFFFF,
1305 3854ca57 Jiang Yunhong
        .no_wb      = 1,
1306 3854ca57 Jiang Yunhong
        .init       = xen_pt_msgaddr64_reg_init,
1307 3854ca57 Jiang Yunhong
        .u.dw.read  = xen_pt_long_reg_read,
1308 3854ca57 Jiang Yunhong
        .u.dw.write = xen_pt_msgaddr64_reg_write,
1309 3854ca57 Jiang Yunhong
    },
1310 3854ca57 Jiang Yunhong
    /* Message Data reg (16 bits of data for 32-bit devices) */
1311 3854ca57 Jiang Yunhong
    {
1312 3854ca57 Jiang Yunhong
        .offset     = PCI_MSI_DATA_32,
1313 3854ca57 Jiang Yunhong
        .size       = 2,
1314 3854ca57 Jiang Yunhong
        .init_val   = 0x0000,
1315 3854ca57 Jiang Yunhong
        .ro_mask    = 0x0000,
1316 3854ca57 Jiang Yunhong
        .emu_mask   = 0xFFFF,
1317 3854ca57 Jiang Yunhong
        .no_wb      = 1,
1318 3854ca57 Jiang Yunhong
        .init       = xen_pt_msgdata_reg_init,
1319 3854ca57 Jiang Yunhong
        .u.w.read   = xen_pt_word_reg_read,
1320 3854ca57 Jiang Yunhong
        .u.w.write  = xen_pt_msgdata_reg_write,
1321 3854ca57 Jiang Yunhong
    },
1322 3854ca57 Jiang Yunhong
    /* Message Data reg (16 bits of data for 64-bit devices) */
1323 3854ca57 Jiang Yunhong
    {
1324 3854ca57 Jiang Yunhong
        .offset     = PCI_MSI_DATA_64,
1325 3854ca57 Jiang Yunhong
        .size       = 2,
1326 3854ca57 Jiang Yunhong
        .init_val   = 0x0000,
1327 3854ca57 Jiang Yunhong
        .ro_mask    = 0x0000,
1328 3854ca57 Jiang Yunhong
        .emu_mask   = 0xFFFF,
1329 3854ca57 Jiang Yunhong
        .no_wb      = 1,
1330 3854ca57 Jiang Yunhong
        .init       = xen_pt_msgdata_reg_init,
1331 3854ca57 Jiang Yunhong
        .u.w.read   = xen_pt_word_reg_read,
1332 3854ca57 Jiang Yunhong
        .u.w.write  = xen_pt_msgdata_reg_write,
1333 3854ca57 Jiang Yunhong
    },
1334 3854ca57 Jiang Yunhong
    {
1335 3854ca57 Jiang Yunhong
        .size = 0,
1336 3854ca57 Jiang Yunhong
    },
1337 3854ca57 Jiang Yunhong
};
1338 3854ca57 Jiang Yunhong
1339 3854ca57 Jiang Yunhong
1340 3854ca57 Jiang Yunhong
/**************************************
1341 3854ca57 Jiang Yunhong
 * MSI-X Capability
1342 3854ca57 Jiang Yunhong
 */
1343 3854ca57 Jiang Yunhong
1344 3854ca57 Jiang Yunhong
/* Message Control register for MSI-X */
1345 3854ca57 Jiang Yunhong
static int xen_pt_msixctrl_reg_init(XenPCIPassthroughState *s,
1346 3854ca57 Jiang Yunhong
                                    XenPTRegInfo *reg, uint32_t real_offset,
1347 3854ca57 Jiang Yunhong
                                    uint32_t *data)
1348 3854ca57 Jiang Yunhong
{
1349 3854ca57 Jiang Yunhong
    PCIDevice *d = &s->dev;
1350 3854ca57 Jiang Yunhong
    uint16_t reg_field = 0;
1351 3854ca57 Jiang Yunhong
1352 3854ca57 Jiang Yunhong
    /* use I/O device register's value as initial value */
1353 3854ca57 Jiang Yunhong
    reg_field = pci_get_word(d->config + real_offset);
1354 3854ca57 Jiang Yunhong
1355 3854ca57 Jiang Yunhong
    if (reg_field & PCI_MSIX_FLAGS_ENABLE) {
1356 3854ca57 Jiang Yunhong
        XEN_PT_LOG(d, "MSIX already enabled, disabling it first\n");
1357 3854ca57 Jiang Yunhong
        xen_host_pci_set_word(&s->real_device, real_offset,
1358 3854ca57 Jiang Yunhong
                              reg_field & ~PCI_MSIX_FLAGS_ENABLE);
1359 3854ca57 Jiang Yunhong
    }
1360 3854ca57 Jiang Yunhong
1361 3854ca57 Jiang Yunhong
    s->msix->ctrl_offset = real_offset;
1362 3854ca57 Jiang Yunhong
1363 3854ca57 Jiang Yunhong
    *data = reg->init_val;
1364 3854ca57 Jiang Yunhong
    return 0;
1365 3854ca57 Jiang Yunhong
}
1366 3854ca57 Jiang Yunhong
static int xen_pt_msixctrl_reg_write(XenPCIPassthroughState *s,
1367 3854ca57 Jiang Yunhong
                                     XenPTReg *cfg_entry, uint16_t *val,
1368 3854ca57 Jiang Yunhong
                                     uint16_t dev_value, uint16_t valid_mask)
1369 3854ca57 Jiang Yunhong
{
1370 3854ca57 Jiang Yunhong
    XenPTRegInfo *reg = cfg_entry->reg;
1371 3854ca57 Jiang Yunhong
    uint16_t writable_mask = 0;
1372 3854ca57 Jiang Yunhong
    uint16_t throughable_mask = 0;
1373 3854ca57 Jiang Yunhong
    int debug_msix_enabled_old;
1374 3854ca57 Jiang Yunhong
1375 3854ca57 Jiang Yunhong
    /* modify emulate register */
1376 3854ca57 Jiang Yunhong
    writable_mask = reg->emu_mask & ~reg->ro_mask & valid_mask;
1377 3854ca57 Jiang Yunhong
    cfg_entry->data = XEN_PT_MERGE_VALUE(*val, cfg_entry->data, writable_mask);
1378 3854ca57 Jiang Yunhong
1379 3854ca57 Jiang Yunhong
    /* create value for writing to I/O device register */
1380 3854ca57 Jiang Yunhong
    throughable_mask = ~reg->emu_mask & valid_mask;
1381 3854ca57 Jiang Yunhong
    *val = XEN_PT_MERGE_VALUE(*val, dev_value, throughable_mask);
1382 3854ca57 Jiang Yunhong
1383 3854ca57 Jiang Yunhong
    /* update MSI-X */
1384 3854ca57 Jiang Yunhong
    if ((*val & PCI_MSIX_FLAGS_ENABLE)
1385 3854ca57 Jiang Yunhong
        && !(*val & PCI_MSIX_FLAGS_MASKALL)) {
1386 3854ca57 Jiang Yunhong
        xen_pt_msix_update(s);
1387 3854ca57 Jiang Yunhong
    }
1388 3854ca57 Jiang Yunhong
1389 3854ca57 Jiang Yunhong
    debug_msix_enabled_old = s->msix->enabled;
1390 3854ca57 Jiang Yunhong
    s->msix->enabled = !!(*val & PCI_MSIX_FLAGS_ENABLE);
1391 3854ca57 Jiang Yunhong
    if (s->msix->enabled != debug_msix_enabled_old) {
1392 3854ca57 Jiang Yunhong
        XEN_PT_LOG(&s->dev, "%s MSI-X\n",
1393 3854ca57 Jiang Yunhong
                   s->msix->enabled ? "enable" : "disable");
1394 3854ca57 Jiang Yunhong
    }
1395 3854ca57 Jiang Yunhong
1396 3854ca57 Jiang Yunhong
    return 0;
1397 3854ca57 Jiang Yunhong
}
1398 3854ca57 Jiang Yunhong
1399 3854ca57 Jiang Yunhong
/* MSI-X Capability Structure reg static infomation table */
1400 3854ca57 Jiang Yunhong
static XenPTRegInfo xen_pt_emu_reg_msix[] = {
1401 3854ca57 Jiang Yunhong
    /* Next Pointer reg */
1402 3854ca57 Jiang Yunhong
    {
1403 3854ca57 Jiang Yunhong
        .offset     = PCI_CAP_LIST_NEXT,
1404 3854ca57 Jiang Yunhong
        .size       = 1,
1405 3854ca57 Jiang Yunhong
        .init_val   = 0x00,
1406 3854ca57 Jiang Yunhong
        .ro_mask    = 0xFF,
1407 3854ca57 Jiang Yunhong
        .emu_mask   = 0xFF,
1408 3854ca57 Jiang Yunhong
        .init       = xen_pt_ptr_reg_init,
1409 3854ca57 Jiang Yunhong
        .u.b.read   = xen_pt_byte_reg_read,
1410 3854ca57 Jiang Yunhong
        .u.b.write  = xen_pt_byte_reg_write,
1411 3854ca57 Jiang Yunhong
    },
1412 3854ca57 Jiang Yunhong
    /* Message Control reg */
1413 3854ca57 Jiang Yunhong
    {
1414 3854ca57 Jiang Yunhong
        .offset     = PCI_MSI_FLAGS,
1415 3854ca57 Jiang Yunhong
        .size       = 2,
1416 3854ca57 Jiang Yunhong
        .init_val   = 0x0000,
1417 3854ca57 Jiang Yunhong
        .ro_mask    = 0x3FFF,
1418 3854ca57 Jiang Yunhong
        .emu_mask   = 0x0000,
1419 3854ca57 Jiang Yunhong
        .init       = xen_pt_msixctrl_reg_init,
1420 3854ca57 Jiang Yunhong
        .u.w.read   = xen_pt_word_reg_read,
1421 3854ca57 Jiang Yunhong
        .u.w.write  = xen_pt_msixctrl_reg_write,
1422 3854ca57 Jiang Yunhong
    },
1423 3854ca57 Jiang Yunhong
    {
1424 3854ca57 Jiang Yunhong
        .size = 0,
1425 3854ca57 Jiang Yunhong
    },
1426 3854ca57 Jiang Yunhong
};
1427 3854ca57 Jiang Yunhong
1428 3854ca57 Jiang Yunhong
1429 93d7ae8e Allen Kay
/****************************
1430 93d7ae8e Allen Kay
 * Capabilities
1431 93d7ae8e Allen Kay
 */
1432 93d7ae8e Allen Kay
1433 93d7ae8e Allen Kay
/* capability structure register group size functions */
1434 93d7ae8e Allen Kay
1435 93d7ae8e Allen Kay
static int xen_pt_reg_grp_size_init(XenPCIPassthroughState *s,
1436 93d7ae8e Allen Kay
                                    const XenPTRegGroupInfo *grp_reg,
1437 93d7ae8e Allen Kay
                                    uint32_t base_offset, uint8_t *size)
1438 93d7ae8e Allen Kay
{
1439 93d7ae8e Allen Kay
    *size = grp_reg->grp_size;
1440 93d7ae8e Allen Kay
    return 0;
1441 93d7ae8e Allen Kay
}
1442 93d7ae8e Allen Kay
/* get Vendor Specific Capability Structure register group size */
1443 93d7ae8e Allen Kay
static int xen_pt_vendor_size_init(XenPCIPassthroughState *s,
1444 93d7ae8e Allen Kay
                                   const XenPTRegGroupInfo *grp_reg,
1445 93d7ae8e Allen Kay
                                   uint32_t base_offset, uint8_t *size)
1446 93d7ae8e Allen Kay
{
1447 93d7ae8e Allen Kay
    *size = pci_get_byte(s->dev.config + base_offset + 0x02);
1448 93d7ae8e Allen Kay
    return 0;
1449 93d7ae8e Allen Kay
}
1450 93d7ae8e Allen Kay
/* get PCI Express Capability Structure register group size */
1451 93d7ae8e Allen Kay
static int xen_pt_pcie_size_init(XenPCIPassthroughState *s,
1452 93d7ae8e Allen Kay
                                 const XenPTRegGroupInfo *grp_reg,
1453 93d7ae8e Allen Kay
                                 uint32_t base_offset, uint8_t *size)
1454 93d7ae8e Allen Kay
{
1455 93d7ae8e Allen Kay
    PCIDevice *d = &s->dev;
1456 93d7ae8e Allen Kay
    uint8_t version = get_capability_version(s, base_offset);
1457 93d7ae8e Allen Kay
    uint8_t type = get_device_type(s, base_offset);
1458 93d7ae8e Allen Kay
    uint8_t pcie_size = 0;
1459 93d7ae8e Allen Kay
1460 93d7ae8e Allen Kay
1461 93d7ae8e Allen Kay
    /* calculate size depend on capability version and device/port type */
1462 93d7ae8e Allen Kay
    /* in case of PCI Express Base Specification Rev 1.x */
1463 93d7ae8e Allen Kay
    if (version == 1) {
1464 93d7ae8e Allen Kay
        /* The PCI Express Capabilities, Device Capabilities, and Device
1465 93d7ae8e Allen Kay
         * Status/Control registers are required for all PCI Express devices.
1466 93d7ae8e Allen Kay
         * The Link Capabilities and Link Status/Control are required for all
1467 93d7ae8e Allen Kay
         * Endpoints that are not Root Complex Integrated Endpoints. Endpoints
1468 93d7ae8e Allen Kay
         * are not required to implement registers other than those listed
1469 93d7ae8e Allen Kay
         * above and terminate the capability structure.
1470 93d7ae8e Allen Kay
         */
1471 93d7ae8e Allen Kay
        switch (type) {
1472 93d7ae8e Allen Kay
        case PCI_EXP_TYPE_ENDPOINT:
1473 93d7ae8e Allen Kay
        case PCI_EXP_TYPE_LEG_END:
1474 93d7ae8e Allen Kay
            pcie_size = 0x14;
1475 93d7ae8e Allen Kay
            break;
1476 93d7ae8e Allen Kay
        case PCI_EXP_TYPE_RC_END:
1477 93d7ae8e Allen Kay
            /* has no link */
1478 93d7ae8e Allen Kay
            pcie_size = 0x0C;
1479 93d7ae8e Allen Kay
            break;
1480 93d7ae8e Allen Kay
            /* only EndPoint passthrough is supported */
1481 93d7ae8e Allen Kay
        case PCI_EXP_TYPE_ROOT_PORT:
1482 93d7ae8e Allen Kay
        case PCI_EXP_TYPE_UPSTREAM:
1483 93d7ae8e Allen Kay
        case PCI_EXP_TYPE_DOWNSTREAM:
1484 93d7ae8e Allen Kay
        case PCI_EXP_TYPE_PCI_BRIDGE:
1485 93d7ae8e Allen Kay
        case PCI_EXP_TYPE_PCIE_BRIDGE:
1486 93d7ae8e Allen Kay
        case PCI_EXP_TYPE_RC_EC:
1487 93d7ae8e Allen Kay
        default:
1488 93d7ae8e Allen Kay
            XEN_PT_ERR(d, "Unsupported device/port type %#x.\n", type);
1489 93d7ae8e Allen Kay
            return -1;
1490 93d7ae8e Allen Kay
        }
1491 93d7ae8e Allen Kay
    }
1492 93d7ae8e Allen Kay
    /* in case of PCI Express Base Specification Rev 2.0 */
1493 93d7ae8e Allen Kay
    else if (version == 2) {
1494 93d7ae8e Allen Kay
        switch (type) {
1495 93d7ae8e Allen Kay
        case PCI_EXP_TYPE_ENDPOINT:
1496 93d7ae8e Allen Kay
        case PCI_EXP_TYPE_LEG_END:
1497 93d7ae8e Allen Kay
        case PCI_EXP_TYPE_RC_END:
1498 93d7ae8e Allen Kay
            /* For Functions that do not implement the registers,
1499 93d7ae8e Allen Kay
             * these spaces must be hardwired to 0b.
1500 93d7ae8e Allen Kay
             */
1501 93d7ae8e Allen Kay
            pcie_size = 0x3C;
1502 93d7ae8e Allen Kay
            break;
1503 93d7ae8e Allen Kay
            /* only EndPoint passthrough is supported */
1504 93d7ae8e Allen Kay
        case PCI_EXP_TYPE_ROOT_PORT:
1505 93d7ae8e Allen Kay
        case PCI_EXP_TYPE_UPSTREAM:
1506 93d7ae8e Allen Kay
        case PCI_EXP_TYPE_DOWNSTREAM:
1507 93d7ae8e Allen Kay
        case PCI_EXP_TYPE_PCI_BRIDGE:
1508 93d7ae8e Allen Kay
        case PCI_EXP_TYPE_PCIE_BRIDGE:
1509 93d7ae8e Allen Kay
        case PCI_EXP_TYPE_RC_EC:
1510 93d7ae8e Allen Kay
        default:
1511 93d7ae8e Allen Kay
            XEN_PT_ERR(d, "Unsupported device/port type %#x.\n", type);
1512 93d7ae8e Allen Kay
            return -1;
1513 93d7ae8e Allen Kay
        }
1514 93d7ae8e Allen Kay
    } else {
1515 93d7ae8e Allen Kay
        XEN_PT_ERR(d, "Unsupported capability version %#x.\n", version);
1516 93d7ae8e Allen Kay
        return -1;
1517 93d7ae8e Allen Kay
    }
1518 93d7ae8e Allen Kay
1519 93d7ae8e Allen Kay
    *size = pcie_size;
1520 93d7ae8e Allen Kay
    return 0;
1521 93d7ae8e Allen Kay
}
1522 3854ca57 Jiang Yunhong
/* get MSI Capability Structure register group size */
1523 3854ca57 Jiang Yunhong
static int xen_pt_msi_size_init(XenPCIPassthroughState *s,
1524 3854ca57 Jiang Yunhong
                                const XenPTRegGroupInfo *grp_reg,
1525 3854ca57 Jiang Yunhong
                                uint32_t base_offset, uint8_t *size)
1526 3854ca57 Jiang Yunhong
{
1527 3854ca57 Jiang Yunhong
    PCIDevice *d = &s->dev;
1528 3854ca57 Jiang Yunhong
    uint16_t msg_ctrl = 0;
1529 3854ca57 Jiang Yunhong
    uint8_t msi_size = 0xa;
1530 3854ca57 Jiang Yunhong
1531 3854ca57 Jiang Yunhong
    msg_ctrl = pci_get_word(d->config + (base_offset + PCI_MSI_FLAGS));
1532 3854ca57 Jiang Yunhong
1533 3854ca57 Jiang Yunhong
    /* check if 64-bit address is capable of per-vector masking */
1534 3854ca57 Jiang Yunhong
    if (msg_ctrl & PCI_MSI_FLAGS_64BIT) {
1535 3854ca57 Jiang Yunhong
        msi_size += 4;
1536 3854ca57 Jiang Yunhong
    }
1537 3854ca57 Jiang Yunhong
    if (msg_ctrl & PCI_MSI_FLAGS_MASKBIT) {
1538 3854ca57 Jiang Yunhong
        msi_size += 10;
1539 3854ca57 Jiang Yunhong
    }
1540 3854ca57 Jiang Yunhong
1541 3854ca57 Jiang Yunhong
    s->msi = g_new0(XenPTMSI, 1);
1542 3854ca57 Jiang Yunhong
    s->msi->pirq = XEN_PT_UNASSIGNED_PIRQ;
1543 3854ca57 Jiang Yunhong
1544 3854ca57 Jiang Yunhong
    *size = msi_size;
1545 3854ca57 Jiang Yunhong
    return 0;
1546 3854ca57 Jiang Yunhong
}
1547 3854ca57 Jiang Yunhong
/* get MSI-X Capability Structure register group size */
1548 3854ca57 Jiang Yunhong
static int xen_pt_msix_size_init(XenPCIPassthroughState *s,
1549 3854ca57 Jiang Yunhong
                                 const XenPTRegGroupInfo *grp_reg,
1550 3854ca57 Jiang Yunhong
                                 uint32_t base_offset, uint8_t *size)
1551 3854ca57 Jiang Yunhong
{
1552 3854ca57 Jiang Yunhong
    int rc = 0;
1553 3854ca57 Jiang Yunhong
1554 3854ca57 Jiang Yunhong
    rc = xen_pt_msix_init(s, base_offset);
1555 3854ca57 Jiang Yunhong
1556 3854ca57 Jiang Yunhong
    if (rc < 0) {
1557 3854ca57 Jiang Yunhong
        XEN_PT_ERR(&s->dev, "Internal error: Invalid xen_pt_msix_init.\n");
1558 3854ca57 Jiang Yunhong
        return rc;
1559 3854ca57 Jiang Yunhong
    }
1560 3854ca57 Jiang Yunhong
1561 3854ca57 Jiang Yunhong
    *size = grp_reg->grp_size;
1562 3854ca57 Jiang Yunhong
    return 0;
1563 3854ca57 Jiang Yunhong
}
1564 3854ca57 Jiang Yunhong
1565 93d7ae8e Allen Kay
1566 93d7ae8e Allen Kay
static const XenPTRegGroupInfo xen_pt_emu_reg_grps[] = {
1567 93d7ae8e Allen Kay
    /* Header Type0 reg group */
1568 93d7ae8e Allen Kay
    {
1569 93d7ae8e Allen Kay
        .grp_id      = 0xFF,
1570 93d7ae8e Allen Kay
        .grp_type    = XEN_PT_GRP_TYPE_EMU,
1571 93d7ae8e Allen Kay
        .grp_size    = 0x40,
1572 93d7ae8e Allen Kay
        .size_init   = xen_pt_reg_grp_size_init,
1573 93d7ae8e Allen Kay
        .emu_regs = xen_pt_emu_reg_header0,
1574 93d7ae8e Allen Kay
    },
1575 93d7ae8e Allen Kay
    /* PCI PowerManagement Capability reg group */
1576 93d7ae8e Allen Kay
    {
1577 93d7ae8e Allen Kay
        .grp_id      = PCI_CAP_ID_PM,
1578 93d7ae8e Allen Kay
        .grp_type    = XEN_PT_GRP_TYPE_EMU,
1579 93d7ae8e Allen Kay
        .grp_size    = PCI_PM_SIZEOF,
1580 93d7ae8e Allen Kay
        .size_init   = xen_pt_reg_grp_size_init,
1581 93d7ae8e Allen Kay
        .emu_regs = xen_pt_emu_reg_pm,
1582 93d7ae8e Allen Kay
    },
1583 93d7ae8e Allen Kay
    /* AGP Capability Structure reg group */
1584 93d7ae8e Allen Kay
    {
1585 93d7ae8e Allen Kay
        .grp_id     = PCI_CAP_ID_AGP,
1586 93d7ae8e Allen Kay
        .grp_type   = XEN_PT_GRP_TYPE_HARDWIRED,
1587 93d7ae8e Allen Kay
        .grp_size   = 0x30,
1588 93d7ae8e Allen Kay
        .size_init  = xen_pt_reg_grp_size_init,
1589 93d7ae8e Allen Kay
    },
1590 93d7ae8e Allen Kay
    /* Vital Product Data Capability Structure reg group */
1591 93d7ae8e Allen Kay
    {
1592 93d7ae8e Allen Kay
        .grp_id      = PCI_CAP_ID_VPD,
1593 93d7ae8e Allen Kay
        .grp_type    = XEN_PT_GRP_TYPE_EMU,
1594 93d7ae8e Allen Kay
        .grp_size    = 0x08,
1595 93d7ae8e Allen Kay
        .size_init   = xen_pt_reg_grp_size_init,
1596 93d7ae8e Allen Kay
        .emu_regs = xen_pt_emu_reg_vpd,
1597 93d7ae8e Allen Kay
    },
1598 93d7ae8e Allen Kay
    /* Slot Identification reg group */
1599 93d7ae8e Allen Kay
    {
1600 93d7ae8e Allen Kay
        .grp_id     = PCI_CAP_ID_SLOTID,
1601 93d7ae8e Allen Kay
        .grp_type   = XEN_PT_GRP_TYPE_HARDWIRED,
1602 93d7ae8e Allen Kay
        .grp_size   = 0x04,
1603 93d7ae8e Allen Kay
        .size_init  = xen_pt_reg_grp_size_init,
1604 93d7ae8e Allen Kay
    },
1605 3854ca57 Jiang Yunhong
    /* MSI Capability Structure reg group */
1606 3854ca57 Jiang Yunhong
    {
1607 3854ca57 Jiang Yunhong
        .grp_id      = PCI_CAP_ID_MSI,
1608 3854ca57 Jiang Yunhong
        .grp_type    = XEN_PT_GRP_TYPE_EMU,
1609 3854ca57 Jiang Yunhong
        .grp_size    = 0xFF,
1610 3854ca57 Jiang Yunhong
        .size_init   = xen_pt_msi_size_init,
1611 3854ca57 Jiang Yunhong
        .emu_regs = xen_pt_emu_reg_msi,
1612 3854ca57 Jiang Yunhong
    },
1613 93d7ae8e Allen Kay
    /* PCI-X Capabilities List Item reg group */
1614 93d7ae8e Allen Kay
    {
1615 93d7ae8e Allen Kay
        .grp_id     = PCI_CAP_ID_PCIX,
1616 93d7ae8e Allen Kay
        .grp_type   = XEN_PT_GRP_TYPE_HARDWIRED,
1617 93d7ae8e Allen Kay
        .grp_size   = 0x18,
1618 93d7ae8e Allen Kay
        .size_init  = xen_pt_reg_grp_size_init,
1619 93d7ae8e Allen Kay
    },
1620 93d7ae8e Allen Kay
    /* Vendor Specific Capability Structure reg group */
1621 93d7ae8e Allen Kay
    {
1622 93d7ae8e Allen Kay
        .grp_id      = PCI_CAP_ID_VNDR,
1623 93d7ae8e Allen Kay
        .grp_type    = XEN_PT_GRP_TYPE_EMU,
1624 93d7ae8e Allen Kay
        .grp_size    = 0xFF,
1625 93d7ae8e Allen Kay
        .size_init   = xen_pt_vendor_size_init,
1626 93d7ae8e Allen Kay
        .emu_regs = xen_pt_emu_reg_vendor,
1627 93d7ae8e Allen Kay
    },
1628 93d7ae8e Allen Kay
    /* SHPC Capability List Item reg group */
1629 93d7ae8e Allen Kay
    {
1630 93d7ae8e Allen Kay
        .grp_id     = PCI_CAP_ID_SHPC,
1631 93d7ae8e Allen Kay
        .grp_type   = XEN_PT_GRP_TYPE_HARDWIRED,
1632 93d7ae8e Allen Kay
        .grp_size   = 0x08,
1633 93d7ae8e Allen Kay
        .size_init  = xen_pt_reg_grp_size_init,
1634 93d7ae8e Allen Kay
    },
1635 93d7ae8e Allen Kay
    /* Subsystem ID and Subsystem Vendor ID Capability List Item reg group */
1636 93d7ae8e Allen Kay
    {
1637 93d7ae8e Allen Kay
        .grp_id     = PCI_CAP_ID_SSVID,
1638 93d7ae8e Allen Kay
        .grp_type   = XEN_PT_GRP_TYPE_HARDWIRED,
1639 93d7ae8e Allen Kay
        .grp_size   = 0x08,
1640 93d7ae8e Allen Kay
        .size_init  = xen_pt_reg_grp_size_init,
1641 93d7ae8e Allen Kay
    },
1642 93d7ae8e Allen Kay
    /* AGP 8x Capability Structure reg group */
1643 93d7ae8e Allen Kay
    {
1644 93d7ae8e Allen Kay
        .grp_id     = PCI_CAP_ID_AGP3,
1645 93d7ae8e Allen Kay
        .grp_type   = XEN_PT_GRP_TYPE_HARDWIRED,
1646 93d7ae8e Allen Kay
        .grp_size   = 0x30,
1647 93d7ae8e Allen Kay
        .size_init  = xen_pt_reg_grp_size_init,
1648 93d7ae8e Allen Kay
    },
1649 93d7ae8e Allen Kay
    /* PCI Express Capability Structure reg group */
1650 93d7ae8e Allen Kay
    {
1651 93d7ae8e Allen Kay
        .grp_id      = PCI_CAP_ID_EXP,
1652 93d7ae8e Allen Kay
        .grp_type    = XEN_PT_GRP_TYPE_EMU,
1653 93d7ae8e Allen Kay
        .grp_size    = 0xFF,
1654 93d7ae8e Allen Kay
        .size_init   = xen_pt_pcie_size_init,
1655 93d7ae8e Allen Kay
        .emu_regs = xen_pt_emu_reg_pcie,
1656 93d7ae8e Allen Kay
    },
1657 3854ca57 Jiang Yunhong
    /* MSI-X Capability Structure reg group */
1658 3854ca57 Jiang Yunhong
    {
1659 3854ca57 Jiang Yunhong
        .grp_id      = PCI_CAP_ID_MSIX,
1660 3854ca57 Jiang Yunhong
        .grp_type    = XEN_PT_GRP_TYPE_EMU,
1661 3854ca57 Jiang Yunhong
        .grp_size    = 0x0C,
1662 3854ca57 Jiang Yunhong
        .size_init   = xen_pt_msix_size_init,
1663 3854ca57 Jiang Yunhong
        .emu_regs = xen_pt_emu_reg_msix,
1664 3854ca57 Jiang Yunhong
    },
1665 93d7ae8e Allen Kay
    {
1666 93d7ae8e Allen Kay
        .grp_size = 0,
1667 93d7ae8e Allen Kay
    },
1668 93d7ae8e Allen Kay
};
1669 93d7ae8e Allen Kay
1670 93d7ae8e Allen Kay
/* initialize Capabilities Pointer or Next Pointer register */
1671 93d7ae8e Allen Kay
static int xen_pt_ptr_reg_init(XenPCIPassthroughState *s,
1672 93d7ae8e Allen Kay
                               XenPTRegInfo *reg, uint32_t real_offset,
1673 93d7ae8e Allen Kay
                               uint32_t *data)
1674 93d7ae8e Allen Kay
{
1675 93d7ae8e Allen Kay
    int i;
1676 93d7ae8e Allen Kay
    uint8_t *config = s->dev.config;
1677 93d7ae8e Allen Kay
    uint32_t reg_field = pci_get_byte(config + real_offset);
1678 93d7ae8e Allen Kay
    uint8_t cap_id = 0;
1679 93d7ae8e Allen Kay
1680 93d7ae8e Allen Kay
    /* find capability offset */
1681 93d7ae8e Allen Kay
    while (reg_field) {
1682 93d7ae8e Allen Kay
        for (i = 0; xen_pt_emu_reg_grps[i].grp_size != 0; i++) {
1683 93d7ae8e Allen Kay
            if (xen_pt_hide_dev_cap(&s->real_device,
1684 93d7ae8e Allen Kay
                                    xen_pt_emu_reg_grps[i].grp_id)) {
1685 93d7ae8e Allen Kay
                continue;
1686 93d7ae8e Allen Kay
            }
1687 93d7ae8e Allen Kay
1688 93d7ae8e Allen Kay
            cap_id = pci_get_byte(config + reg_field + PCI_CAP_LIST_ID);
1689 93d7ae8e Allen Kay
            if (xen_pt_emu_reg_grps[i].grp_id == cap_id) {
1690 93d7ae8e Allen Kay
                if (xen_pt_emu_reg_grps[i].grp_type == XEN_PT_GRP_TYPE_EMU) {
1691 93d7ae8e Allen Kay
                    goto out;
1692 93d7ae8e Allen Kay
                }
1693 93d7ae8e Allen Kay
                /* ignore the 0 hardwired capability, find next one */
1694 93d7ae8e Allen Kay
                break;
1695 93d7ae8e Allen Kay
            }
1696 93d7ae8e Allen Kay
        }
1697 93d7ae8e Allen Kay
1698 93d7ae8e Allen Kay
        /* next capability */
1699 93d7ae8e Allen Kay
        reg_field = pci_get_byte(config + reg_field + PCI_CAP_LIST_NEXT);
1700 93d7ae8e Allen Kay
    }
1701 93d7ae8e Allen Kay
1702 93d7ae8e Allen Kay
out:
1703 93d7ae8e Allen Kay
    *data = reg_field;
1704 93d7ae8e Allen Kay
    return 0;
1705 93d7ae8e Allen Kay
}
1706 93d7ae8e Allen Kay
1707 93d7ae8e Allen Kay
1708 93d7ae8e Allen Kay
/*************
1709 93d7ae8e Allen Kay
 * Main
1710 93d7ae8e Allen Kay
 */
1711 93d7ae8e Allen Kay
1712 93d7ae8e Allen Kay
static uint8_t find_cap_offset(XenPCIPassthroughState *s, uint8_t cap)
1713 93d7ae8e Allen Kay
{
1714 93d7ae8e Allen Kay
    uint8_t id;
1715 93d7ae8e Allen Kay
    unsigned max_cap = PCI_CAP_MAX;
1716 93d7ae8e Allen Kay
    uint8_t pos = PCI_CAPABILITY_LIST;
1717 93d7ae8e Allen Kay
    uint8_t status = 0;
1718 93d7ae8e Allen Kay
1719 93d7ae8e Allen Kay
    if (xen_host_pci_get_byte(&s->real_device, PCI_STATUS, &status)) {
1720 93d7ae8e Allen Kay
        return 0;
1721 93d7ae8e Allen Kay
    }
1722 93d7ae8e Allen Kay
    if ((status & PCI_STATUS_CAP_LIST) == 0) {
1723 93d7ae8e Allen Kay
        return 0;
1724 93d7ae8e Allen Kay
    }
1725 93d7ae8e Allen Kay
1726 93d7ae8e Allen Kay
    while (max_cap--) {
1727 93d7ae8e Allen Kay
        if (xen_host_pci_get_byte(&s->real_device, pos, &pos)) {
1728 93d7ae8e Allen Kay
            break;
1729 93d7ae8e Allen Kay
        }
1730 93d7ae8e Allen Kay
        if (pos < PCI_CONFIG_HEADER_SIZE) {
1731 93d7ae8e Allen Kay
            break;
1732 93d7ae8e Allen Kay
        }
1733 93d7ae8e Allen Kay
1734 93d7ae8e Allen Kay
        pos &= ~3;
1735 93d7ae8e Allen Kay
        if (xen_host_pci_get_byte(&s->real_device,
1736 93d7ae8e Allen Kay
                                  pos + PCI_CAP_LIST_ID, &id)) {
1737 93d7ae8e Allen Kay
            break;
1738 93d7ae8e Allen Kay
        }
1739 93d7ae8e Allen Kay
1740 93d7ae8e Allen Kay
        if (id == 0xff) {
1741 93d7ae8e Allen Kay
            break;
1742 93d7ae8e Allen Kay
        }
1743 93d7ae8e Allen Kay
        if (id == cap) {
1744 93d7ae8e Allen Kay
            return pos;
1745 93d7ae8e Allen Kay
        }
1746 93d7ae8e Allen Kay
1747 93d7ae8e Allen Kay
        pos += PCI_CAP_LIST_NEXT;
1748 93d7ae8e Allen Kay
    }
1749 93d7ae8e Allen Kay
    return 0;
1750 93d7ae8e Allen Kay
}
1751 93d7ae8e Allen Kay
1752 93d7ae8e Allen Kay
static int xen_pt_config_reg_init(XenPCIPassthroughState *s,
1753 93d7ae8e Allen Kay
                                  XenPTRegGroup *reg_grp, XenPTRegInfo *reg)
1754 93d7ae8e Allen Kay
{
1755 93d7ae8e Allen Kay
    XenPTReg *reg_entry;
1756 93d7ae8e Allen Kay
    uint32_t data = 0;
1757 93d7ae8e Allen Kay
    int rc = 0;
1758 93d7ae8e Allen Kay
1759 93d7ae8e Allen Kay
    reg_entry = g_new0(XenPTReg, 1);
1760 93d7ae8e Allen Kay
    reg_entry->reg = reg;
1761 93d7ae8e Allen Kay
1762 93d7ae8e Allen Kay
    if (reg->init) {
1763 93d7ae8e Allen Kay
        /* initialize emulate register */
1764 93d7ae8e Allen Kay
        rc = reg->init(s, reg_entry->reg,
1765 93d7ae8e Allen Kay
                       reg_grp->base_offset + reg->offset, &data);
1766 93d7ae8e Allen Kay
        if (rc < 0) {
1767 93d7ae8e Allen Kay
            free(reg_entry);
1768 93d7ae8e Allen Kay
            return rc;
1769 93d7ae8e Allen Kay
        }
1770 93d7ae8e Allen Kay
        if (data == XEN_PT_INVALID_REG) {
1771 93d7ae8e Allen Kay
            /* free unused BAR register entry */
1772 93d7ae8e Allen Kay
            free(reg_entry);
1773 93d7ae8e Allen Kay
            return 0;
1774 93d7ae8e Allen Kay
        }
1775 93d7ae8e Allen Kay
        /* set register value */
1776 93d7ae8e Allen Kay
        reg_entry->data = data;
1777 93d7ae8e Allen Kay
    }
1778 93d7ae8e Allen Kay
    /* list add register entry */
1779 93d7ae8e Allen Kay
    QLIST_INSERT_HEAD(&reg_grp->reg_tbl_list, reg_entry, entries);
1780 93d7ae8e Allen Kay
1781 93d7ae8e Allen Kay
    return 0;
1782 93d7ae8e Allen Kay
}
1783 93d7ae8e Allen Kay
1784 93d7ae8e Allen Kay
int xen_pt_config_init(XenPCIPassthroughState *s)
1785 93d7ae8e Allen Kay
{
1786 93d7ae8e Allen Kay
    int i, rc;
1787 93d7ae8e Allen Kay
1788 93d7ae8e Allen Kay
    QLIST_INIT(&s->reg_grps);
1789 93d7ae8e Allen Kay
1790 93d7ae8e Allen Kay
    for (i = 0; xen_pt_emu_reg_grps[i].grp_size != 0; i++) {
1791 93d7ae8e Allen Kay
        uint32_t reg_grp_offset = 0;
1792 93d7ae8e Allen Kay
        XenPTRegGroup *reg_grp_entry = NULL;
1793 93d7ae8e Allen Kay
1794 93d7ae8e Allen Kay
        if (xen_pt_emu_reg_grps[i].grp_id != 0xFF) {
1795 93d7ae8e Allen Kay
            if (xen_pt_hide_dev_cap(&s->real_device,
1796 93d7ae8e Allen Kay
                                    xen_pt_emu_reg_grps[i].grp_id)) {
1797 93d7ae8e Allen Kay
                continue;
1798 93d7ae8e Allen Kay
            }
1799 93d7ae8e Allen Kay
1800 93d7ae8e Allen Kay
            reg_grp_offset = find_cap_offset(s, xen_pt_emu_reg_grps[i].grp_id);
1801 93d7ae8e Allen Kay
1802 93d7ae8e Allen Kay
            if (!reg_grp_offset) {
1803 93d7ae8e Allen Kay
                continue;
1804 93d7ae8e Allen Kay
            }
1805 93d7ae8e Allen Kay
        }
1806 93d7ae8e Allen Kay
1807 93d7ae8e Allen Kay
        reg_grp_entry = g_new0(XenPTRegGroup, 1);
1808 93d7ae8e Allen Kay
        QLIST_INIT(&reg_grp_entry->reg_tbl_list);
1809 93d7ae8e Allen Kay
        QLIST_INSERT_HEAD(&s->reg_grps, reg_grp_entry, entries);
1810 93d7ae8e Allen Kay
1811 93d7ae8e Allen Kay
        reg_grp_entry->base_offset = reg_grp_offset;
1812 93d7ae8e Allen Kay
        reg_grp_entry->reg_grp = xen_pt_emu_reg_grps + i;
1813 93d7ae8e Allen Kay
        if (xen_pt_emu_reg_grps[i].size_init) {
1814 93d7ae8e Allen Kay
            /* get register group size */
1815 93d7ae8e Allen Kay
            rc = xen_pt_emu_reg_grps[i].size_init(s, reg_grp_entry->reg_grp,
1816 93d7ae8e Allen Kay
                                                  reg_grp_offset,
1817 93d7ae8e Allen Kay
                                                  &reg_grp_entry->size);
1818 93d7ae8e Allen Kay
            if (rc < 0) {
1819 93d7ae8e Allen Kay
                xen_pt_config_delete(s);
1820 93d7ae8e Allen Kay
                return rc;
1821 93d7ae8e Allen Kay
            }
1822 93d7ae8e Allen Kay
        }
1823 93d7ae8e Allen Kay
1824 93d7ae8e Allen Kay
        if (xen_pt_emu_reg_grps[i].grp_type == XEN_PT_GRP_TYPE_EMU) {
1825 93d7ae8e Allen Kay
            if (xen_pt_emu_reg_grps[i].emu_regs) {
1826 93d7ae8e Allen Kay
                int j = 0;
1827 93d7ae8e Allen Kay
                XenPTRegInfo *regs = xen_pt_emu_reg_grps[i].emu_regs;
1828 93d7ae8e Allen Kay
                /* initialize capability register */
1829 93d7ae8e Allen Kay
                for (j = 0; regs->size != 0; j++, regs++) {
1830 93d7ae8e Allen Kay
                    /* initialize capability register */
1831 93d7ae8e Allen Kay
                    rc = xen_pt_config_reg_init(s, reg_grp_entry, regs);
1832 93d7ae8e Allen Kay
                    if (rc < 0) {
1833 93d7ae8e Allen Kay
                        xen_pt_config_delete(s);
1834 93d7ae8e Allen Kay
                        return rc;
1835 93d7ae8e Allen Kay
                    }
1836 93d7ae8e Allen Kay
                }
1837 93d7ae8e Allen Kay
            }
1838 93d7ae8e Allen Kay
        }
1839 93d7ae8e Allen Kay
    }
1840 93d7ae8e Allen Kay
1841 93d7ae8e Allen Kay
    return 0;
1842 93d7ae8e Allen Kay
}
1843 93d7ae8e Allen Kay
1844 93d7ae8e Allen Kay
/* delete all emulate register */
1845 93d7ae8e Allen Kay
void xen_pt_config_delete(XenPCIPassthroughState *s)
1846 93d7ae8e Allen Kay
{
1847 93d7ae8e Allen Kay
    struct XenPTRegGroup *reg_group, *next_grp;
1848 93d7ae8e Allen Kay
    struct XenPTReg *reg, *next_reg;
1849 93d7ae8e Allen Kay
1850 3854ca57 Jiang Yunhong
    /* free MSI/MSI-X info table */
1851 3854ca57 Jiang Yunhong
    if (s->msix) {
1852 3854ca57 Jiang Yunhong
        xen_pt_msix_delete(s);
1853 3854ca57 Jiang Yunhong
    }
1854 3854ca57 Jiang Yunhong
    if (s->msi) {
1855 3854ca57 Jiang Yunhong
        g_free(s->msi);
1856 3854ca57 Jiang Yunhong
    }
1857 3854ca57 Jiang Yunhong
1858 93d7ae8e Allen Kay
    /* free all register group entry */
1859 93d7ae8e Allen Kay
    QLIST_FOREACH_SAFE(reg_group, &s->reg_grps, entries, next_grp) {
1860 93d7ae8e Allen Kay
        /* free all register entry */
1861 93d7ae8e Allen Kay
        QLIST_FOREACH_SAFE(reg, &reg_group->reg_tbl_list, entries, next_reg) {
1862 93d7ae8e Allen Kay
            QLIST_REMOVE(reg, entries);
1863 93d7ae8e Allen Kay
            g_free(reg);
1864 93d7ae8e Allen Kay
        }
1865 93d7ae8e Allen Kay
1866 93d7ae8e Allen Kay
        QLIST_REMOVE(reg_group, entries);
1867 93d7ae8e Allen Kay
        g_free(reg_group);
1868 93d7ae8e Allen Kay
    }
1869 93d7ae8e Allen Kay
}