[GitHub/mt8127/android_kernel_alcatel_ttab.git] / drivers / char / mspec.c

/*
 * Copyright (C) 2001-2006 Silicon Graphics, Inc.  All rights
 * reserved.
 *
 * This program is free software; you can redistribute it and/or modify it
 * under the terms of version 2 of the GNU General Public License
 * as published by the Free Software Foundation.
 */

/*
 * SN Platform Special Memory (mspec) Support
 *
 * This driver exports the SN special memory (mspec) facility to user
 * processes.
 * There are three types of memory made available thru this driver:
 * fetchops, uncached and cached.
 *
 * Fetchops are atomic memory operations that are implemented in the
 * memory controller on SGI SN hardware.
 *
 * Uncached are used for memory write combining feature of the ia64
 * cpu.
 *
 * Cached are used for areas of memory that are used as cached addresses
 * on our partition and used as uncached addresses from other partitions.
 * Due to a design constraint of the SN2 Shub, you can not have processors
 * on the same FSB perform both a cached and uncached reference to the
 * same cache line.  These special memory cached regions prevent the
 * kernel from ever dropping in a TLB entry and therefore prevent the
 * processor from ever speculating a cache line from this page.
 */

#include <linux/types.h>
#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/init.h>
#include <linux/errno.h>
#include <linux/miscdevice.h>
#include <linux/spinlock.h>
#include <linux/mm.h>
#include <linux/fs.h>
#include <linux/vmalloc.h>
#include <linux/string.h>
#include <linux/slab.h>
#include <linux/numa.h>
#include <asm/page.h>
#include <asm/pgtable.h>
#include <linux/atomic.h>
#include <asm/tlbflush.h>
#include <asm/uncached.h>
#include <asm/sn/addrs.h>
#include <asm/sn/arch.h>
#include <asm/sn/mspec.h>
#include <asm/sn/sn_cpuid.h>
#include <asm/sn/io.h>
#include <asm/sn/bte.h>
#include <asm/sn/shubio.h>


#define FETCHOP_ID	"SGI Fetchop,"
#define CACHED_ID	"Cached,"
#define UNCACHED_ID	"Uncached"
#define REVISION	"4.0"
#define MSPEC_BASENAME	"mspec"

/*
 * Page types allocated by the device.
 */
enum mspec_page_type {
	MSPEC_FETCHOP = 1,
	MSPEC_CACHED,
	MSPEC_UNCACHED
};

#ifdef CONFIG_SGI_SN
static int is_sn2;
#else
#define is_sn2		0
#endif

/*
 * One of these structures is allocated when an mspec region is mmaped. The
 * structure is pointed to by the vma->vm_private_data field in the vma struct.
 * This structure is used to record the addresses of the mspec pages.
 * This structure is shared by all vma's that are split off from the
 * original vma when split_vma()'s are done.
 *
 * The refcnt is incremented atomically because mm->mmap_sem does not
 * protect in fork case where multiple tasks share the vma_data.
 */
struct vma_data {
	atomic_t refcnt;	/* Number of vmas sharing the data. */
	spinlock_t lock;	/* Serialize access to this structure. */
	int count;		/* Number of pages allocated. */
	enum mspec_page_type type; /* Type of pages allocated. */
	int flags;		/* See VMD_xxx below. */
	unsigned long vm_start;	/* Original (unsplit) base. */
	unsigned long vm_end;	/* Original (unsplit) end. */
	unsigned long maddr[0];	/* Array of MSPEC addresses. */
};

#define VMD_VMALLOCED 0x1	/* vmalloc'd rather than kmalloc'd */

/* used on shub2 to clear FOP cache in the HUB */
static unsigned long scratch_page[MAX_NUMNODES];
#define SH2_AMO_CACHE_ENTRIES	4

