[linux-2.6-block.git] / arch / x86 / kernel / vsmp_64.c

/*
 * vSMPowered(tm) systems specific initialization
 * Copyright (C) 2005 ScaleMP Inc.
 *
 * Use of this code is subject to the terms and conditions of the
 * GNU general public license version 2. See "COPYING" or
 * http://www.gnu.org/licenses/gpl.html
 *
 * Ravikiran Thirumalai <kiran@scalemp.com>,
 * Shai Fultheim <shai@scalemp.com>
 * Paravirt ops integration: Glauber de Oliveira Costa <gcosta@redhat.com>,
 *			     Ravikiran Thirumalai <kiran@scalemp.com>
 */

#include <linux/init.h>
#include <linux/pci_ids.h>
#include <linux/pci_regs.h>
#include <asm/pci-direct.h>
#include <asm/io.h>
#include <asm/paravirt.h>

#if defined CONFIG_PCI && defined CONFIG_PARAVIRT
/*
 * Interrupt control on vSMPowered systems:
 * ~AC is a shadow of IF.  If IF is 'on' AC should be 'off'
 * and vice versa.
 */

static unsigned long vsmp_save_fl(void)
{
	unsigned long flags = native_save_fl();

	if (!(flags & X86_EFLAGS_IF) || (flags & X86_EFLAGS_AC))
		flags &= ~X86_EFLAGS_IF;
	return flags;
}

static void vsmp_restore_fl(unsigned long flags)
{
	if (flags & X86_EFLAGS_IF)
		flags &= ~X86_EFLAGS_AC;
	else
		flags |= X86_EFLAGS_AC;
	native_restore_fl(flags);
}

static void vsmp_irq_disable(void)
{
	unsigned long flags = native_save_fl();

	native_restore_fl((flags & ~X86_EFLAGS_IF) | X86_EFLAGS_AC);
}

static void vsmp_irq_enable(void)
{
	unsigned long flags = native_save_fl();

	native_restore_fl((flags | X86_EFLAGS_IF) & (~X86_EFLAGS_AC));
}

static unsigned __init vsmp_patch(u8 type, u16 clobbers, void *ibuf,
				  unsigned long addr, unsigned len)
{
	switch (type) {
	case PARAVIRT_PATCH(pv_irq_ops.irq_enable):
	case PARAVIRT_PATCH(pv_irq_ops.irq_disable):
	case PARAVIRT_PATCH(pv_irq_ops.save_fl):
	case PARAVIRT_PATCH(pv_irq_ops.restore_fl):
		return paravirt_patch_default(type, clobbers, ibuf, addr, len);
	default:
		return native_patch(type, clobbers, ibuf, addr, len);
	}

}

static void __init set_vsmp_pv_ops(void)
{
	void *address;
	unsigned int cap, ctl, cfg;

	/* set vSMP magic bits to indicate vSMP capable kernel */
	cfg = read_pci_config(0, 0x1f, 0, PCI_BASE_ADDRESS_0);
	address = early_ioremap(cfg, 8);
	cap = readl(address);
	ctl = readl(address + 4);
	printk(KERN_INFO "vSMP CTL: capabilities:0x%08x  control:0x%08x\n",
	       cap, ctl);
	if (cap & ctl & (1 << 4)) {
		/* Setup irq ops and turn on vSMP  IRQ fastpath handling */
		pv_irq_ops.irq_disable = vsmp_irq_disable;
		pv_irq_ops.irq_enable  = vsmp_irq_enable;
		pv_irq_ops.save_fl  = vsmp_save_fl;
		pv_irq_ops.restore_fl  = vsmp_restore_fl;
		pv_init_ops.patch = vsmp_patch;

		ctl &= ~(1 << 4);
		writel(ctl, address + 4);
		ctl = readl(address + 4);
		printk(KERN_INFO "vSMP CTL: control set to:0x%08x\n", ctl);
	}

	early_iounmap(address, 8);
}
#else
static void __init set_vsmp_pv_ops(void)
{
}
#endif

#ifdef CONFIG_PCI
static int vsmp = -1;

int is_vsmp_box(void)
{
	if (vsmp != -1)
		return vsmp;

	vsmp = 0;
	if (!early_pci_allowed())
		return vsmp;

	/* Check if we are running on a ScaleMP vSMP box */
	if (read_pci_config(0, 0x1f, 0, PCI_VENDOR_ID) ==
	     (PCI_VENDOR_ID_SCALEMP | (PCI_DEVICE_ID_SCALEMP_VSMP_CTL << 16)))
		vsmp = 1;

	return vsmp;
}
#else
int is_vsmp_box(void)
{
	return 0;
}
#endif

void __init vsmp_init(void)
{
	if (!is_vsmp_box())
		return;

	set_vsmp_pv_ops();
	return;
}
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>
96597fd2 GC	11	* Paravirt ops integration: Glauber de Oliveira Costa <gcosta@redhat.com>,
96597fd2 GC	12	* Ravikiran Thirumalai <kiran@scalemp.com>
79f12614 RT	13	*/
	14
	15	#include <linux/init.h>
	16	#include <linux/pci_ids.h>
	17	#include <linux/pci_regs.h>
	18	#include <asm/pci-direct.h>
