Commit | Line | Data |
---|---|---|
79f12614 RT |
1 | /* |
2 | * vSMPowered(tm) systems specific initialization | |
3 | * Copyright (C) 2005 ScaleMP Inc. | |
4 | * | |
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 | |
8 | * | |
9 | * Ravikiran Thirumalai <kiran@scalemp.com>, | |
10 | * Shai Fultheim <shai@scalemp.com> | |
11 | */ | |
12 | ||
13 | #include <linux/init.h> | |
14 | #include <linux/pci_ids.h> | |
15 | #include <linux/pci_regs.h> | |
16 | #include <asm/pci-direct.h> | |
734c4c67 | 17 | #include <asm/io.h> |
79f12614 | 18 | |
2785c8d0 | 19 | void __init vsmp_init(void) |
79f12614 RT |
20 | { |
21 | void *address; | |
2785c8d0 | 22 | unsigned int cap, ctl, cfg; |
79f12614 | 23 | |
0637a70a | 24 | if (!early_pci_allowed()) |
a2beab31 | 25 | return; |
0637a70a | 26 | |
79f12614 | 27 | /* Check if we are running on a ScaleMP vSMP box */ |
ed4aed98 TG |
28 | if ((read_pci_config_16(0, 0x1f, 0, PCI_VENDOR_ID) != |
29 | PCI_VENDOR_ID_SCALEMP) || | |
30 | (read_pci_config_16(0, 0x1f, 0, PCI_DEVICE_ID) != | |
31 | PCI_DEVICE_ID_SCALEMP_VSMP_CTL)) | |
a2beab31 | 32 | return; |
79f12614 RT |
33 | |
34 | /* set vSMP magic bits to indicate vSMP capable kernel */ | |
2785c8d0 GC |
35 | cfg = read_pci_config(0, 0x1f, 0, PCI_BASE_ADDRESS_0); |
36 | address = early_ioremap(cfg, 8); | |
79f12614 RT |
37 | cap = readl(address); |
38 | ctl = readl(address + 4); | |
ed4aed98 TG |
39 | printk(KERN_INFO "vSMP CTL: capabilities:0x%08x control:0x%08x\n", |
40 | cap, ctl); | |
79f12614 RT |
41 | if (cap & ctl & (1 << 4)) { |
42 | /* Turn on vSMP IRQ fastpath handling (see system.h) */ | |
43 | ctl &= ~(1 << 4); | |
44 | writel(ctl, address + 4); | |
45 | ctl = readl(address + 4); | |
ed4aed98 | 46 | printk(KERN_INFO "vSMP CTL: control set to:0x%08x\n", ctl); |
79f12614 RT |
47 | } |
48 | ||
2785c8d0 | 49 | early_iounmap(address, 8); |
a2beab31 | 50 | return; |
79f12614 | 51 | } |