static inline int
mspec_zero_block(unsigned long addr, int len)
{
	int status;

	if (is_sn2) {
		if (is_shub2()) {
			int nid;
			void *p;
			int i;

			nid = nasid_to_cnodeid(get_node_number(__pa(addr)));
			p = (void *)TO_AMO(scratch_page[nid]);

			for (i=0; i < SH2_AMO_CACHE_ENTRIES; i++) {
				FETCHOP_LOAD_OP(p, FETCHOP_LOAD);
				p += FETCHOP_VAR_SIZE;
			}
		}

		status = bte_copy(0, addr & ~__IA64_UNCACHED_OFFSET, len,
				  BTE_WACQUIRE | BTE_ZERO_FILL, NULL);
	} else {
		memset((char *) addr, 0, len);
		status = 0;
	}
	return status;
}

/*
 * mspec_open
 *
 * Called when a device mapping is created by a means other than mmap
 * (via fork, munmap, etc.).  Increments the reference count on the
 * underlying mspec data so it is not freed prematurely.
 */
static void
mspec_open(struct vm_area_struct *vma)
{
	struct vma_data *vdata;

	vdata = vma->vm_private_data;
	atomic_inc(&vdata->refcnt);
}

/*
 * mspec_close
 *
 * Called when unmapping a device mapping. Frees all mspec pages
 * belonging to all the vma's sharing this vma_data structure.
 */
static void
mspec_close(struct vm_area_struct *vma)
{
	struct vma_data *vdata;
	int index, last_index;
	unsigned long my_page;

	vdata = vma->vm_private_data;

	if (!atomic_dec_and_test(&vdata->refcnt))
		return;

	last_index = (vdata->vm_end - vdata->vm_start) >> PAGE_SHIFT;
	for (index = 0; index < last_index; index++) {
		if (vdata->maddr[index] == 0)
			continue;
		/*
		 * Clear the page before sticking it back
		 * into the pool.
		 */
		my_page = vdata->maddr[index];
		vdata->maddr[index] = 0;
		if (!mspec_zero_block(my_page, PAGE_SIZE))
			uncached_free_page(my_page, 1);
		else
			printk(KERN_WARNING "mspec_close(): "
			       "failed to zero page %ld\n", my_page);
	}

	if (vdata->flags & VMD_VMALLOCED)
		vfree(vdata);
	else
		kfree(vdata);
}

/*
 * mspec_fault
 *
 * Creates a mspec page and maps it to user space.
 */
static int
mspec_fault(struct vm_area_struct *vma, struct vm_fault *vmf)
{
	unsigned long paddr, maddr;
	unsigned long pfn;
	pgoff_t index = vmf->pgoff;
	struct vma_data *vdata = vma->vm_private_data;

	maddr = (volatile unsigned long) vdata->maddr[index];
	if (maddr == 0) {
		maddr = uncached_alloc_page(numa_node_id(), 1);
		if (maddr == 0)
			return VM_FAULT_OOM;

		spin_lock(&vdata->lock);
		if (vdata->maddr[index] == 0) {
			vdata->count++;
			vdata->maddr[index] = maddr;
		} else {
			uncached_free_page(maddr, 1);
			maddr = vdata->maddr[index];
		}
		spin_unlock(&vdata->lock);
	}

	if (vdata->type == MSPEC_FETCHOP)
		paddr = TO_AMO(maddr);
	else
		paddr = maddr & ~__IA64_UNCACHED_OFFSET;

	pfn = paddr >> PAGE_SHIFT;

	/*
	 * vm_insert_pfn can fail with -EBUSY, but in that case it will
	 * be because another thread has installed the pte first, so it
	 * is no problem.
	 */
	vm_insert_pfn(vma, (unsigned long)vmf->virtual_address, pfn);

	return VM_FAULT_NOPAGE;
}

static const struct vm_operations_struct mspec_vm_ops = {
	.open = mspec_open,
	.close = mspec_close,
	.fault = mspec_fault,
};

/*
 * mspec_mmap
 *
 * Called when mmapping the device.  Initializes the vma with a fault handler
 * and private data structure necessary to allocate, track, and free the
 * underlying pages.
 */
static int
mspec_mmap(struct file *file, struct vm_area_struct *vma,
					enum mspec_page_type type)
{
	struct vma_data *vdata;
	int pages, vdata_size, flags = 0;

	if (vma->vm_pgoff != 0)
		return -EINVAL;