734c4c67	19	#include <asm/io.h>
96597fd2 GC	20	#include <asm/paravirt.h>
96597fd2 GC	21
aa7d8e25	22	#if defined CONFIG_PCI && defined CONFIG_PARAVIRT
96597fd2 GC	23	/*
	24	* Interrupt control on vSMPowered systems:
	25	* ~AC is a shadow of IF. If IF is 'on' AC should be 'off'
	26	* and vice versa.
	27	*/
	28
	29	static unsigned long vsmp_save_fl(void)
	30	{
	31	unsigned long flags = native_save_fl();
	32
	33	if (!(flags & X86_EFLAGS_IF) \|\| (flags & X86_EFLAGS_AC))
	34	flags &= ~X86_EFLAGS_IF;
	35	return flags;
	36	}
	37
	38	static void vsmp_restore_fl(unsigned long flags)
	39	{
	40	if (flags & X86_EFLAGS_IF)
	41	flags &= ~X86_EFLAGS_AC;
	42	else
	43	flags \|= X86_EFLAGS_AC;
	44	native_restore_fl(flags);
	45	}
	46
	47	static void vsmp_irq_disable(void)
	48	{
	49	unsigned long flags = native_save_fl();
	50
	51	native_restore_fl((flags & ~X86_EFLAGS_IF) \| X86_EFLAGS_AC);
	52	}
	53
	54	static void vsmp_irq_enable(void)
	55	{
	56	unsigned long flags = native_save_fl();
	57
	58	native_restore_fl((flags \| X86_EFLAGS_IF) & (~X86_EFLAGS_AC));
	59	}
	60
	61	static unsigned __init vsmp_patch(u8 type, u16 clobbers, void *ibuf,
	62	unsigned long addr, unsigned len)
	63	{
	64	switch (type) {
	65	case PARAVIRT_PATCH(pv_irq_ops.irq_enable):
	66	case PARAVIRT_PATCH(pv_irq_ops.irq_disable):
	67	case PARAVIRT_PATCH(pv_irq_ops.save_fl):
	68	case PARAVIRT_PATCH(pv_irq_ops.restore_fl):
	69	return paravirt_patch_default(type, clobbers, ibuf, addr, len);
	70	default:
	71	return native_patch(type, clobbers, ibuf, addr, len);
	72	}
	73
	74	}
79f12614	75
aa7d8e25	76	static void __init set_vsmp_pv_ops(void)
79f12614 RT	77	{
79f12614 RT	78	void *address;
2785c8d0	79	unsigned int cap, ctl, cfg;
79f12614	80
79f12614	81	/* set vSMP magic bits to indicate vSMP capable kernel */
2785c8d0 GC	82	cfg = read_pci_config(0, 0x1f, 0, PCI_BASE_ADDRESS_0);
2785c8d0 GC	83	address = early_ioremap(cfg, 8);
79f12614 RT	84	cap = readl(address);
79f12614 RT	85	ctl = readl(address + 4);
ed4aed98 TG	86	printk(KERN_INFO "vSMP CTL: capabilities:0x%08x control:0x%08x\n",
ed4aed98 TG	87	cap, ctl);
79f12614	88	if (cap & ctl & (1 << 4)) {
9f6d8552 RT	89	/* Setup irq ops and turn on vSMP IRQ fastpath handling */
	90	pv_irq_ops.irq_disable = vsmp_irq_disable;
	91	pv_irq_ops.irq_enable = vsmp_irq_enable;
	92	pv_irq_ops.save_fl = vsmp_save_fl;
	93	pv_irq_ops.restore_fl = vsmp_restore_fl;
	94	pv_init_ops.patch = vsmp_patch;
	95
79f12614 RT	96	ctl &= ~(1 << 4);
	97	writel(ctl, address + 4);
	98	ctl = readl(address + 4);
ed4aed98	99	printk(KERN_INFO "vSMP CTL: control set to:0x%08x\n", ctl);
79f12614 RT	100	}
79f12614 RT	101
2785c8d0	102	early_iounmap(address, 8);
aa7d8e25 RT	103	}
	104	#else
	105	static void __init set_vsmp_pv_ops(void)
	106	{
	107	}
	108	#endif
	109
	110	#ifdef CONFIG_PCI
	111	static int vsmp = -1;
	112
	113	int is_vsmp_box(void)
	114	{
	115	if (vsmp != -1)
	116	return vsmp;
	117
	118	vsmp = 0;
	119	if (!early_pci_allowed())
	120	return vsmp;
	121
	122	/* Check if we are running on a ScaleMP vSMP box */
6542fe80 IM	123	if (read_pci_config(0, 0x1f, 0, PCI_VENDOR_ID) ==
6542fe80 IM	124	(PCI_VENDOR_ID_SCALEMP \| (PCI_DEVICE_ID_SCALEMP_VSMP_CTL << 16)))
aa7d8e25 RT	125	vsmp = 1;
	126
	127	return vsmp;
	128	}
	129	#else
	130	int is_vsmp_box(void)
	131	{
	132	return 0;
	133	}
	134	#endif
	135
	136	void __init vsmp_init(void)
	137	{
	138	if (!is_vsmp_box())
	139	return;
	140
	141	set_vsmp_pv_ops();
a2beab31	142	return;
79f12614	143	}