xref: /OK3568_Linux_fs/kernel/drivers/char/agp/frontend.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun /*
2*4882a593Smuzhiyun  * AGPGART driver frontend
3*4882a593Smuzhiyun  * Copyright (C) 2004 Silicon Graphics, Inc.
4*4882a593Smuzhiyun  * Copyright (C) 2002-2003 Dave Jones
5*4882a593Smuzhiyun  * Copyright (C) 1999 Jeff Hartmann
6*4882a593Smuzhiyun  * Copyright (C) 1999 Precision Insight, Inc.
7*4882a593Smuzhiyun  * Copyright (C) 1999 Xi Graphics, Inc.
8*4882a593Smuzhiyun  *
9*4882a593Smuzhiyun  * Permission is hereby granted, free of charge, to any person obtaining a
10*4882a593Smuzhiyun  * copy of this software and associated documentation files (the "Software"),
11*4882a593Smuzhiyun  * to deal in the Software without restriction, including without limitation
12*4882a593Smuzhiyun  * the rights to use, copy, modify, merge, publish, distribute, sublicense,
13*4882a593Smuzhiyun  * and/or sell copies of the Software, and to permit persons to whom the
14*4882a593Smuzhiyun  * Software is furnished to do so, subject to the following conditions:
15*4882a593Smuzhiyun  *
16*4882a593Smuzhiyun  * The above copyright notice and this permission notice shall be included
17*4882a593Smuzhiyun  * in all copies or substantial portions of the Software.
18*4882a593Smuzhiyun  *
19*4882a593Smuzhiyun  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS
20*4882a593Smuzhiyun  * OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
21*4882a593Smuzhiyun  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
22*4882a593Smuzhiyun  * JEFF HARTMANN, OR ANY OTHER CONTRIBUTORS BE LIABLE FOR ANY CLAIM,
23*4882a593Smuzhiyun  * DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR
24*4882a593Smuzhiyun  * OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE
25*4882a593Smuzhiyun  * OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
26*4882a593Smuzhiyun  *
27*4882a593Smuzhiyun  */
28*4882a593Smuzhiyun 
29*4882a593Smuzhiyun #include <linux/types.h>
30*4882a593Smuzhiyun #include <linux/kernel.h>
31*4882a593Smuzhiyun #include <linux/module.h>
32*4882a593Smuzhiyun #include <linux/mman.h>
33*4882a593Smuzhiyun #include <linux/pci.h>
34*4882a593Smuzhiyun #include <linux/miscdevice.h>
35*4882a593Smuzhiyun #include <linux/agp_backend.h>
36*4882a593Smuzhiyun #include <linux/agpgart.h>
37*4882a593Smuzhiyun #include <linux/slab.h>
38*4882a593Smuzhiyun #include <linux/mm.h>
39*4882a593Smuzhiyun #include <linux/fs.h>
40*4882a593Smuzhiyun #include <linux/sched.h>
41*4882a593Smuzhiyun #include <linux/uaccess.h>
42*4882a593Smuzhiyun #include "agp.h"
43*4882a593Smuzhiyun 
44*4882a593Smuzhiyun struct agp_front_data agp_fe;
45*4882a593Smuzhiyun 
agp_find_mem_by_key(int key)46*4882a593Smuzhiyun struct agp_memory *agp_find_mem_by_key(int key)
47*4882a593Smuzhiyun {
48*4882a593Smuzhiyun 	struct agp_memory *curr;
49*4882a593Smuzhiyun 
50*4882a593Smuzhiyun 	if (agp_fe.current_controller == NULL)
51*4882a593Smuzhiyun 		return NULL;
52*4882a593Smuzhiyun 
53*4882a593Smuzhiyun 	curr = agp_fe.current_controller->pool;
54*4882a593Smuzhiyun 
55*4882a593Smuzhiyun 	while (curr != NULL) {
56*4882a593Smuzhiyun 		if (curr->key == key)
57*4882a593Smuzhiyun 			break;
58*4882a593Smuzhiyun 		curr = curr->next;
59*4882a593Smuzhiyun 	}
60*4882a593Smuzhiyun 
61*4882a593Smuzhiyun 	DBG("key=%d -> mem=%p", key, curr);
62*4882a593Smuzhiyun 	return curr;
63*4882a593Smuzhiyun }
64*4882a593Smuzhiyun 
agp_remove_from_pool(struct agp_memory * temp)65*4882a593Smuzhiyun static void agp_remove_from_pool(struct agp_memory *temp)
66*4882a593Smuzhiyun {
67*4882a593Smuzhiyun 	struct agp_memory *prev;
68*4882a593Smuzhiyun 	struct agp_memory *next;
69*4882a593Smuzhiyun 
70*4882a593Smuzhiyun 	/* Check to see if this is even in the memory pool */
71*4882a593Smuzhiyun 
72*4882a593Smuzhiyun 	DBG("mem=%p", temp);
73*4882a593Smuzhiyun 	if (agp_find_mem_by_key(temp->key) != NULL) {
74*4882a593Smuzhiyun 		next = temp->next;
75*4882a593Smuzhiyun 		prev = temp->prev;
76*4882a593Smuzhiyun 
77*4882a593Smuzhiyun 		if (prev != NULL) {
78*4882a593Smuzhiyun 			prev->next = next;
79*4882a593Smuzhiyun 			if (next != NULL)
80*4882a593Smuzhiyun 				next->prev = prev;
81*4882a593Smuzhiyun 
82*4882a593Smuzhiyun 		} else {
83*4882a593Smuzhiyun 			/* This is the first item on the list */
84*4882a593Smuzhiyun 			if (next != NULL)
85*4882a593Smuzhiyun 				next->prev = NULL;
86*4882a593Smuzhiyun 
87*4882a593Smuzhiyun 			agp_fe.current_controller->pool = next;
88*4882a593Smuzhiyun 		}
89*4882a593Smuzhiyun 	}
90*4882a593Smuzhiyun }
91*4882a593Smuzhiyun 
92*4882a593Smuzhiyun /*
93*4882a593Smuzhiyun  * Routines for managing each client's segment list -
94*4882a593Smuzhiyun  * These routines handle adding and removing segments
95*4882a593Smuzhiyun  * to each auth'ed client.
96*4882a593Smuzhiyun  */
97*4882a593Smuzhiyun 
98*4882a593Smuzhiyun static struct
agp_find_seg_in_client(const struct agp_client * client,unsigned long offset,int size,pgprot_t page_prot)99*4882a593Smuzhiyun agp_segment_priv *agp_find_seg_in_client(const struct agp_client *client,
100*4882a593Smuzhiyun 						unsigned long offset,
101*4882a593Smuzhiyun 					    int size, pgprot_t page_prot)
102*4882a593Smuzhiyun {
103*4882a593Smuzhiyun 	struct agp_segment_priv *seg;
104*4882a593Smuzhiyun 	int i;
105*4882a593Smuzhiyun 	off_t pg_start;
106*4882a593Smuzhiyun 	size_t pg_count;
107*4882a593Smuzhiyun 
108*4882a593Smuzhiyun 	pg_start = offset / 4096;
109*4882a593Smuzhiyun 	pg_count = size / 4096;
110*4882a593Smuzhiyun 	seg = *(client->segments);
111*4882a593Smuzhiyun 
112*4882a593Smuzhiyun 	for (i = 0; i < client->num_segments; i++) {
113*4882a593Smuzhiyun 		if ((seg[i].pg_start == pg_start) &&
114*4882a593Smuzhiyun 		    (seg[i].pg_count == pg_count) &&
115*4882a593Smuzhiyun 		    (pgprot_val(seg[i].prot) == pgprot_val(page_prot))) {
116*4882a593Smuzhiyun 			return seg + i;
117*4882a593Smuzhiyun 		}
118*4882a593Smuzhiyun 	}
119*4882a593Smuzhiyun 
120*4882a593Smuzhiyun 	return NULL;
121*4882a593Smuzhiyun }
122*4882a593Smuzhiyun 
agp_remove_seg_from_client(struct agp_client * client)123*4882a593Smuzhiyun static void agp_remove_seg_from_client(struct agp_client *client)
124*4882a593Smuzhiyun {
125*4882a593Smuzhiyun 	DBG("client=%p", client);
126*4882a593Smuzhiyun 
127*4882a593Smuzhiyun 	if (client->segments != NULL) {
128*4882a593Smuzhiyun 		if (*(client->segments) != NULL) {
129*4882a593Smuzhiyun 			DBG("Freeing %p from client %p", *(client->segments), client);
130*4882a593Smuzhiyun 			kfree(*(client->segments));
131*4882a593Smuzhiyun 		}
132*4882a593Smuzhiyun 		DBG("Freeing %p from client %p", client->segments, client);
133*4882a593Smuzhiyun 		kfree(client->segments);
134*4882a593Smuzhiyun 		client->segments = NULL;
135*4882a593Smuzhiyun 	}
136*4882a593Smuzhiyun }
137*4882a593Smuzhiyun 
agp_add_seg_to_client(struct agp_client * client,struct agp_segment_priv ** seg,int num_segments)138*4882a593Smuzhiyun static void agp_add_seg_to_client(struct agp_client *client,
139*4882a593Smuzhiyun 			       struct agp_segment_priv ** seg, int num_segments)
140*4882a593Smuzhiyun {
141*4882a593Smuzhiyun 	struct agp_segment_priv **prev_seg;
142*4882a593Smuzhiyun 
143*4882a593Smuzhiyun 	prev_seg = client->segments;
144*4882a593Smuzhiyun 
145*4882a593Smuzhiyun 	if (prev_seg != NULL)
146*4882a593Smuzhiyun 		agp_remove_seg_from_client(client);
147*4882a593Smuzhiyun 
148*4882a593Smuzhiyun 	DBG("Adding seg %p (%d segments) to client %p", seg, num_segments, client);
149*4882a593Smuzhiyun 	client->num_segments = num_segments;
150*4882a593Smuzhiyun 	client->segments = seg;
151*4882a593Smuzhiyun }
152*4882a593Smuzhiyun 
agp_convert_mmap_flags(int prot)153*4882a593Smuzhiyun static pgprot_t agp_convert_mmap_flags(int prot)
154*4882a593Smuzhiyun {
155*4882a593Smuzhiyun 	unsigned long prot_bits;
156*4882a593Smuzhiyun 
157*4882a593Smuzhiyun 	prot_bits = calc_vm_prot_bits(prot, 0) | VM_SHARED;
158*4882a593Smuzhiyun 	return vm_get_page_prot(prot_bits);
159*4882a593Smuzhiyun }
160*4882a593Smuzhiyun 
agp_create_segment(struct agp_client * client,struct agp_region * region)161*4882a593Smuzhiyun int agp_create_segment(struct agp_client *client, struct agp_region *region)
162*4882a593Smuzhiyun {
163*4882a593Smuzhiyun 	struct agp_segment_priv **ret_seg;
164*4882a593Smuzhiyun 	struct agp_segment_priv *seg;
165*4882a593Smuzhiyun 	struct agp_segment *user_seg;
166*4882a593Smuzhiyun 	size_t i;
167*4882a593Smuzhiyun 
168*4882a593Smuzhiyun 	seg = kzalloc((sizeof(struct agp_segment_priv) * region->seg_count), GFP_KERNEL);
169*4882a593Smuzhiyun 	if (seg == NULL) {
170*4882a593Smuzhiyun 		kfree(region->seg_list);
171*4882a593Smuzhiyun 		region->seg_list = NULL;
172*4882a593Smuzhiyun 		return -ENOMEM;
173*4882a593Smuzhiyun 	}
174*4882a593Smuzhiyun 	user_seg = region->seg_list;
175*4882a593Smuzhiyun 
176*4882a593Smuzhiyun 	for (i = 0; i < region->seg_count; i++) {
177*4882a593Smuzhiyun 		seg[i].pg_start = user_seg[i].pg_start;
178*4882a593Smuzhiyun 		seg[i].pg_count = user_seg[i].pg_count;
179*4882a593Smuzhiyun 		seg[i].prot = agp_convert_mmap_flags(user_seg[i].prot);
180*4882a593Smuzhiyun 	}
181*4882a593Smuzhiyun 	kfree(region->seg_list);
182*4882a593Smuzhiyun 	region->seg_list = NULL;
183*4882a593Smuzhiyun 
184*4882a593Smuzhiyun 	ret_seg = kmalloc(sizeof(void *), GFP_KERNEL);
185*4882a593Smuzhiyun 	if (ret_seg == NULL) {
186*4882a593Smuzhiyun 		kfree(seg);
187*4882a593Smuzhiyun 		return -ENOMEM;
188*4882a593Smuzhiyun 	}
189*4882a593Smuzhiyun 	*ret_seg = seg;
190*4882a593Smuzhiyun 	agp_add_seg_to_client(client, ret_seg, region->seg_count);
191*4882a593Smuzhiyun 	return 0;
192*4882a593Smuzhiyun }
193*4882a593Smuzhiyun 
194*4882a593Smuzhiyun /* End - Routines for managing each client's segment list */
195*4882a593Smuzhiyun 
196*4882a593Smuzhiyun /* This function must only be called when current_controller != NULL */
agp_insert_into_pool(struct agp_memory * temp)197*4882a593Smuzhiyun static void agp_insert_into_pool(struct agp_memory * temp)
198*4882a593Smuzhiyun {
199*4882a593Smuzhiyun 	struct agp_memory *prev;
200*4882a593Smuzhiyun 
201*4882a593Smuzhiyun 	prev = agp_fe.current_controller->pool;
202*4882a593Smuzhiyun 
203*4882a593Smuzhiyun 	if (prev != NULL) {
204*4882a593Smuzhiyun 		prev->prev = temp;
205*4882a593Smuzhiyun 		temp->next = prev;
206*4882a593Smuzhiyun 	}
207*4882a593Smuzhiyun 	agp_fe.current_controller->pool = temp;
208*4882a593Smuzhiyun }
209*4882a593Smuzhiyun 
210*4882a593Smuzhiyun 
211*4882a593Smuzhiyun /* File private list routines */
212*4882a593Smuzhiyun 
agp_find_private(pid_t pid)213*4882a593Smuzhiyun struct agp_file_private *agp_find_private(pid_t pid)
214*4882a593Smuzhiyun {
215*4882a593Smuzhiyun 	struct agp_file_private *curr;
216*4882a593Smuzhiyun 
217*4882a593Smuzhiyun 	curr = agp_fe.file_priv_list;
218*4882a593Smuzhiyun 
219*4882a593Smuzhiyun 	while (curr != NULL) {
220*4882a593Smuzhiyun 		if (curr->my_pid == pid)
221*4882a593Smuzhiyun 			return curr;
222*4882a593Smuzhiyun 		curr = curr->next;
223*4882a593Smuzhiyun 	}
224*4882a593Smuzhiyun 
225*4882a593Smuzhiyun 	return NULL;
226*4882a593Smuzhiyun }
227*4882a593Smuzhiyun 
agp_insert_file_private(struct agp_file_private * priv)228*4882a593Smuzhiyun static void agp_insert_file_private(struct agp_file_private * priv)
229*4882a593Smuzhiyun {
230*4882a593Smuzhiyun 	struct agp_file_private *prev;
231*4882a593Smuzhiyun 
232*4882a593Smuzhiyun 	prev = agp_fe.file_priv_list;
233*4882a593Smuzhiyun 
234*4882a593Smuzhiyun 	if (prev != NULL)
235*4882a593Smuzhiyun 		prev->prev = priv;
236*4882a593Smuzhiyun 	priv->next = prev;
237*4882a593Smuzhiyun 	agp_fe.file_priv_list = priv;
238*4882a593Smuzhiyun }
239*4882a593Smuzhiyun 
agp_remove_file_private(struct agp_file_private * priv)240*4882a593Smuzhiyun static void agp_remove_file_private(struct agp_file_private * priv)
241*4882a593Smuzhiyun {
242*4882a593Smuzhiyun 	struct agp_file_private *next;
243*4882a593Smuzhiyun 	struct agp_file_private *prev;
244*4882a593Smuzhiyun 
245*4882a593Smuzhiyun 	next = priv->next;
246*4882a593Smuzhiyun 	prev = priv->prev;
247*4882a593Smuzhiyun 
248*4882a593Smuzhiyun 	if (prev != NULL) {
249*4882a593Smuzhiyun 		prev->next = next;
250*4882a593Smuzhiyun 
251*4882a593Smuzhiyun 		if (next != NULL)
252*4882a593Smuzhiyun 			next->prev = prev;
253*4882a593Smuzhiyun 
254*4882a593Smuzhiyun 	} else {
255*4882a593Smuzhiyun 		if (next != NULL)
256*4882a593Smuzhiyun 			next->prev = NULL;
257*4882a593Smuzhiyun 
258*4882a593Smuzhiyun 		agp_fe.file_priv_list = next;
259*4882a593Smuzhiyun 	}
260*4882a593Smuzhiyun }
261*4882a593Smuzhiyun 
262*4882a593Smuzhiyun /* End - File flag list routines */
263*4882a593Smuzhiyun 
264*4882a593Smuzhiyun /*
265*4882a593Smuzhiyun  * Wrappers for agp_free_memory & agp_allocate_memory
266*4882a593Smuzhiyun  * These make sure that internal lists are kept updated.
267*4882a593Smuzhiyun  */
agp_free_memory_wrap(struct agp_memory * memory)268*4882a593Smuzhiyun void agp_free_memory_wrap(struct agp_memory *memory)
269*4882a593Smuzhiyun {
270*4882a593Smuzhiyun 	agp_remove_from_pool(memory);
271*4882a593Smuzhiyun 	agp_free_memory(memory);
272*4882a593Smuzhiyun }
273*4882a593Smuzhiyun 
agp_allocate_memory_wrap(size_t pg_count,u32 type)274*4882a593Smuzhiyun struct agp_memory *agp_allocate_memory_wrap(size_t pg_count, u32 type)
275*4882a593Smuzhiyun {
276*4882a593Smuzhiyun 	struct agp_memory *memory;
277*4882a593Smuzhiyun 
278*4882a593Smuzhiyun 	memory = agp_allocate_memory(agp_bridge, pg_count, type);
279*4882a593Smuzhiyun 	if (memory == NULL)
280*4882a593Smuzhiyun 		return NULL;
281*4882a593Smuzhiyun 
282*4882a593Smuzhiyun 	agp_insert_into_pool(memory);
283*4882a593Smuzhiyun 	return memory;
284*4882a593Smuzhiyun }
285*4882a593Smuzhiyun 
286*4882a593Smuzhiyun /* Routines for managing the list of controllers -
287*4882a593Smuzhiyun  * These routines manage the current controller, and the list of
288*4882a593Smuzhiyun  * controllers
289*4882a593Smuzhiyun  */
290*4882a593Smuzhiyun 
agp_find_controller_by_pid(pid_t id)291*4882a593Smuzhiyun static struct agp_controller *agp_find_controller_by_pid(pid_t id)
292*4882a593Smuzhiyun {
293*4882a593Smuzhiyun 	struct agp_controller *controller;
294*4882a593Smuzhiyun 
295*4882a593Smuzhiyun 	controller = agp_fe.controllers;
296*4882a593Smuzhiyun 
297*4882a593Smuzhiyun 	while (controller != NULL) {
298*4882a593Smuzhiyun 		if (controller->pid == id)
299*4882a593Smuzhiyun 			return controller;
300*4882a593Smuzhiyun 		controller = controller->next;
301*4882a593Smuzhiyun 	}
302*4882a593Smuzhiyun 
303*4882a593Smuzhiyun 	return NULL;
304*4882a593Smuzhiyun }
305*4882a593Smuzhiyun 
agp_create_controller(pid_t id)306*4882a593Smuzhiyun static struct agp_controller *agp_create_controller(pid_t id)
307*4882a593Smuzhiyun {
308*4882a593Smuzhiyun 	struct agp_controller *controller;
309*4882a593Smuzhiyun 
310*4882a593Smuzhiyun 	controller = kzalloc(sizeof(struct agp_controller), GFP_KERNEL);
311*4882a593Smuzhiyun 	if (controller == NULL)
312*4882a593Smuzhiyun 		return NULL;
313*4882a593Smuzhiyun 
314*4882a593Smuzhiyun 	controller->pid = id;
315*4882a593Smuzhiyun 	return controller;
316*4882a593Smuzhiyun }
317*4882a593Smuzhiyun 
agp_insert_controller(struct agp_controller * controller)318*4882a593Smuzhiyun static int agp_insert_controller(struct agp_controller *controller)
319*4882a593Smuzhiyun {
320*4882a593Smuzhiyun 	struct agp_controller *prev_controller;
321*4882a593Smuzhiyun 
322*4882a593Smuzhiyun 	prev_controller = agp_fe.controllers;
323*4882a593Smuzhiyun 	controller->next = prev_controller;
324*4882a593Smuzhiyun 
325*4882a593Smuzhiyun 	if (prev_controller != NULL)
326*4882a593Smuzhiyun 		prev_controller->prev = controller;
327*4882a593Smuzhiyun 
328*4882a593Smuzhiyun 	agp_fe.controllers = controller;
329*4882a593Smuzhiyun 
330*4882a593Smuzhiyun 	return 0;
331*4882a593Smuzhiyun }
332*4882a593Smuzhiyun 
agp_remove_all_clients(struct agp_controller * controller)333*4882a593Smuzhiyun static void agp_remove_all_clients(struct agp_controller *controller)
334*4882a593Smuzhiyun {
335*4882a593Smuzhiyun 	struct agp_client *client;
336*4882a593Smuzhiyun 	struct agp_client *temp;
337*4882a593Smuzhiyun 
338*4882a593Smuzhiyun 	client = controller->clients;
339*4882a593Smuzhiyun 
340*4882a593Smuzhiyun 	while (client) {
341*4882a593Smuzhiyun 		struct agp_file_private *priv;
342*4882a593Smuzhiyun 
343*4882a593Smuzhiyun 		temp = client;
344*4882a593Smuzhiyun 		agp_remove_seg_from_client(temp);
345*4882a593Smuzhiyun 		priv = agp_find_private(temp->pid);
346*4882a593Smuzhiyun 
347*4882a593Smuzhiyun 		if (priv != NULL) {
348*4882a593Smuzhiyun 			clear_bit(AGP_FF_IS_VALID, &priv->access_flags);
349*4882a593Smuzhiyun 			clear_bit(AGP_FF_IS_CLIENT, &priv->access_flags);
350*4882a593Smuzhiyun 		}
351*4882a593Smuzhiyun 		client = client->next;
352*4882a593Smuzhiyun 		kfree(temp);
353*4882a593Smuzhiyun 	}
354*4882a593Smuzhiyun }
355*4882a593Smuzhiyun 
agp_remove_all_memory(struct agp_controller * controller)356*4882a593Smuzhiyun static void agp_remove_all_memory(struct agp_controller *controller)
357*4882a593Smuzhiyun {
358*4882a593Smuzhiyun 	struct agp_memory *memory;
359*4882a593Smuzhiyun 	struct agp_memory *temp;
360*4882a593Smuzhiyun 
361*4882a593Smuzhiyun 	memory = controller->pool;
362*4882a593Smuzhiyun 
363*4882a593Smuzhiyun 	while (memory) {
364*4882a593Smuzhiyun 		temp = memory;
365*4882a593Smuzhiyun 		memory = memory->next;
366*4882a593Smuzhiyun 		agp_free_memory_wrap(temp);
367*4882a593Smuzhiyun 	}
368*4882a593Smuzhiyun }
369*4882a593Smuzhiyun 
agp_remove_controller(struct agp_controller * controller)370*4882a593Smuzhiyun static int agp_remove_controller(struct agp_controller *controller)
371*4882a593Smuzhiyun {
372*4882a593Smuzhiyun 	struct agp_controller *prev_controller;
373*4882a593Smuzhiyun 	struct agp_controller *next_controller;
374*4882a593Smuzhiyun 
375*4882a593Smuzhiyun 	prev_controller = controller->prev;
376*4882a593Smuzhiyun 	next_controller = controller->next;
377*4882a593Smuzhiyun 
378*4882a593Smuzhiyun 	if (prev_controller != NULL) {
379*4882a593Smuzhiyun 		prev_controller->next = next_controller;
380*4882a593Smuzhiyun 		if (next_controller != NULL)
381*4882a593Smuzhiyun 			next_controller->prev = prev_controller;
382*4882a593Smuzhiyun 
383*4882a593Smuzhiyun 	} else {
384*4882a593Smuzhiyun 		if (next_controller != NULL)
385*4882a593Smuzhiyun 			next_controller->prev = NULL;
386*4882a593Smuzhiyun 
387*4882a593Smuzhiyun 		agp_fe.controllers = next_controller;
388*4882a593Smuzhiyun 	}
389*4882a593Smuzhiyun 
390*4882a593Smuzhiyun 	agp_remove_all_memory(controller);
391*4882a593Smuzhiyun 	agp_remove_all_clients(controller);
392*4882a593Smuzhiyun 
393*4882a593Smuzhiyun 	if (agp_fe.current_controller == controller) {
394*4882a593Smuzhiyun 		agp_fe.current_controller = NULL;
395*4882a593Smuzhiyun 		agp_fe.backend_acquired = false;
396*4882a593Smuzhiyun 		agp_backend_release(agp_bridge);
397*4882a593Smuzhiyun 	}
398*4882a593Smuzhiyun 	kfree(controller);
399*4882a593Smuzhiyun 	return 0;
400*4882a593Smuzhiyun }
401*4882a593Smuzhiyun 
agp_controller_make_current(struct agp_controller * controller)402*4882a593Smuzhiyun static void agp_controller_make_current(struct agp_controller *controller)
403*4882a593Smuzhiyun {
404*4882a593Smuzhiyun 	struct agp_client *clients;
405*4882a593Smuzhiyun 
406*4882a593Smuzhiyun 	clients = controller->clients;
407*4882a593Smuzhiyun 
408*4882a593Smuzhiyun 	while (clients != NULL) {
409*4882a593Smuzhiyun 		struct agp_file_private *priv;
410*4882a593Smuzhiyun 
411*4882a593Smuzhiyun 		priv = agp_find_private(clients->pid);
412*4882a593Smuzhiyun 
413*4882a593Smuzhiyun 		if (priv != NULL) {
414*4882a593Smuzhiyun 			set_bit(AGP_FF_IS_VALID, &priv->access_flags);
415*4882a593Smuzhiyun 			set_bit(AGP_FF_IS_CLIENT, &priv->access_flags);
416*4882a593Smuzhiyun 		}
417*4882a593Smuzhiyun 		clients = clients->next;
418*4882a593Smuzhiyun 	}
419*4882a593Smuzhiyun 
420*4882a593Smuzhiyun 	agp_fe.current_controller = controller;
421*4882a593Smuzhiyun }
422*4882a593Smuzhiyun 
agp_controller_release_current(struct agp_controller * controller,struct agp_file_private * controller_priv)423*4882a593Smuzhiyun static void agp_controller_release_current(struct agp_controller *controller,
424*4882a593Smuzhiyun 				      struct agp_file_private *controller_priv)
425*4882a593Smuzhiyun {
426*4882a593Smuzhiyun 	struct agp_client *clients;
427*4882a593Smuzhiyun 
428*4882a593Smuzhiyun 	clear_bit(AGP_FF_IS_VALID, &controller_priv->access_flags);
429*4882a593Smuzhiyun 	clients = controller->clients;
430*4882a593Smuzhiyun 
431*4882a593Smuzhiyun 	while (clients != NULL) {
432*4882a593Smuzhiyun 		struct agp_file_private *priv;
433*4882a593Smuzhiyun 
434*4882a593Smuzhiyun 		priv = agp_find_private(clients->pid);
435*4882a593Smuzhiyun 
436*4882a593Smuzhiyun 		if (priv != NULL)
437*4882a593Smuzhiyun 			clear_bit(AGP_FF_IS_VALID, &priv->access_flags);
438*4882a593Smuzhiyun 
439*4882a593Smuzhiyun 		clients = clients->next;
440*4882a593Smuzhiyun 	}
441*4882a593Smuzhiyun 
442*4882a593Smuzhiyun 	agp_fe.current_controller = NULL;
443*4882a593Smuzhiyun 	agp_fe.used_by_controller = false;
444*4882a593Smuzhiyun 	agp_backend_release(agp_bridge);
445*4882a593Smuzhiyun }
446*4882a593Smuzhiyun 
447*4882a593Smuzhiyun /*
448*4882a593Smuzhiyun  * Routines for managing client lists -
449*4882a593Smuzhiyun  * These routines are for managing the list of auth'ed clients.
450*4882a593Smuzhiyun  */
451*4882a593Smuzhiyun 
452*4882a593Smuzhiyun static struct agp_client
agp_find_client_in_controller(struct agp_controller * controller,pid_t id)453*4882a593Smuzhiyun *agp_find_client_in_controller(struct agp_controller *controller, pid_t id)
454*4882a593Smuzhiyun {
455*4882a593Smuzhiyun 	struct agp_client *client;
456*4882a593Smuzhiyun 
457*4882a593Smuzhiyun 	if (controller == NULL)
458*4882a593Smuzhiyun 		return NULL;
459*4882a593Smuzhiyun 
460*4882a593Smuzhiyun 	client = controller->clients;
461*4882a593Smuzhiyun 
462*4882a593Smuzhiyun 	while (client != NULL) {
463*4882a593Smuzhiyun 		if (client->pid == id)
464*4882a593Smuzhiyun 			return client;
465*4882a593Smuzhiyun 		client = client->next;
466*4882a593Smuzhiyun 	}
467*4882a593Smuzhiyun 
468*4882a593Smuzhiyun 	return NULL;
469*4882a593Smuzhiyun }
470*4882a593Smuzhiyun 
agp_find_controller_for_client(pid_t id)471*4882a593Smuzhiyun static struct agp_controller *agp_find_controller_for_client(pid_t id)
472*4882a593Smuzhiyun {
473*4882a593Smuzhiyun 	struct agp_controller *controller;
474*4882a593Smuzhiyun 
475*4882a593Smuzhiyun 	controller = agp_fe.controllers;
476*4882a593Smuzhiyun 
477*4882a593Smuzhiyun 	while (controller != NULL) {
478*4882a593Smuzhiyun 		if ((agp_find_client_in_controller(controller, id)) != NULL)
479*4882a593Smuzhiyun 			return controller;
480*4882a593Smuzhiyun 		controller = controller->next;
481*4882a593Smuzhiyun 	}
482*4882a593Smuzhiyun 
483*4882a593Smuzhiyun 	return NULL;
484*4882a593Smuzhiyun }
485*4882a593Smuzhiyun 
agp_find_client_by_pid(pid_t id)486*4882a593Smuzhiyun struct agp_client *agp_find_client_by_pid(pid_t id)
487*4882a593Smuzhiyun {
488*4882a593Smuzhiyun 	struct agp_client *temp;
489*4882a593Smuzhiyun 
490*4882a593Smuzhiyun 	if (agp_fe.current_controller == NULL)
491*4882a593Smuzhiyun 		return NULL;
492*4882a593Smuzhiyun 
493*4882a593Smuzhiyun 	temp = agp_find_client_in_controller(agp_fe.current_controller, id);
494*4882a593Smuzhiyun 	return temp;
495*4882a593Smuzhiyun }
496*4882a593Smuzhiyun 
agp_insert_client(struct agp_client * client)497*4882a593Smuzhiyun static void agp_insert_client(struct agp_client *client)
498*4882a593Smuzhiyun {
499*4882a593Smuzhiyun 	struct agp_client *prev_client;
500*4882a593Smuzhiyun 
501*4882a593Smuzhiyun 	prev_client = agp_fe.current_controller->clients;
502*4882a593Smuzhiyun 	client->next = prev_client;
503*4882a593Smuzhiyun 
504*4882a593Smuzhiyun 	if (prev_client != NULL)
505*4882a593Smuzhiyun 		prev_client->prev = client;
506*4882a593Smuzhiyun 
507*4882a593Smuzhiyun 	agp_fe.current_controller->clients = client;
508*4882a593Smuzhiyun 	agp_fe.current_controller->num_clients++;
509*4882a593Smuzhiyun }
510*4882a593Smuzhiyun 
agp_create_client(pid_t id)511*4882a593Smuzhiyun struct agp_client *agp_create_client(pid_t id)
512*4882a593Smuzhiyun {
513*4882a593Smuzhiyun 	struct agp_client *new_client;
514*4882a593Smuzhiyun 
515*4882a593Smuzhiyun 	new_client = kzalloc(sizeof(struct agp_client), GFP_KERNEL);
516*4882a593Smuzhiyun 	if (new_client == NULL)
517*4882a593Smuzhiyun 		return NULL;
518*4882a593Smuzhiyun 
519*4882a593Smuzhiyun 	new_client->pid = id;
520*4882a593Smuzhiyun 	agp_insert_client(new_client);
521*4882a593Smuzhiyun 	return new_client;
522*4882a593Smuzhiyun }
523*4882a593Smuzhiyun 
agp_remove_client(pid_t id)524*4882a593Smuzhiyun int agp_remove_client(pid_t id)
525*4882a593Smuzhiyun {
526*4882a593Smuzhiyun 	struct agp_client *client;
527*4882a593Smuzhiyun 	struct agp_client *prev_client;
528*4882a593Smuzhiyun 	struct agp_client *next_client;
529*4882a593Smuzhiyun 	struct agp_controller *controller;
530*4882a593Smuzhiyun 
531*4882a593Smuzhiyun 	controller = agp_find_controller_for_client(id);
532*4882a593Smuzhiyun 	if (controller == NULL)
533*4882a593Smuzhiyun 		return -EINVAL;
534*4882a593Smuzhiyun 
535*4882a593Smuzhiyun 	client = agp_find_client_in_controller(controller, id);
536*4882a593Smuzhiyun 	if (client == NULL)
537*4882a593Smuzhiyun 		return -EINVAL;
538*4882a593Smuzhiyun 
539*4882a593Smuzhiyun 	prev_client = client->prev;
540*4882a593Smuzhiyun 	next_client = client->next;
541*4882a593Smuzhiyun 
542*4882a593Smuzhiyun 	if (prev_client != NULL) {
543*4882a593Smuzhiyun 		prev_client->next = next_client;
544*4882a593Smuzhiyun 		if (next_client != NULL)
545*4882a593Smuzhiyun 			next_client->prev = prev_client;
546*4882a593Smuzhiyun 
547*4882a593Smuzhiyun 	} else {
548*4882a593Smuzhiyun 		if (next_client != NULL)
549*4882a593Smuzhiyun 			next_client->prev = NULL;
550*4882a593Smuzhiyun 		controller->clients = next_client;
551*4882a593Smuzhiyun 	}
552*4882a593Smuzhiyun 
553*4882a593Smuzhiyun 	controller->num_clients--;
554*4882a593Smuzhiyun 	agp_remove_seg_from_client(client);
555*4882a593Smuzhiyun 	kfree(client);
556*4882a593Smuzhiyun 	return 0;
557*4882a593Smuzhiyun }
558*4882a593Smuzhiyun 
559*4882a593Smuzhiyun /* End - Routines for managing client lists */
560*4882a593Smuzhiyun 
561*4882a593Smuzhiyun /* File Operations */
562*4882a593Smuzhiyun 
agp_mmap(struct file * file,struct vm_area_struct * vma)563*4882a593Smuzhiyun static int agp_mmap(struct file *file, struct vm_area_struct *vma)
564*4882a593Smuzhiyun {
565*4882a593Smuzhiyun 	unsigned int size, current_size;
566*4882a593Smuzhiyun 	unsigned long offset;
567*4882a593Smuzhiyun 	struct agp_client *client;
568*4882a593Smuzhiyun 	struct agp_file_private *priv = file->private_data;
569*4882a593Smuzhiyun 	struct agp_kern_info kerninfo;
570*4882a593Smuzhiyun 
571*4882a593Smuzhiyun 	mutex_lock(&(agp_fe.agp_mutex));
572*4882a593Smuzhiyun 
573*4882a593Smuzhiyun 	if (agp_fe.backend_acquired != true)
574*4882a593Smuzhiyun 		goto out_eperm;
575*4882a593Smuzhiyun 
576*4882a593Smuzhiyun 	if (!(test_bit(AGP_FF_IS_VALID, &priv->access_flags)))
577*4882a593Smuzhiyun 		goto out_eperm;
578*4882a593Smuzhiyun 
579*4882a593Smuzhiyun 	agp_copy_info(agp_bridge, &kerninfo);
580*4882a593Smuzhiyun 	size = vma->vm_end - vma->vm_start;
581*4882a593Smuzhiyun 	current_size = kerninfo.aper_size;
582*4882a593Smuzhiyun 	current_size = current_size * 0x100000;
583*4882a593Smuzhiyun 	offset = vma->vm_pgoff << PAGE_SHIFT;
584*4882a593Smuzhiyun 	DBG("%lx:%lx", offset, offset+size);
585*4882a593Smuzhiyun 
586*4882a593Smuzhiyun 	if (test_bit(AGP_FF_IS_CLIENT, &priv->access_flags)) {
587*4882a593Smuzhiyun 		if ((size + offset) > current_size)
588*4882a593Smuzhiyun 			goto out_inval;
589*4882a593Smuzhiyun 
590*4882a593Smuzhiyun 		client = agp_find_client_by_pid(current->pid);
591*4882a593Smuzhiyun 
592*4882a593Smuzhiyun 		if (client == NULL)
593*4882a593Smuzhiyun 			goto out_eperm;
594*4882a593Smuzhiyun 
595*4882a593Smuzhiyun 		if (!agp_find_seg_in_client(client, offset, size, vma->vm_page_prot))
596*4882a593Smuzhiyun 			goto out_inval;
597*4882a593Smuzhiyun 
598*4882a593Smuzhiyun 		DBG("client vm_ops=%p", kerninfo.vm_ops);
599*4882a593Smuzhiyun 		if (kerninfo.vm_ops) {
600*4882a593Smuzhiyun 			vma->vm_ops = kerninfo.vm_ops;
601*4882a593Smuzhiyun 		} else if (io_remap_pfn_range(vma, vma->vm_start,
602*4882a593Smuzhiyun 				(kerninfo.aper_base + offset) >> PAGE_SHIFT,
603*4882a593Smuzhiyun 				size,
604*4882a593Smuzhiyun 				pgprot_writecombine(vma->vm_page_prot))) {
605*4882a593Smuzhiyun 			goto out_again;
606*4882a593Smuzhiyun 		}
607*4882a593Smuzhiyun 		mutex_unlock(&(agp_fe.agp_mutex));
608*4882a593Smuzhiyun 		return 0;
609*4882a593Smuzhiyun 	}
610*4882a593Smuzhiyun 
611*4882a593Smuzhiyun 	if (test_bit(AGP_FF_IS_CONTROLLER, &priv->access_flags)) {
612*4882a593Smuzhiyun 		if (size != current_size)
613*4882a593Smuzhiyun 			goto out_inval;
614*4882a593Smuzhiyun 
615*4882a593Smuzhiyun 		DBG("controller vm_ops=%p", kerninfo.vm_ops);
616*4882a593Smuzhiyun 		if (kerninfo.vm_ops) {
617*4882a593Smuzhiyun 			vma->vm_ops = kerninfo.vm_ops;
618*4882a593Smuzhiyun 		} else if (io_remap_pfn_range(vma, vma->vm_start,
619*4882a593Smuzhiyun 				kerninfo.aper_base >> PAGE_SHIFT,
620*4882a593Smuzhiyun 				size,
621*4882a593Smuzhiyun 				pgprot_writecombine(vma->vm_page_prot))) {
622*4882a593Smuzhiyun 			goto out_again;
623*4882a593Smuzhiyun 		}
624*4882a593Smuzhiyun 		mutex_unlock(&(agp_fe.agp_mutex));
625*4882a593Smuzhiyun 		return 0;
626*4882a593Smuzhiyun 	}
627*4882a593Smuzhiyun 
628*4882a593Smuzhiyun out_eperm:
629*4882a593Smuzhiyun 	mutex_unlock(&(agp_fe.agp_mutex));
630*4882a593Smuzhiyun 	return -EPERM;
631*4882a593Smuzhiyun 
632*4882a593Smuzhiyun out_inval:
633*4882a593Smuzhiyun 	mutex_unlock(&(agp_fe.agp_mutex));
634*4882a593Smuzhiyun 	return -EINVAL;
635*4882a593Smuzhiyun 
636*4882a593Smuzhiyun out_again:
637*4882a593Smuzhiyun 	mutex_unlock(&(agp_fe.agp_mutex));
638*4882a593Smuzhiyun 	return -EAGAIN;
639*4882a593Smuzhiyun }
640*4882a593Smuzhiyun 
agp_release(struct inode * inode,struct file * file)641*4882a593Smuzhiyun static int agp_release(struct inode *inode, struct file *file)
642*4882a593Smuzhiyun {
643*4882a593Smuzhiyun 	struct agp_file_private *priv = file->private_data;
644*4882a593Smuzhiyun 
645*4882a593Smuzhiyun 	mutex_lock(&(agp_fe.agp_mutex));
646*4882a593Smuzhiyun 
647*4882a593Smuzhiyun 	DBG("priv=%p", priv);
648*4882a593Smuzhiyun 
649*4882a593Smuzhiyun 	if (test_bit(AGP_FF_IS_CONTROLLER, &priv->access_flags)) {
650*4882a593Smuzhiyun 		struct agp_controller *controller;
651*4882a593Smuzhiyun 
652*4882a593Smuzhiyun 		controller = agp_find_controller_by_pid(priv->my_pid);
653*4882a593Smuzhiyun 
654*4882a593Smuzhiyun 		if (controller != NULL) {
655*4882a593Smuzhiyun 			if (controller == agp_fe.current_controller)
656*4882a593Smuzhiyun 				agp_controller_release_current(controller, priv);
657*4882a593Smuzhiyun 			agp_remove_controller(controller);
658*4882a593Smuzhiyun 			controller = NULL;
659*4882a593Smuzhiyun 		}
660*4882a593Smuzhiyun 	}
661*4882a593Smuzhiyun 
662*4882a593Smuzhiyun 	if (test_bit(AGP_FF_IS_CLIENT, &priv->access_flags))
663*4882a593Smuzhiyun 		agp_remove_client(priv->my_pid);
664*4882a593Smuzhiyun 
665*4882a593Smuzhiyun 	agp_remove_file_private(priv);
666*4882a593Smuzhiyun 	kfree(priv);
667*4882a593Smuzhiyun 	file->private_data = NULL;
668*4882a593Smuzhiyun 	mutex_unlock(&(agp_fe.agp_mutex));
669*4882a593Smuzhiyun 	return 0;
670*4882a593Smuzhiyun }
671*4882a593Smuzhiyun 
agp_open(struct inode * inode,struct file * file)672*4882a593Smuzhiyun static int agp_open(struct inode *inode, struct file *file)
673*4882a593Smuzhiyun {
674*4882a593Smuzhiyun 	int minor = iminor(inode);
675*4882a593Smuzhiyun 	struct agp_file_private *priv;
676*4882a593Smuzhiyun 	struct agp_client *client;
677*4882a593Smuzhiyun 
678*4882a593Smuzhiyun 	if (minor != AGPGART_MINOR)
679*4882a593Smuzhiyun 		return -ENXIO;
680*4882a593Smuzhiyun 
681*4882a593Smuzhiyun 	mutex_lock(&(agp_fe.agp_mutex));
682*4882a593Smuzhiyun 
683*4882a593Smuzhiyun 	priv = kzalloc(sizeof(struct agp_file_private), GFP_KERNEL);
684*4882a593Smuzhiyun 	if (priv == NULL) {
685*4882a593Smuzhiyun 		mutex_unlock(&(agp_fe.agp_mutex));
686*4882a593Smuzhiyun 		return -ENOMEM;
687*4882a593Smuzhiyun 	}
688*4882a593Smuzhiyun 
689*4882a593Smuzhiyun 	set_bit(AGP_FF_ALLOW_CLIENT, &priv->access_flags);
690*4882a593Smuzhiyun 	priv->my_pid = current->pid;
691*4882a593Smuzhiyun 
692*4882a593Smuzhiyun 	if (capable(CAP_SYS_RAWIO))
693*4882a593Smuzhiyun 		/* Root priv, can be controller */
694*4882a593Smuzhiyun 		set_bit(AGP_FF_ALLOW_CONTROLLER, &priv->access_flags);
695*4882a593Smuzhiyun 
696*4882a593Smuzhiyun 	client = agp_find_client_by_pid(current->pid);
697*4882a593Smuzhiyun 
698*4882a593Smuzhiyun 	if (client != NULL) {
699*4882a593Smuzhiyun 		set_bit(AGP_FF_IS_CLIENT, &priv->access_flags);
700*4882a593Smuzhiyun 		set_bit(AGP_FF_IS_VALID, &priv->access_flags);
701*4882a593Smuzhiyun 	}
702*4882a593Smuzhiyun 	file->private_data = (void *) priv;
703*4882a593Smuzhiyun 	agp_insert_file_private(priv);
704*4882a593Smuzhiyun 	DBG("private=%p, client=%p", priv, client);
705*4882a593Smuzhiyun 
706*4882a593Smuzhiyun 	mutex_unlock(&(agp_fe.agp_mutex));
707*4882a593Smuzhiyun 
708*4882a593Smuzhiyun 	return 0;
709*4882a593Smuzhiyun }
710*4882a593Smuzhiyun 
agpioc_info_wrap(struct agp_file_private * priv,void __user * arg)711*4882a593Smuzhiyun static int agpioc_info_wrap(struct agp_file_private *priv, void __user *arg)
712*4882a593Smuzhiyun {
713*4882a593Smuzhiyun 	struct agp_info userinfo;
714*4882a593Smuzhiyun 	struct agp_kern_info kerninfo;
715*4882a593Smuzhiyun 
716*4882a593Smuzhiyun 	agp_copy_info(agp_bridge, &kerninfo);
717*4882a593Smuzhiyun 
718*4882a593Smuzhiyun 	memset(&userinfo, 0, sizeof(userinfo));
719*4882a593Smuzhiyun 	userinfo.version.major = kerninfo.version.major;
720*4882a593Smuzhiyun 	userinfo.version.minor = kerninfo.version.minor;
721*4882a593Smuzhiyun 	userinfo.bridge_id = kerninfo.device->vendor |
722*4882a593Smuzhiyun 	    (kerninfo.device->device << 16);
723*4882a593Smuzhiyun 	userinfo.agp_mode = kerninfo.mode;
724*4882a593Smuzhiyun 	userinfo.aper_base = kerninfo.aper_base;
725*4882a593Smuzhiyun 	userinfo.aper_size = kerninfo.aper_size;
726*4882a593Smuzhiyun 	userinfo.pg_total = userinfo.pg_system = kerninfo.max_memory;
727*4882a593Smuzhiyun 	userinfo.pg_used = kerninfo.current_memory;
728*4882a593Smuzhiyun 
729*4882a593Smuzhiyun 	if (copy_to_user(arg, &userinfo, sizeof(struct agp_info)))
730*4882a593Smuzhiyun 		return -EFAULT;
731*4882a593Smuzhiyun 
732*4882a593Smuzhiyun 	return 0;
733*4882a593Smuzhiyun }
734*4882a593Smuzhiyun 
agpioc_acquire_wrap(struct agp_file_private * priv)735*4882a593Smuzhiyun int agpioc_acquire_wrap(struct agp_file_private *priv)
736*4882a593Smuzhiyun {
737*4882a593Smuzhiyun 	struct agp_controller *controller;
738*4882a593Smuzhiyun 
739*4882a593Smuzhiyun 	DBG("");
740*4882a593Smuzhiyun 
741*4882a593Smuzhiyun 	if (!(test_bit(AGP_FF_ALLOW_CONTROLLER, &priv->access_flags)))
742*4882a593Smuzhiyun 		return -EPERM;
743*4882a593Smuzhiyun 
744*4882a593Smuzhiyun 	if (agp_fe.current_controller != NULL)
745*4882a593Smuzhiyun 		return -EBUSY;
746*4882a593Smuzhiyun 
747*4882a593Smuzhiyun 	if (!agp_bridge)
748*4882a593Smuzhiyun 		return -ENODEV;
749*4882a593Smuzhiyun 
750*4882a593Smuzhiyun         if (atomic_read(&agp_bridge->agp_in_use))
751*4882a593Smuzhiyun                 return -EBUSY;
752*4882a593Smuzhiyun 
753*4882a593Smuzhiyun 	atomic_inc(&agp_bridge->agp_in_use);
754*4882a593Smuzhiyun 
755*4882a593Smuzhiyun 	agp_fe.backend_acquired = true;
756*4882a593Smuzhiyun 
757*4882a593Smuzhiyun 	controller = agp_find_controller_by_pid(priv->my_pid);
758*4882a593Smuzhiyun 
759*4882a593Smuzhiyun 	if (controller != NULL) {
760*4882a593Smuzhiyun 		agp_controller_make_current(controller);
761*4882a593Smuzhiyun 	} else {
762*4882a593Smuzhiyun 		controller = agp_create_controller(priv->my_pid);
763*4882a593Smuzhiyun 
764*4882a593Smuzhiyun 		if (controller == NULL) {
765*4882a593Smuzhiyun 			agp_fe.backend_acquired = false;
766*4882a593Smuzhiyun 			agp_backend_release(agp_bridge);
767*4882a593Smuzhiyun 			return -ENOMEM;
768*4882a593Smuzhiyun 		}
769*4882a593Smuzhiyun 		agp_insert_controller(controller);
770*4882a593Smuzhiyun 		agp_controller_make_current(controller);
771*4882a593Smuzhiyun 	}
772*4882a593Smuzhiyun 
773*4882a593Smuzhiyun 	set_bit(AGP_FF_IS_CONTROLLER, &priv->access_flags);
774*4882a593Smuzhiyun 	set_bit(AGP_FF_IS_VALID, &priv->access_flags);
775*4882a593Smuzhiyun 	return 0;
776*4882a593Smuzhiyun }
777*4882a593Smuzhiyun 
agpioc_release_wrap(struct agp_file_private * priv)778*4882a593Smuzhiyun int agpioc_release_wrap(struct agp_file_private *priv)
779*4882a593Smuzhiyun {
780*4882a593Smuzhiyun 	DBG("");
781*4882a593Smuzhiyun 	agp_controller_release_current(agp_fe.current_controller, priv);
782*4882a593Smuzhiyun 	return 0;
783*4882a593Smuzhiyun }
784*4882a593Smuzhiyun 
agpioc_setup_wrap(struct agp_file_private * priv,void __user * arg)785*4882a593Smuzhiyun int agpioc_setup_wrap(struct agp_file_private *priv, void __user *arg)
786*4882a593Smuzhiyun {
787*4882a593Smuzhiyun 	struct agp_setup mode;
788*4882a593Smuzhiyun 
789*4882a593Smuzhiyun 	DBG("");
790*4882a593Smuzhiyun 	if (copy_from_user(&mode, arg, sizeof(struct agp_setup)))
791*4882a593Smuzhiyun 		return -EFAULT;
792*4882a593Smuzhiyun 
793*4882a593Smuzhiyun 	agp_enable(agp_bridge, mode.agp_mode);
794*4882a593Smuzhiyun 	return 0;
795*4882a593Smuzhiyun }
796*4882a593Smuzhiyun 
agpioc_reserve_wrap(struct agp_file_private * priv,void __user * arg)797*4882a593Smuzhiyun static int agpioc_reserve_wrap(struct agp_file_private *priv, void __user *arg)
798*4882a593Smuzhiyun {
799*4882a593Smuzhiyun 	struct agp_region reserve;
800*4882a593Smuzhiyun 	struct agp_client *client;
801*4882a593Smuzhiyun 	struct agp_file_private *client_priv;
802*4882a593Smuzhiyun 
803*4882a593Smuzhiyun 	DBG("");
804*4882a593Smuzhiyun 	if (copy_from_user(&reserve, arg, sizeof(struct agp_region)))
805*4882a593Smuzhiyun 		return -EFAULT;
806*4882a593Smuzhiyun 
807*4882a593Smuzhiyun 	if ((unsigned) reserve.seg_count >= ~0U/sizeof(struct agp_segment))
808*4882a593Smuzhiyun 		return -EFAULT;
809*4882a593Smuzhiyun 
810*4882a593Smuzhiyun 	client = agp_find_client_by_pid(reserve.pid);
811*4882a593Smuzhiyun 
812*4882a593Smuzhiyun 	if (reserve.seg_count == 0) {
813*4882a593Smuzhiyun 		/* remove a client */
814*4882a593Smuzhiyun 		client_priv = agp_find_private(reserve.pid);
815*4882a593Smuzhiyun 
816*4882a593Smuzhiyun 		if (client_priv != NULL) {
817*4882a593Smuzhiyun 			set_bit(AGP_FF_IS_CLIENT, &client_priv->access_flags);
818*4882a593Smuzhiyun 			set_bit(AGP_FF_IS_VALID, &client_priv->access_flags);
819*4882a593Smuzhiyun 		}
820*4882a593Smuzhiyun 		if (client == NULL) {
821*4882a593Smuzhiyun 			/* client is already removed */
822*4882a593Smuzhiyun 			return 0;
823*4882a593Smuzhiyun 		}
824*4882a593Smuzhiyun 		return agp_remove_client(reserve.pid);
825*4882a593Smuzhiyun 	} else {
826*4882a593Smuzhiyun 		struct agp_segment *segment;
827*4882a593Smuzhiyun 
828*4882a593Smuzhiyun 		if (reserve.seg_count >= 16384)
829*4882a593Smuzhiyun 			return -EINVAL;
830*4882a593Smuzhiyun 
831*4882a593Smuzhiyun 		segment = kmalloc((sizeof(struct agp_segment) * reserve.seg_count),
832*4882a593Smuzhiyun 				  GFP_KERNEL);
833*4882a593Smuzhiyun 
834*4882a593Smuzhiyun 		if (segment == NULL)
835*4882a593Smuzhiyun 			return -ENOMEM;
836*4882a593Smuzhiyun 
837*4882a593Smuzhiyun 		if (copy_from_user(segment, (void __user *) reserve.seg_list,
838*4882a593Smuzhiyun 				   sizeof(struct agp_segment) * reserve.seg_count)) {
839*4882a593Smuzhiyun 			kfree(segment);
840*4882a593Smuzhiyun 			return -EFAULT;
841*4882a593Smuzhiyun 		}
842*4882a593Smuzhiyun 		reserve.seg_list = segment;
843*4882a593Smuzhiyun 
844*4882a593Smuzhiyun 		if (client == NULL) {
845*4882a593Smuzhiyun 			/* Create the client and add the segment */
846*4882a593Smuzhiyun 			client = agp_create_client(reserve.pid);
847*4882a593Smuzhiyun 
848*4882a593Smuzhiyun 			if (client == NULL) {
849*4882a593Smuzhiyun 				kfree(segment);
850*4882a593Smuzhiyun 				return -ENOMEM;
851*4882a593Smuzhiyun 			}
852*4882a593Smuzhiyun 			client_priv = agp_find_private(reserve.pid);
853*4882a593Smuzhiyun 
854*4882a593Smuzhiyun 			if (client_priv != NULL) {
855*4882a593Smuzhiyun 				set_bit(AGP_FF_IS_CLIENT, &client_priv->access_flags);
856*4882a593Smuzhiyun 				set_bit(AGP_FF_IS_VALID, &client_priv->access_flags);
857*4882a593Smuzhiyun 			}
858*4882a593Smuzhiyun 		}
859*4882a593Smuzhiyun 		return agp_create_segment(client, &reserve);
860*4882a593Smuzhiyun 	}
861*4882a593Smuzhiyun 	/* Will never really happen */
862*4882a593Smuzhiyun 	return -EINVAL;
863*4882a593Smuzhiyun }
864*4882a593Smuzhiyun 
agpioc_protect_wrap(struct agp_file_private * priv)865*4882a593Smuzhiyun int agpioc_protect_wrap(struct agp_file_private *priv)
866*4882a593Smuzhiyun {
867*4882a593Smuzhiyun 	DBG("");
868*4882a593Smuzhiyun 	/* This function is not currently implemented */
869*4882a593Smuzhiyun 	return -EINVAL;
870*4882a593Smuzhiyun }
871*4882a593Smuzhiyun 
agpioc_allocate_wrap(struct agp_file_private * priv,void __user * arg)872*4882a593Smuzhiyun static int agpioc_allocate_wrap(struct agp_file_private *priv, void __user *arg)
873*4882a593Smuzhiyun {
874*4882a593Smuzhiyun 	struct agp_memory *memory;
875*4882a593Smuzhiyun 	struct agp_allocate alloc;
876*4882a593Smuzhiyun 
877*4882a593Smuzhiyun 	DBG("");
878*4882a593Smuzhiyun 	if (copy_from_user(&alloc, arg, sizeof(struct agp_allocate)))
879*4882a593Smuzhiyun 		return -EFAULT;
880*4882a593Smuzhiyun 
881*4882a593Smuzhiyun 	if (alloc.type >= AGP_USER_TYPES)
882*4882a593Smuzhiyun 		return -EINVAL;
883*4882a593Smuzhiyun 
884*4882a593Smuzhiyun 	memory = agp_allocate_memory_wrap(alloc.pg_count, alloc.type);
885*4882a593Smuzhiyun 
886*4882a593Smuzhiyun 	if (memory == NULL)
887*4882a593Smuzhiyun 		return -ENOMEM;
888*4882a593Smuzhiyun 
889*4882a593Smuzhiyun 	alloc.key = memory->key;
890*4882a593Smuzhiyun 	alloc.physical = memory->physical;
891*4882a593Smuzhiyun 
892*4882a593Smuzhiyun 	if (copy_to_user(arg, &alloc, sizeof(struct agp_allocate))) {
893*4882a593Smuzhiyun 		agp_free_memory_wrap(memory);
894*4882a593Smuzhiyun 		return -EFAULT;
895*4882a593Smuzhiyun 	}
896*4882a593Smuzhiyun 	return 0;
897*4882a593Smuzhiyun }
898*4882a593Smuzhiyun 
agpioc_deallocate_wrap(struct agp_file_private * priv,int arg)899*4882a593Smuzhiyun int agpioc_deallocate_wrap(struct agp_file_private *priv, int arg)
900*4882a593Smuzhiyun {
901*4882a593Smuzhiyun 	struct agp_memory *memory;
902*4882a593Smuzhiyun 
903*4882a593Smuzhiyun 	DBG("");
904*4882a593Smuzhiyun 	memory = agp_find_mem_by_key(arg);
905*4882a593Smuzhiyun 
906*4882a593Smuzhiyun 	if (memory == NULL)
907*4882a593Smuzhiyun 		return -EINVAL;
908*4882a593Smuzhiyun 
909*4882a593Smuzhiyun 	agp_free_memory_wrap(memory);
910*4882a593Smuzhiyun 	return 0;
911*4882a593Smuzhiyun }
912*4882a593Smuzhiyun 
agpioc_bind_wrap(struct agp_file_private * priv,void __user * arg)913*4882a593Smuzhiyun static int agpioc_bind_wrap(struct agp_file_private *priv, void __user *arg)
914*4882a593Smuzhiyun {
915*4882a593Smuzhiyun 	struct agp_bind bind_info;
916*4882a593Smuzhiyun 	struct agp_memory *memory;
917*4882a593Smuzhiyun 
918*4882a593Smuzhiyun 	DBG("");
919*4882a593Smuzhiyun 	if (copy_from_user(&bind_info, arg, sizeof(struct agp_bind)))
920*4882a593Smuzhiyun 		return -EFAULT;
921*4882a593Smuzhiyun 
922*4882a593Smuzhiyun 	memory = agp_find_mem_by_key(bind_info.key);
923*4882a593Smuzhiyun 
924*4882a593Smuzhiyun 	if (memory == NULL)
925*4882a593Smuzhiyun 		return -EINVAL;
926*4882a593Smuzhiyun 
927*4882a593Smuzhiyun 	return agp_bind_memory(memory, bind_info.pg_start);
928*4882a593Smuzhiyun }
929*4882a593Smuzhiyun 
agpioc_unbind_wrap(struct agp_file_private * priv,void __user * arg)930*4882a593Smuzhiyun static int agpioc_unbind_wrap(struct agp_file_private *priv, void __user *arg)
931*4882a593Smuzhiyun {
932*4882a593Smuzhiyun 	struct agp_memory *memory;
933*4882a593Smuzhiyun 	struct agp_unbind unbind;
934*4882a593Smuzhiyun 
935*4882a593Smuzhiyun 	DBG("");
936*4882a593Smuzhiyun 	if (copy_from_user(&unbind, arg, sizeof(struct agp_unbind)))
937*4882a593Smuzhiyun 		return -EFAULT;
938*4882a593Smuzhiyun 
939*4882a593Smuzhiyun 	memory = agp_find_mem_by_key(unbind.key);
940*4882a593Smuzhiyun 
941*4882a593Smuzhiyun 	if (memory == NULL)
942*4882a593Smuzhiyun 		return -EINVAL;
943*4882a593Smuzhiyun 
944*4882a593Smuzhiyun 	return agp_unbind_memory(memory);
945*4882a593Smuzhiyun }
946*4882a593Smuzhiyun 
agp_ioctl(struct file * file,unsigned int cmd,unsigned long arg)947*4882a593Smuzhiyun static long agp_ioctl(struct file *file,
948*4882a593Smuzhiyun 		     unsigned int cmd, unsigned long arg)
949*4882a593Smuzhiyun {
950*4882a593Smuzhiyun 	struct agp_file_private *curr_priv = file->private_data;
951*4882a593Smuzhiyun 	int ret_val = -ENOTTY;
952*4882a593Smuzhiyun 
953*4882a593Smuzhiyun 	DBG("priv=%p, cmd=%x", curr_priv, cmd);
954*4882a593Smuzhiyun 	mutex_lock(&(agp_fe.agp_mutex));
955*4882a593Smuzhiyun 
956*4882a593Smuzhiyun 	if ((agp_fe.current_controller == NULL) &&
957*4882a593Smuzhiyun 	    (cmd != AGPIOC_ACQUIRE)) {
958*4882a593Smuzhiyun 		ret_val = -EINVAL;
959*4882a593Smuzhiyun 		goto ioctl_out;
960*4882a593Smuzhiyun 	}
961*4882a593Smuzhiyun 	if ((agp_fe.backend_acquired != true) &&
962*4882a593Smuzhiyun 	    (cmd != AGPIOC_ACQUIRE)) {
963*4882a593Smuzhiyun 		ret_val = -EBUSY;
964*4882a593Smuzhiyun 		goto ioctl_out;
965*4882a593Smuzhiyun 	}
966*4882a593Smuzhiyun 	if (cmd != AGPIOC_ACQUIRE) {
967*4882a593Smuzhiyun 		if (!(test_bit(AGP_FF_IS_CONTROLLER, &curr_priv->access_flags))) {
968*4882a593Smuzhiyun 			ret_val = -EPERM;
969*4882a593Smuzhiyun 			goto ioctl_out;
970*4882a593Smuzhiyun 		}
971*4882a593Smuzhiyun 		/* Use the original pid of the controller,
972*4882a593Smuzhiyun 		 * in case it's threaded */
973*4882a593Smuzhiyun 
974*4882a593Smuzhiyun 		if (agp_fe.current_controller->pid != curr_priv->my_pid) {
975*4882a593Smuzhiyun 			ret_val = -EBUSY;
976*4882a593Smuzhiyun 			goto ioctl_out;
977*4882a593Smuzhiyun 		}
978*4882a593Smuzhiyun 	}
979*4882a593Smuzhiyun 
980*4882a593Smuzhiyun 	switch (cmd) {
981*4882a593Smuzhiyun 	case AGPIOC_INFO:
982*4882a593Smuzhiyun 		ret_val = agpioc_info_wrap(curr_priv, (void __user *) arg);
983*4882a593Smuzhiyun 		break;
984*4882a593Smuzhiyun 
985*4882a593Smuzhiyun 	case AGPIOC_ACQUIRE:
986*4882a593Smuzhiyun 		ret_val = agpioc_acquire_wrap(curr_priv);
987*4882a593Smuzhiyun 		break;
988*4882a593Smuzhiyun 
989*4882a593Smuzhiyun 	case AGPIOC_RELEASE:
990*4882a593Smuzhiyun 		ret_val = agpioc_release_wrap(curr_priv);
991*4882a593Smuzhiyun 		break;
992*4882a593Smuzhiyun 
993*4882a593Smuzhiyun 	case AGPIOC_SETUP:
994*4882a593Smuzhiyun 		ret_val = agpioc_setup_wrap(curr_priv, (void __user *) arg);
995*4882a593Smuzhiyun 		break;
996*4882a593Smuzhiyun 
997*4882a593Smuzhiyun 	case AGPIOC_RESERVE:
998*4882a593Smuzhiyun 		ret_val = agpioc_reserve_wrap(curr_priv, (void __user *) arg);
999*4882a593Smuzhiyun 		break;
1000*4882a593Smuzhiyun 
1001*4882a593Smuzhiyun 	case AGPIOC_PROTECT:
1002*4882a593Smuzhiyun 		ret_val = agpioc_protect_wrap(curr_priv);
1003*4882a593Smuzhiyun 		break;
1004*4882a593Smuzhiyun 
1005*4882a593Smuzhiyun 	case AGPIOC_ALLOCATE:
1006*4882a593Smuzhiyun 		ret_val = agpioc_allocate_wrap(curr_priv, (void __user *) arg);
1007*4882a593Smuzhiyun 		break;
1008*4882a593Smuzhiyun 
1009*4882a593Smuzhiyun 	case AGPIOC_DEALLOCATE:
1010*4882a593Smuzhiyun 		ret_val = agpioc_deallocate_wrap(curr_priv, (int) arg);
1011*4882a593Smuzhiyun 		break;
1012*4882a593Smuzhiyun 
1013*4882a593Smuzhiyun 	case AGPIOC_BIND:
1014*4882a593Smuzhiyun 		ret_val = agpioc_bind_wrap(curr_priv, (void __user *) arg);
1015*4882a593Smuzhiyun 		break;
1016*4882a593Smuzhiyun 
1017*4882a593Smuzhiyun 	case AGPIOC_UNBIND:
1018*4882a593Smuzhiyun 		ret_val = agpioc_unbind_wrap(curr_priv, (void __user *) arg);
1019*4882a593Smuzhiyun 		break;
1020*4882a593Smuzhiyun 
1021*4882a593Smuzhiyun 	case AGPIOC_CHIPSET_FLUSH:
1022*4882a593Smuzhiyun 		break;
1023*4882a593Smuzhiyun 	}
1024*4882a593Smuzhiyun 
1025*4882a593Smuzhiyun ioctl_out:
1026*4882a593Smuzhiyun 	DBG("ioctl returns %d\n", ret_val);
1027*4882a593Smuzhiyun 	mutex_unlock(&(agp_fe.agp_mutex));
1028*4882a593Smuzhiyun 	return ret_val;
1029*4882a593Smuzhiyun }
1030*4882a593Smuzhiyun 
1031*4882a593Smuzhiyun static const struct file_operations agp_fops =
1032*4882a593Smuzhiyun {
1033*4882a593Smuzhiyun 	.owner		= THIS_MODULE,
1034*4882a593Smuzhiyun 	.llseek		= no_llseek,
1035*4882a593Smuzhiyun 	.unlocked_ioctl	= agp_ioctl,
1036*4882a593Smuzhiyun #ifdef CONFIG_COMPAT
1037*4882a593Smuzhiyun 	.compat_ioctl	= compat_agp_ioctl,
1038*4882a593Smuzhiyun #endif
1039*4882a593Smuzhiyun 	.mmap		= agp_mmap,
1040*4882a593Smuzhiyun 	.open		= agp_open,
1041*4882a593Smuzhiyun 	.release	= agp_release,
1042*4882a593Smuzhiyun };
1043*4882a593Smuzhiyun 
1044*4882a593Smuzhiyun static struct miscdevice agp_miscdev =
1045*4882a593Smuzhiyun {
1046*4882a593Smuzhiyun 	.minor	= AGPGART_MINOR,
1047*4882a593Smuzhiyun 	.name	= "agpgart",
1048*4882a593Smuzhiyun 	.fops	= &agp_fops
1049*4882a593Smuzhiyun };
1050*4882a593Smuzhiyun 
agp_frontend_initialize(void)1051*4882a593Smuzhiyun int agp_frontend_initialize(void)
1052*4882a593Smuzhiyun {
1053*4882a593Smuzhiyun 	memset(&agp_fe, 0, sizeof(struct agp_front_data));
1054*4882a593Smuzhiyun 	mutex_init(&(agp_fe.agp_mutex));
1055*4882a593Smuzhiyun 
1056*4882a593Smuzhiyun 	if (misc_register(&agp_miscdev)) {
1057*4882a593Smuzhiyun 		printk(KERN_ERR PFX "unable to get minor: %d\n", AGPGART_MINOR);
1058*4882a593Smuzhiyun 		return -EIO;
1059*4882a593Smuzhiyun 	}
1060*4882a593Smuzhiyun 	return 0;
1061*4882a593Smuzhiyun }
1062*4882a593Smuzhiyun 
agp_frontend_cleanup(void)1063*4882a593Smuzhiyun void agp_frontend_cleanup(void)
1064*4882a593Smuzhiyun {
1065*4882a593Smuzhiyun 	misc_deregister(&agp_miscdev);
1066*4882a593Smuzhiyun }
1067