	if ((vma->vm_flags & VM_SHARED) == 0)
		return -EINVAL;

	if ((vma->vm_flags & VM_WRITE) == 0)
		return -EPERM;

	pages = (vma->vm_end - vma->vm_start) >> PAGE_SHIFT;
	vdata_size = sizeof(struct vma_data) + pages * sizeof(long);
	if (vdata_size <= PAGE_SIZE)
		vdata = kzalloc(vdata_size, GFP_KERNEL);
	else {
		vdata = vzalloc(vdata_size);
		flags = VMD_VMALLOCED;
	}
	if (!vdata)
		return -ENOMEM;

	vdata->vm_start = vma->vm_start;
	vdata->vm_end = vma->vm_end;
	vdata->flags = flags;
	vdata->type = type;
	spin_lock_init(&vdata->lock);
	atomic_set(&vdata->refcnt, 1);
	vma->vm_private_data = vdata;

	vma->vm_flags |= VM_IO | VM_PFNMAP | VM_DONTEXPAND | VM_DONTDUMP;
	if (vdata->type == MSPEC_FETCHOP || vdata->type == MSPEC_UNCACHED)
		vma->vm_page_prot = pgprot_noncached(vma->vm_page_prot);
	vma->vm_ops = &mspec_vm_ops;

	return 0;
}

static int
fetchop_mmap(struct file *file, struct vm_area_struct *vma)
{
	return mspec_mmap(file, vma, MSPEC_FETCHOP);
}

static int
cached_mmap(struct file *file, struct vm_area_struct *vma)
{
	return mspec_mmap(file, vma, MSPEC_CACHED);
}

static int
uncached_mmap(struct file *file, struct vm_area_struct *vma)
{
	return mspec_mmap(file, vma, MSPEC_UNCACHED);
}

static const struct file_operations fetchop_fops = {
	.owner = THIS_MODULE,
	.mmap = fetchop_mmap,
	.llseek = noop_llseek,
};

static struct miscdevice fetchop_miscdev = {
	.minor = MISC_DYNAMIC_MINOR,
	.name = "sgi_fetchop",
	.fops = &fetchop_fops
};

static const struct file_operations cached_fops = {
	.owner = THIS_MODULE,
	.mmap = cached_mmap,
	.llseek = noop_llseek,
};

static struct miscdevice cached_miscdev = {
	.minor = MISC_DYNAMIC_MINOR,
	.name = "mspec_cached",
	.fops = &cached_fops
};

static const struct file_operations uncached_fops = {
	.owner = THIS_MODULE,
	.mmap = uncached_mmap,
	.llseek = noop_llseek,
};

static struct miscdevice uncached_miscdev = {
	.minor = MISC_DYNAMIC_MINOR,
	.name = "mspec_uncached",
	.fops = &uncached_fops
};

/*
 * mspec_init
 *
 * Called at boot time to initialize the mspec facility.
 */
static int __init
mspec_init(void)
{
	int ret;
	int nid;

	/*
	 * The fetchop device only works on SN2 hardware, uncached and cached
	 * memory drivers should both be valid on all ia64 hardware
	 */
#ifdef CONFIG_SGI_SN
	if (ia64_platform_is("sn2")) {
		is_sn2 = 1;
		if (is_shub2()) {
			ret = -ENOMEM;
			for_each_node_state(nid, N_ONLINE) {
				int actual_nid;
				int nasid;
				unsigned long phys;

				scratch_page[nid] = uncached_alloc_page(nid, 1);
				if (scratch_page[nid] == 0)
					goto free_scratch_pages;
				phys = __pa(scratch_page[nid]);
				nasid = get_node_number(phys);
				actual_nid = nasid_to_cnodeid(nasid);
				if (actual_nid != nid)
					goto free_scratch_pages;
			}
		}

		ret = misc_register(&fetchop_miscdev);
		if (ret) {
			printk(KERN_ERR
			       "%s: failed to register device %i\n",
			       FETCHOP_ID, ret);
			goto free_scratch_pages;
		}
	}
#endif
	ret = misc_register(&cached_miscdev);
	if (ret) {
		printk(KERN_ERR "%s: failed to register device %i\n",
		       CACHED_ID, ret);
		if (is_sn2)
			misc_deregister(&fetchop_miscdev);
		goto free_scratch_pages;
	}
	ret = misc_register(&uncached_miscdev);
	if (ret) {
		printk(KERN_ERR "%s: failed to register device %i\n",
		       UNCACHED_ID, ret);
		misc_deregister(&cached_miscdev);
		if (is_sn2)
			misc_deregister(&fetchop_miscdev);
		goto free_scratch_pages;
	}

	printk(KERN_INFO "%s %s initialized devices: %s %s %s\n",
	       MSPEC_BASENAME, REVISION, is_sn2 ? FETCHOP_ID : "",
	       CACHED_ID, UNCACHED_ID);

	return 0;

 free_scratch_pages:
	for_each_node(nid) {
		if (scratch_page[nid] != 0)
			uncached_free_page(scratch_page[nid], 1);
	}
	return ret;
}

