Commit cf2cf0f5 authored by Paul Bolle's avatar Paul Bolle Committed by Thomas Gleixner

lguest: Read offset of device_cap later

Read the offset of the capability with type VIRTIO_PCI_CAP_DEVICE_CFG
only when we're sure we're going to need it. Which is when all checks
have passed and we know we have a virtio console with an emerg_wr field.
Signed-off-by: default avatarPaul Bolle <pebolle@tiscali.nl>
Cc: Rusty Russell <rusty@rustcorp.com.au>
Cc: lguest@lists.ozlabs.org
Link: http://lkml.kernel.org/r/1457006501-5377-3-git-send-email-pebolle@tiscali.nlSigned-off-by: default avatarThomas Gleixner <tglx@linutronix.de>
parent 7faf90ef
...@@ -1233,8 +1233,6 @@ static void write_bar_via_cfg(u32 cfg_offset, u32 off, u32 val) ...@@ -1233,8 +1233,6 @@ static void write_bar_via_cfg(u32 cfg_offset, u32 off, u32 val)
static void probe_pci_console(void) static void probe_pci_console(void)
{ {
u8 cap, common_cap = 0, device_cap = 0; u8 cap, common_cap = 0, device_cap = 0;
/* Offset within BAR0 */
u32 device_offset;
u32 device_len; u32 device_len;
/* Avoid recursive printk into here. */ /* Avoid recursive printk into here. */
...@@ -1258,21 +1256,16 @@ static void probe_pci_console(void) ...@@ -1258,21 +1256,16 @@ static void probe_pci_console(void)
u8 vndr = read_pci_config_byte(0, 1, 0, cap); u8 vndr = read_pci_config_byte(0, 1, 0, cap);
if (vndr == PCI_CAP_ID_VNDR) { if (vndr == PCI_CAP_ID_VNDR) {
u8 type, bar; u8 type, bar;
u32 offset;
type = read_pci_config_byte(0, 1, 0, type = read_pci_config_byte(0, 1, 0,
cap + offsetof(struct virtio_pci_cap, cfg_type)); cap + offsetof(struct virtio_pci_cap, cfg_type));
bar = read_pci_config_byte(0, 1, 0, bar = read_pci_config_byte(0, 1, 0,
cap + offsetof(struct virtio_pci_cap, bar)); cap + offsetof(struct virtio_pci_cap, bar));
offset = read_pci_config(0, 1, 0,
cap + offsetof(struct virtio_pci_cap, offset));
switch (type) { switch (type) {
case VIRTIO_PCI_CAP_DEVICE_CFG: case VIRTIO_PCI_CAP_DEVICE_CFG:
if (bar == 0) { if (bar == 0)
device_cap = cap; device_cap = cap;
device_offset = offset;
}
break; break;
case VIRTIO_PCI_CAP_PCI_CFG: case VIRTIO_PCI_CAP_PCI_CFG:
console_access_cap = cap; console_access_cap = cap;
...@@ -1302,7 +1295,8 @@ static void probe_pci_console(void) ...@@ -1302,7 +1295,8 @@ static void probe_pci_console(void)
return; return;
} }
console_cfg_offset = device_offset; console_cfg_offset = read_pci_config(0, 1, 0,
device_cap + offsetof(struct virtio_pci_cap, offset));
printk(KERN_INFO "lguest: Console via virtio-pci emerg_wr\n"); printk(KERN_INFO "lguest: Console via virtio-pci emerg_wr\n");
} }
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment