patch-2.4.23 linux-2.4.23/drivers/char/drm/savage_drv.c

• Lines: 249
• Date: 2003-11-28 10:26:20.000000000 -0800
• Orig file: linux-2.4.22/drivers/char/drm/savage_drv.c
• Orig date: 1969-12-31 16:00:00.000000000 -0800

diff -urN linux-2.4.22/drivers/char/drm/savage_drv.c linux-2.4.23/drivers/char/drm/savage_drv.c
@@ -0,0 +1,248 @@
+/*
+ * Copyright 1998-2003 VIA Technologies, Inc. All Rights Reserved.
+ * Copyright 2001-2003 S3 Graphics, Inc. All Rights Reserved.
+ *
+ * Permission is hereby granted, free of charge, to any person obtaining a
+ * copy of this software and associated documentation files (the "Software"),
+ * to deal in the Software without restriction, including without limitation
+ * the rights to use, copy, modify, merge, publish, distribute, sub license,
+ * and/or sell copies of the Software, and to permit persons to whom the
+ * Software is furnished to do so, subject to the following conditions:
+ *
+ * The above copyright notice and this permission notice (including the
+ * next paragraph) shall be included in all copies or substantial portions
+ * of the Software.
+ *
+ * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
+ * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
+ * FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT. IN NO EVENT SHALL
+ * VIA, S3 GRAPHICS, AND/OR ITS SUPPLIERS BE LIABLE FOR ANY CLAIM, DAMAGES OR
+ * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
+ * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER
+ * DEALINGS IN THE SOFTWARE.
+ */
+
+#include <linux/config.h>
+#include "savage.h"
+#include "drmP.h"
+#include "savage_drv.h"
+
+#define DRIVER_AUTHOR		"John Zhao, S3 Graphics Inc."
+
+#define DRIVER_NAME		"savage"
+#define DRIVER_DESC		"Savage4 Family"
+#define DRIVER_DATE		"20011023"
+
+#define DRIVER_MAJOR		1
+#define DRIVER_MINOR		0
+#define DRIVER_PATCHLEVEL	0
+
+/* Currently Savage4 not implement DMA */
+/* mark off by Jiayo Hsu, Oct. 23, 2001*/
+
+
+#define DRIVER_IOCTLS \
+	[DRM_IOCTL_NR(DRM_IOCTL_SAVAGE_ALLOC_CONTINUOUS_MEM)] \
+	= {savage_alloc_continuous_mem,1,0},\
+	[DRM_IOCTL_NR( DRM_IOCTL_SAVAGE_GET_PHYSICS_ADDRESS)] \
+	= {savage_get_physics_address,1,0},\
+        [DRM_IOCTL_NR(DRM_IOCTL_SAVAGE_FREE_CONTINUOUS_MEM)]  \
+        = {savage_free_cont_mem,1,0}
+
+int savage_alloc_continuous_mem(struct inode *inode, struct file *filp,
+				unsigned int cmd, unsigned long arg)
+{
+	drm_savage_alloc_cont_mem_t cont_mem;
+	unsigned long size, addr;
+	void *ret;
+	int i;
+	mem_map_t *p;
+	pgprot_t flags;
+
+	/* add to list */
+	drm_file_t *priv = filp->private_data;
+	drm_device_t *dev = priv->dev;
+	drm_map_t *map;
+	drm_map_list_t *list;
+	
+	dma_addr_t pa;
+
+	if (copy_from_user(&cont_mem, (drm_savage_alloc_cont_mem_t *) arg, sizeof(cont_mem)))
+		return -EFAULT;
+
+	/*check the parameters */
+	if (cont_mem.size <= 0)
+		return -EINVAL;
+	if( 0xFFFFFFFFUL / cont_mem.size < cont_mem.type )
+		return -EINVAL;
+		
+	map = DRM(alloc) (sizeof(*map), DRM_MEM_MAPS);
+	if (!map)
+		return -ENOMEM;
+
+	size = cont_mem.type * cont_mem.size;
+
+	ret = pci_alloc_consistent(/*FIXME*/NULL, size, &pa);
+	if (ret == NULL)
+		return -ENOMEM;
+
+	/* Set the reserverd flag so that the remap_page_range can map these page */
+	for (i = 0, p = virt_to_page(ret); i < size / PAGE_SIZE; i++, p++)
+		SetPageReserved(p);
+
+	cont_mem.phyaddress = pa;
+	cont_mem.location = DRM_SAVAGE_MEM_LOCATION_PCI;	/* pci only at present */
+
+	/*Map the memory to user space */
+	down_write(&current->mm->mmap_sem);
+	addr = do_mmap(NULL, 0, size, PROT_READ | PROT_WRITE, MAP_PRIVATE, cont_mem.phyaddress);
+	if ((unsigned long)addr > -1024UL)
+	{
+		up_write(&current->mm->mmap_sem);
+		return -EINVAL;
+	}
+	pgprot_val(flags) = _PAGE_PRESENT | _PAGE_RW | _PAGE_USER;
+	if (remap_page_range(addr, cont_mem.phyaddress, size, flags))
+	{
+		up_write(&current->mm->mmap_sem);
+		return -EINVAL;
+	}
+	up_write(&current->mm->mmap_sem);
+
+	for (i = 0, p = virt_to_page(ret); i < size / PAGE_SIZE; i++, p++)
+		ClearPageReserved(p);
+
+	cont_mem.linear = addr;
+
+	/*map list */
+	map->handle = ret;	/* to distinguish with other */
+	map->offset = cont_mem.phyaddress;
+	map->size = size;
+	map->mtrr = -1;
+	/*map-flags,type?? */
+
+	list = DRM(alloc) (sizeof(*list), DRM_MEM_MAPS);
+	if (!list) {
+		DRM(free) (map, sizeof(*map), DRM_MEM_MAPS);
+		return -EINVAL;
+	}
+	memset(list, 0, sizeof(*list));
+	list->map = map;
+
+	down(&dev->struct_sem);
+	list_add(&list->head, &dev->maplist->head);
+	up(&dev->struct_sem);
+
+	if (copy_to_user((drm_savage_alloc_cont_mem_t *) arg, &cont_mem, sizeof(cont_mem)))
+		return -EFAULT;
+
+#warning "Race at the very least"
+	for (i = 0, p = virt_to_page(ret); i < size / PAGE_SIZE; i++, p++)
+		atomic_set(&p->count, 1);
+
+	return 1;		/*success */
+}
+
+int savage_get_physics_address(struct inode *inode, struct file *filp,
+			       unsigned int cmd, unsigned long arg)
+{
+
+	drm_savage_get_physcis_address_t req;
+	unsigned long buf;
+	pgd_t *pgd;
+	pmd_t *pmd;
+	pte_t *pte;
+	struct mm_struct *mm;
+
+	if (copy_from_user(&req, (drm_savage_get_physcis_address_t *) arg, sizeof(req)))
+		return -EFAULT;
+	buf = req.v_address;
+
+#warning "FIXME: need to redo logic for this"
+	/*What kind of virtual address ? */
+	if (buf >= (unsigned long) high_memory)
+		mm = &init_mm;
+	else
+		mm = current->mm;
+
+	spin_lock(&mm->page_table_lock);
+
+	pgd = pgd_offset(mm, buf);
+	pmd = pmd_offset(pgd, buf);
+	pte = pte_offset(pmd, buf);
+
+	if (!pte_present(*pte))
+	{
+		spin_unlock(&mm->page_table_lock);
+		return -EINVAL;
+	}
+	req.p_address = ((pte_val(*pte) & PAGE_MASK) | (buf & (PAGE_SIZE - 1)));
+	spin_unlock(&mm->page_table_lock);
+
+	if (copy_to_user((drm_savage_get_physcis_address_t *) arg, &req, sizeof(req)))
+		return -EFAULT;
+	return 1;
+}
+
+/*free the continuous memory*/
+int savage_free_cont_mem(struct inode *inode, struct file *filp,
+			 unsigned int cmd, unsigned long arg)
+{
+	drm_savage_alloc_cont_mem_t cont_mem;
+	unsigned long size;
+
+	/*map  list */
+	drm_file_t *priv = filp->private_data;
+	drm_device_t *dev = priv->dev;
+	drm_map_t *map;
+	struct list_head *list;
+	drm_map_list_t *r_list = NULL;
+
+	if (copy_from_user(&cont_mem, (drm_savage_alloc_cont_mem_t *) arg, sizeof(cont_mem)))
+		return -EFAULT;
+#warning "fix size overflow check"
+	size = cont_mem.type * cont_mem.size;
+	if (size <= 0)
+		return -EINVAL;
+
+	/* find the map in the list */
+	list_for_each(list, &dev->maplist->head) {
+		r_list = (drm_map_list_t *) list;
+
+		if (r_list->map && r_list->map->offset == cont_mem.phyaddress)
+			break;
+	}
+	/*find none */
+	if (list == (&dev->maplist->head)) {
+		up(&dev->struct_sem);
+		return -EINVAL;
+	}
+	map = r_list->map;
+	list_del(list);
+	DRM(free) (list, sizeof(*list), DRM_MEM_MAPS);
+
+	/*unmap the user space */
+	if (do_munmap(current->mm, cont_mem.linear, size) != 0)
+		return -EFAULT;
+	/*free the page */
+	pci_free_consistent(NULL, size, map->handle, cont_mem.phyaddress);
+
+	return 1;
+}
+
+
+#include "drm_agpsupport.h"
+#include "drm_auth.h"
+#include "drm_bufs.h"
+#include "drm_context.h"
+#include "drm_dma.h"
+#include "drm_drawable.h"
+#include "drm_drv.h"
+#include "drm_fops.h"
+#include "drm_init.h"
+#include "drm_ioctl.h"
+#include "drm_lock.h"
+#include "drm_memory.h"
+#include "drm_proc.h"
+#include "drm_vm.h"
+#include "drm_stub.h"