static void __exit
mspec_exit(void)
{
	int nid;

	misc_deregister(&uncached_miscdev);
	misc_deregister(&cached_miscdev);
	if (is_sn2) {
		misc_deregister(&fetchop_miscdev);

		for_each_node(nid) {
			if (scratch_page[nid] != 0)
				uncached_free_page(scratch_page[nid], 1);
		}
	}
}

module_init(mspec_init);
module_exit(mspec_exit);

MODULE_AUTHOR("Silicon Graphics, Inc. <linux-altix@sgi.com>");
MODULE_DESCRIPTION("Driver for SGI SN special memory operations");
MODULE_LICENSE("GPL");
Commit	Line	Data
17a3b050 JS	1	/*
	2	* Copyright (C) 2001-2006 Silicon Graphics, Inc. All rights
	3	* reserved.
	4	*
	5	* This program is free software; you can redistribute it and/or modify it
	6	* under the terms of version 2 of the GNU General Public License
	7	* as published by the Free Software Foundation.
	8	*/
	9
	10	/*
	11	* SN Platform Special Memory (mspec) Support
	12	*
	13	* This driver exports the SN special memory (mspec) facility to user
	14	* processes.
	15	* There are three types of memory made available thru this driver:
	16	* fetchops, uncached and cached.
	17	*
	18	* Fetchops are atomic memory operations that are implemented in the
	19	* memory controller on SGI SN hardware.
	20	*
	21	* Uncached are used for memory write combining feature of the ia64
	22	* cpu.
	23	*
	24	* Cached are used for areas of memory that are used as cached addresses
	25	* on our partition and used as uncached addresses from other partitions.
	26	* Due to a design constraint of the SN2 Shub, you can not have processors
	27	* on the same FSB perform both a cached and uncached reference to the
	28	* same cache line. These special memory cached regions prevent the
	29	* kernel from ever dropping in a TLB entry and therefore prevent the
	30	* processor from ever speculating a cache line from this page.
	31	*/
	32
17a3b050 JS	33	#include <linux/types.h>
	34	#include <linux/kernel.h>
	35	#include <linux/module.h>
	36	#include <linux/init.h>
	37	#include <linux/errno.h>
	38	#include <linux/miscdevice.h>
	39	#include <linux/spinlock.h>
	40	#include <linux/mm.h>
4e950f6f	41	#include <linux/fs.h>
17a3b050 JS	42	#include <linux/vmalloc.h>
	43	#include <linux/string.h>
	44	#include <linux/slab.h>
	45	#include <linux/numa.h>
	46	#include <asm/page.h>
17a3b050	47	#include <asm/pgtable.h>
60063497	48	#include <linux/atomic.h>
17a3b050 JS	49	#include <asm/tlbflush.h>
	50	#include <asm/uncached.h>
	51	#include <asm/sn/addrs.h>
	52	#include <asm/sn/arch.h>
	53	#include <asm/sn/mspec.h>
	54	#include <asm/sn/sn_cpuid.h>
	55	#include <asm/sn/io.h>
	56	#include <asm/sn/bte.h>
	57	#include <asm/sn/shubio.h>
	58
	59
	60	#define FETCHOP_ID "SGI Fetchop,"
	61	#define CACHED_ID "Cached,"
	62	#define UNCACHED_ID "Uncached"
	63	#define REVISION "4.0"
	64	#define MSPEC_BASENAME "mspec"
	65
	66	/*
	67	* Page types allocated by the device.
	68	*/
