2 * vSMPowered(tm) systems specific initialization
3 * Copyright (C) 2005 ScaleMP Inc.
5 * Use of this code is subject to the terms and conditions of the
6 * GNU general public license version 2. See "COPYING" or
7 * http://www.gnu.org/licenses/gpl.html
9 * Ravikiran Thirumalai <kiran@scalemp.com>,
10 * Shai Fultheim <shai@scalemp.com>
11 * Paravirt ops integration: Glauber de Oliveira Costa <gcosta@redhat.com>,
12 * Ravikiran Thirumalai <kiran@scalemp.com>
15 #include <linux/init.h>
16 #include <linux/pci_ids.h>
17 #include <linux/pci_regs.h>
18 #include <asm/pci-direct.h>
20 #include <asm/paravirt.h>
23 * Interrupt control on vSMPowered systems:
24 * ~AC is a shadow of IF. If IF is 'on' AC should be 'off'
28 static unsigned long vsmp_save_fl(void)
30 unsigned long flags
= native_save_fl();
32 if (!(flags
& X86_EFLAGS_IF
) || (flags
& X86_EFLAGS_AC
))
33 flags
&= ~X86_EFLAGS_IF
;
37 static void vsmp_restore_fl(unsigned long flags
)
39 if (flags
& X86_EFLAGS_IF
)
40 flags
&= ~X86_EFLAGS_AC
;
42 flags
|= X86_EFLAGS_AC
;
43 native_restore_fl(flags
);
46 static void vsmp_irq_disable(void)
48 unsigned long flags
= native_save_fl();
50 native_restore_fl((flags
& ~X86_EFLAGS_IF
) | X86_EFLAGS_AC
);
53 static void vsmp_irq_enable(void)
55 unsigned long flags
= native_save_fl();
57 native_restore_fl((flags
| X86_EFLAGS_IF
) & (~X86_EFLAGS_AC
));
60 static unsigned __init
vsmp_patch(u8 type
, u16 clobbers
, void *ibuf
,
61 unsigned long addr
, unsigned len
)
64 case PARAVIRT_PATCH(pv_irq_ops
.irq_enable
):
65 case PARAVIRT_PATCH(pv_irq_ops
.irq_disable
):
66 case PARAVIRT_PATCH(pv_irq_ops
.save_fl
):
67 case PARAVIRT_PATCH(pv_irq_ops
.restore_fl
):
68 return paravirt_patch_default(type
, clobbers
, ibuf
, addr
, len
);
70 return native_patch(type
, clobbers
, ibuf
, addr
, len
);
75 void __init
vsmp_init(void)
78 unsigned int cap
, ctl
, cfg
;
80 if (!early_pci_allowed())
83 /* Check if we are running on a ScaleMP vSMP box */
84 if ((read_pci_config_16(0, 0x1f, 0, PCI_VENDOR_ID
) !=
85 PCI_VENDOR_ID_SCALEMP
) ||
86 (read_pci_config_16(0, 0x1f, 0, PCI_DEVICE_ID
) !=
87 PCI_DEVICE_ID_SCALEMP_VSMP_CTL
))
90 /* If we are, use the distinguished irq functions */
91 pv_irq_ops
.irq_disable
= vsmp_irq_disable
;
92 pv_irq_ops
.irq_enable
= vsmp_irq_enable
;
93 pv_irq_ops
.save_fl
= vsmp_save_fl
;
94 pv_irq_ops
.restore_fl
= vsmp_restore_fl
;
95 pv_init_ops
.patch
= vsmp_patch
;
97 /* set vSMP magic bits to indicate vSMP capable kernel */
98 cfg
= read_pci_config(0, 0x1f, 0, PCI_BASE_ADDRESS_0
);
99 address
= early_ioremap(cfg
, 8);
100 cap
= readl(address
);
101 ctl
= readl(address
+ 4);
102 printk(KERN_INFO
"vSMP CTL: capabilities:0x%08x control:0x%08x\n",
104 if (cap
& ctl
& (1 << 4)) {
105 /* Turn on vSMP IRQ fastpath handling (see system.h) */
107 writel(ctl
, address
+ 4);
108 ctl
= readl(address
+ 4);
109 printk(KERN_INFO
"vSMP CTL: control set to:0x%08x\n", ctl
);
112 early_iounmap(address
, 8);