4191ba26	69	enum mspec_page_type {
17a3b050 JS	70	MSPEC_FETCHOP = 1,
	71	MSPEC_CACHED,
	72	MSPEC_UNCACHED
	73	};
	74
1a4b0fc5	75	#ifdef CONFIG_SGI_SN
17a3b050	76	static int is_sn2;
1a4b0fc5 JS	77	#else
	78	#define is_sn2 0
	79	#endif
17a3b050 JS	80
	81	/*
	82	* One of these structures is allocated when an mspec region is mmaped. The
	83	* structure is pointed to by the vma->vm_private_data field in the vma struct.
	84	* This structure is used to record the addresses of the mspec pages.
4191ba26 CW	85	* This structure is shared by all vma's that are split off from the
	86	* original vma when split_vma()'s are done.
	87	*
	88	* The refcnt is incremented atomically because mm->mmap_sem does not
	89	* protect in fork case where multiple tasks share the vma_data.
17a3b050 JS	90	*/
	91	struct vma_data {
	92	atomic_t refcnt; /* Number of vmas sharing the data. */
4191ba26	93	spinlock_t lock; /* Serialize access to this structure. */
17a3b050	94	int count; /* Number of pages allocated. */
4191ba26 CW	95	enum mspec_page_type type; /* Type of pages allocated. */
	96	int flags; /* See VMD_xxx below. */
	97	unsigned long vm_start; /* Original (unsplit) base. */
	98	unsigned long vm_end; /* Original (unsplit) end. */
17a3b050 JS	99	unsigned long maddr[0]; /* Array of MSPEC addresses. */
	100	};
	101
4191ba26 CW	102	#define VMD_VMALLOCED 0x1 /* vmalloc'd rather than kmalloc'd */
4191ba26 CW	103
17a3b050 JS	104	/* used on shub2 to clear FOP cache in the HUB */
	105	static unsigned long scratch_page[MAX_NUMNODES];
	106	#define SH2_AMO_CACHE_ENTRIES 4
	107
	108	static inline int
	109	mspec_zero_block(unsigned long addr, int len)
	110	{
	111	int status;
	112
	113	if (is_sn2) {
	114	if (is_shub2()) {
	115	int nid;
	116	void *p;
	117	int i;
	118
	119	nid = nasid_to_cnodeid(get_node_number(__pa(addr)));
	120	p = (void *)TO_AMO(scratch_page[nid]);
	121
	122	for (i=0; i < SH2_AMO_CACHE_ENTRIES; i++) {
	123	FETCHOP_LOAD_OP(p, FETCHOP_LOAD);
	124	p += FETCHOP_VAR_SIZE;
	125	}
	126	}
	127
	128	status = bte_copy(0, addr & ~__IA64_UNCACHED_OFFSET, len,
	129	BTE_WACQUIRE \| BTE_ZERO_FILL, NULL);
	130	} else {
	131	memset((char *) addr, 0, len);
	132	status = 0;
	133	}
	134	return status;
	135	}
	136
	137	/*
	138	* mspec_open
	139	*
	140	* Called when a device mapping is created by a means other than mmap
4191ba26 CW	141	* (via fork, munmap, etc.). Increments the reference count on the
4191ba26 CW	142	* underlying mspec data so it is not freed prematurely.
17a3b050 JS	143	*/
	144	static void
	145	mspec_open(struct vm_area_struct *vma)
	146	{
	147	struct vma_data *vdata;
	148
	149	vdata = vma->vm_private_data;
	150	atomic_inc(&vdata->refcnt);
	151	}
	152
	153	/*
	154	* mspec_close
	155	*
	156	* Called when unmapping a device mapping. Frees all mspec pages
afa684f6	157	* belonging to all the vma's sharing this vma_data structure.
17a3b050 JS	158	*/
	159	static void
	160	mspec_close(struct vm_area_struct *vma)
	161	{
	162	struct vma_data *vdata;
afa684f6	163	int index, last_index;
4191ba26	164	unsigned long my_page;
17a3b050 JS	165
17a3b050 JS	166	vdata = vma->vm_private_data;
17a3b050	167
afa684f6 CW	168	if (!atomic_dec_and_test(&vdata->refcnt))
afa684f6 CW	169	return;
4191ba26	170
afa684f6 CW	171	last_index = (vdata->vm_end - vdata->vm_start) >> PAGE_SHIFT;
afa684f6 CW	172	for (index = 0; index < last_index; index++) {
4191ba26	173	if (vdata->maddr[index] == 0)
17a3b050 JS	174	continue;
	175	/*
	176	* Clear the page before sticking it back
	177	* into the pool.
	178	*/
4191ba26 CW	179	my_page = vdata->maddr[index];
4191ba26 CW	180	vdata->maddr[index] = 0;
afa684f6	181	if (!mspec_zero_block(my_page, PAGE_SIZE))
e4a064df	182	uncached_free_page(my_page, 1);
17a3b050 JS	183	else
17a3b050 JS	184	printk(KERN_WARNING "mspec_close(): "
afa684f6	185	"failed to zero page %ld\n", my_page);
17a3b050	186	}
4191ba26 CW	187
4191ba26 CW	188	if (vdata->flags & VMD_VMALLOCED)
17a3b050	189	vfree(vdata);
4191ba26 CW	190	else
4191ba26 CW	191	kfree(vdata);
17a3b050 JS	192	}
17a3b050 JS	193
17a3b050	194	/*
efe9e779	195	* mspec_fault
17a3b050 JS	196	*
	197	* Creates a mspec page and maps it to user space.
	198	*/
efe9e779 NP	199	static int
efe9e779 NP	200	mspec_fault(struct vm_area_struct vma, struct vm_fault vmf)
17a3b050 JS	201	{
	202	unsigned long paddr, maddr;
	203	unsigned long pfn;
efe9e779	204	pgoff_t index = vmf->pgoff;
17a3b050 JS	205	struct vma_data *vdata = vma->vm_private_data;
17a3b050 JS	206
17a3b050 JS	207	maddr = (volatile unsigned long) vdata->maddr[index];
17a3b050 JS	208	if (maddr == 0) {
e4a064df	209	maddr = uncached_alloc_page(numa_node_id(), 1);
17a3b050	210	if (maddr == 0)
efe9e779	211	return VM_FAULT_OOM;
17a3b050 JS	212
	213	spin_lock(&vdata->lock);
	214	if (vdata->maddr[index] == 0) {
	215	vdata->count++;
	216	vdata->maddr[index] = maddr;
	217	} else {
e4a064df	218	uncached_free_page(maddr, 1);
17a3b050 JS	219	maddr = vdata->maddr[index];
	220	}
	221	spin_unlock(&vdata->lock);
	222	}
	223
	224	if (vdata->type == MSPEC_FETCHOP)
	225	paddr = TO_AMO(maddr);
	226	else
1a4b0fc5	227	paddr = maddr & ~__IA64_UNCACHED_OFFSET;
17a3b050 JS	228
	229	pfn = paddr >> PAGE_SHIFT;
	230
efe9e779 NP	231	/*
	232	* vm_insert_pfn can fail with -EBUSY, but in that case it will
	233	* be because another thread has installed the pte first, so it
	234	* is no problem.
	235	*/
	236	vm_insert_pfn(vma, (unsigned long)vmf->virtual_address, pfn);
	237
	238	return VM_FAULT_NOPAGE;
17a3b050 JS	239	}
17a3b050 JS	240
f0f37e2f	241	static const struct vm_operations_struct mspec_vm_ops = {
17a3b050 JS	242	.open = mspec_open,
17a3b050 JS	243	.close = mspec_close,
efe9e779	244	.fault = mspec_fault,
17a3b050 JS	245	};
	246
	247	/*
	248	* mspec_mmap
	249	*
af901ca1	250	* Called when mmapping the device. Initializes the vma with a fault handler
17a3b050 JS	251	* and private data structure necessary to allocate, track, and free the
	252	* underlying pages.
	253	*/
	254	static int
4191ba26 CW	255	mspec_mmap(struct file file, struct vm_area_struct vma,
4191ba26 CW	256	enum mspec_page_type type)
17a3b050 JS	257	{
17a3b050 JS	258	struct vma_data *vdata;
4191ba26	259	int pages, vdata_size, flags = 0;
17a3b050 JS	260
	261	if (vma->vm_pgoff != 0)
	262	return -EINVAL;
	263
	264	if ((vma->vm_flags & VM_SHARED) == 0)
	265	return -EINVAL;
	266
	267	if ((vma->vm_flags & VM_WRITE) == 0)
	268	return -EPERM;
	269
	270	pages = (vma->vm_end - vma->vm_start) >> PAGE_SHIFT;
	271	vdata_size = sizeof(struct vma_data) + pages * sizeof(long);
	272	if (vdata_size <= PAGE_SIZE)
658c74cf	273	vdata = kzalloc(vdata_size, GFP_KERNEL);
4191ba26	274	else {
658c74cf	275	vdata = vzalloc(vdata_size);
4191ba26 CW	276	flags = VMD_VMALLOCED;
4191ba26 CW	277	}
17a3b050 JS	278	if (!vdata)
17a3b050 JS	279	return -ENOMEM;
17a3b050	280
4191ba26 CW	281	vdata->vm_start = vma->vm_start;
	282	vdata->vm_end = vma->vm_end;
	283	vdata->flags = flags;
17a3b050 JS	284	vdata->type = type;
17a3b050 JS	285	spin_lock_init(&vdata->lock);
a1193655	286	atomic_set(&vdata->refcnt, 1);
17a3b050 JS	287	vma->vm_private_data = vdata;
17a3b050 JS	288
314e51b9	289	vma->vm_flags \|= VM_IO \| VM_PFNMAP \| VM_DONTEXPAND \| VM_DONTDUMP;
17a3b050 JS	290	if (vdata->type == MSPEC_FETCHOP \|\| vdata->type == MSPEC_UNCACHED)
	291	vma->vm_page_prot = pgprot_noncached(vma->vm_page_prot);
	292	vma->vm_ops = &mspec_vm_ops;
	293
	294	return 0;
	295	}
	296
	297	static int
	298	fetchop_mmap(struct file file, struct vm_area_struct vma)
	299	{
	300	return mspec_mmap(file, vma, MSPEC_FETCHOP);
	301	}
	302
	303	static int
	304	cached_mmap(struct file file, struct vm_area_struct vma)
	305	{
	306	return mspec_mmap(file, vma, MSPEC_CACHED);
	307	}
	308
	309	static int
	310	uncached_mmap(struct file file, struct vm_area_struct vma)
	311	{
	312	return mspec_mmap(file, vma, MSPEC_UNCACHED);
	313	}
	314
2b8693c0	315	static const struct file_operations fetchop_fops = {
17a3b050	316	.owner = THIS_MODULE,
6038f373 AB	317	.mmap = fetchop_mmap,
6038f373 AB	318	.llseek = noop_llseek,
17a3b050 JS	319	};
	320
	321	static struct miscdevice fetchop_miscdev = {
	322	.minor = MISC_DYNAMIC_MINOR,
	323	.name = "sgi_fetchop",
	324	.fops = &fetchop_fops
	325	};
	326
2b8693c0	327	static const struct file_operations cached_fops = {
17a3b050	328	.owner = THIS_MODULE,
6038f373 AB	329	.mmap = cached_mmap,
6038f373 AB	330	.llseek = noop_llseek,
17a3b050 JS	331	};
	332
	333	static struct miscdevice cached_miscdev = {
	334	.minor = MISC_DYNAMIC_MINOR,
	335	.name = "mspec_cached",
	336	.fops = &cached_fops
	337	};
	338
2b8693c0	339	static const struct file_operations uncached_fops = {
17a3b050	340	.owner = THIS_MODULE,
6038f373 AB	341	.mmap = uncached_mmap,
6038f373 AB	342	.llseek = noop_llseek,
17a3b050 JS	343	};
	344
	345	static struct miscdevice uncached_miscdev = {
	346	.minor = MISC_DYNAMIC_MINOR,
	347	.name = "mspec_uncached",
	348	.fops = &uncached_fops
	349	};
	350
	351	/*
	352	* mspec_init
	353	*
	354	* Called at boot time to initialize the mspec facility.
	355	*/
	356	static int __init
	357	mspec_init(void)
	358	{
	359	int ret;
	360	int nid;
	361
	362	/*
	363	* The fetchop device only works on SN2 hardware, uncached and cached
	364	* memory drivers should both be valid on all ia64 hardware
	365	*/
1a4b0fc5	366	#ifdef CONFIG_SGI_SN
17a3b050 JS	367	if (ia64_platform_is("sn2")) {
	368	is_sn2 = 1;
	369	if (is_shub2()) {
	370	ret = -ENOMEM;
2dca53a9	371	for_each_node_state(nid, N_ONLINE) {
17a3b050 JS	372	int actual_nid;
	373	int nasid;
	374	unsigned long phys;
	375
e4a064df	376	scratch_page[nid] = uncached_alloc_page(nid, 1);
17a3b050 JS	377	if (scratch_page[nid] == 0)
	378	goto free_scratch_pages;
	379	phys = __pa(scratch_page[nid]);
	380	nasid = get_node_number(phys);
	381	actual_nid = nasid_to_cnodeid(nasid);
	382	if (actual_nid != nid)
	383	goto free_scratch_pages;
	384	}
	385	}
	386
	387	ret = misc_register(&fetchop_miscdev);
	388	if (ret) {
	389	printk(KERN_ERR
	390	"%s: failed to register device %i\n",
	391	FETCHOP_ID, ret);
	392	goto free_scratch_pages;
	393	}
	394	}
1a4b0fc5	395	#endif
17a3b050 JS	396	ret = misc_register(&cached_miscdev);
	397	if (ret) {
	398	printk(KERN_ERR "%s: failed to register device %i\n",
	399	CACHED_ID, ret);
	400	if (is_sn2)
	401	misc_deregister(&fetchop_miscdev);
	402	goto free_scratch_pages;
	403	}
	404	ret = misc_register(&uncached_miscdev);
	405	if (ret) {
	406	printk(KERN_ERR "%s: failed to register device %i\n",
	407	UNCACHED_ID, ret);
	408	misc_deregister(&cached_miscdev);
	409	if (is_sn2)
	410	misc_deregister(&fetchop_miscdev);
	411	goto free_scratch_pages;
	412	}
	413
	414	printk(KERN_INFO "%s %s initialized devices: %s %s %s\n",
	415	MSPEC_BASENAME, REVISION, is_sn2 ? FETCHOP_ID : "",
	416	CACHED_ID, UNCACHED_ID);
	417
	418	return 0;
	419
	420	free_scratch_pages:
	421	for_each_node(nid) {
	422	if (scratch_page[nid] != 0)
e4a064df	423	uncached_free_page(scratch_page[nid], 1);
17a3b050 JS	424	}
	425	return ret;
	426	}
	427
	428	static void __exit
	429	mspec_exit(void)
	430	{
	431	int nid;
	432
	433	misc_deregister(&uncached_miscdev);
	434	misc_deregister(&cached_miscdev);
	435	if (is_sn2) {
	436	misc_deregister(&fetchop_miscdev);
	437
	438	for_each_node(nid) {
	439	if (scratch_page[nid] != 0)
e4a064df	440	uncached_free_page(scratch_page[nid], 1);
17a3b050 JS	441	}
	442	}
	443	}
	444
	445	module_init(mspec_init);
	446	module_exit(mspec_exit);
	447
	448	MODULE_AUTHOR("Silicon Graphics, Inc. <linux-altix@sgi.com>");
	449	MODULE_DESCRIPTION("Driver for SGI SN special memory operations");
	450	MODULE_LICENSE("GPL");