1 /*-
2 * Copyright (c) 2000-2001 by Coleman Kane <cokane@FreeBSD.org>
3 * All rights reserved.
4 *
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
7 * are met:
8 * 1. Redistributions of source code must retain the above copyright
9 * notice, this list of conditions and the following disclaimer.
10 * 2. Redistributions in binary form must reproduce the above copyright
11 * notice, this list of conditions and the following disclaimer in the
12 * documentation and/or other materials provided with the distribution.
13 * 3. All advertising materials mentioning features or use of this software
14 * must display the following acknowledgement:
15 * This product includes software developed by Gardner Buchanan.
16 * 4. The name of Gardner Buchanan may not be used to endorse or promote
17 * products derived from this software without specific prior written
18 * permission.
19 *
20 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
21 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
22 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
23 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
24 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
25 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
26 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
27 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
28 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
29 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
30 */
31
32 #include <sys/cdefs.h>
33 __FBSDID("$FreeBSD: releng/8.0/sys/dev/tdfx/tdfx_pci.c 191056 2009-04-14 11:57:26Z ed $");
34
35 /* 3dfx driver for FreeBSD 4.x - Finished 11 May 2000, 12:25AM ET
36 *
37 * Copyright (C) 2000-2001, by Coleman Kane <cokane@FreeBSD.org>,
38 * based upon the 3dfx driver written for linux, by Daryll Straus, Jon Taylor,
39 * and Jens Axboe, located at http://linux.3dfx.com.
40 */
41
42 #include <sys/param.h>
43
44 #include <sys/bus.h>
45 #include <sys/cdefs.h>
46 #include <sys/conf.h>
47 #include <sys/fcntl.h>
48 #include <sys/file.h>
49 #include <sys/filedesc.h>
50 #include <sys/filio.h>
51 #include <sys/ioccom.h>
52 #include <sys/kernel.h>
53 #include <sys/module.h>
54 #include <sys/malloc.h>
55 #include <sys/mman.h>
56 #include <sys/signalvar.h>
57 #include <sys/systm.h>
58 #include <sys/uio.h>
59
60 #include <dev/pci/pcivar.h>
61 #include <dev/pci/pcireg.h>
62
63 #include <vm/vm.h>
64 #include <vm/vm_kern.h>
65 #include <vm/pmap.h>
66 #include <vm/vm_extern.h>
67
68 /* rman.h depends on machine/bus.h */
69 #include <machine/resource.h>
70 #include <machine/bus.h>
71 #include <sys/rman.h>
72
73 #include <dev/tdfx/tdfx_io.h>
74 #include <dev/tdfx/tdfx_vars.h>
75 #include <dev/tdfx/tdfx_pci.h>
76
77
78 static devclass_t tdfx_devclass;
79
80
81 static int tdfx_count = 0;
82
83
84 /* Set up the boot probe/attach routines */
85 static device_method_t tdfx_methods[] = {
86 DEVMETHOD(device_probe, tdfx_probe),
87 DEVMETHOD(device_attach, tdfx_attach),
88 DEVMETHOD(device_detach, tdfx_detach),
89 DEVMETHOD(device_shutdown, tdfx_shutdown),
90 { 0, 0 }
91 };
92
93 MALLOC_DEFINE(M_TDFX,"tdfx_driver","3DFX Graphics[/2D]/3D Accelerator(s)");
94
95 /* Char. Dev. file operations structure */
96 static struct cdevsw tdfx_cdev = {
97 .d_version = D_VERSION,
98 .d_flags = D_NEEDGIANT,
99 .d_open = tdfx_open,
100 .d_close = tdfx_close,
101 .d_ioctl = tdfx_ioctl,
102 .d_mmap = tdfx_mmap,
103 .d_name = "tdfx",
104 };
105
106 static int
107 tdfx_probe(device_t dev)
108 {
109 /*
110 * probe routine called on kernel boot to register supported devices. We get
111 * a device structure to work with, and we can test the VENDOR/DEVICE IDs to
112 * see if this PCI device is one that we support. Return BUS_PRROBE_DEFAULT
113 * if yes, ENXIO if not.
114 */
115 switch(pci_get_devid(dev)) {
116 case PCI_DEVICE_ALLIANCE_AT3D:
117 device_set_desc(dev, "ProMotion At3D 3D Accelerator");
118 return BUS_PROBE_DEFAULT;
119 case PCI_DEVICE_3DFX_VOODOO2:
120 device_set_desc(dev, "3DFX Voodoo II 3D Accelerator");
121 return BUS_PROBE_DEFAULT;
122 /*case PCI_DEVICE_3DFX_BANSHEE:
123 device_set_desc(dev, "3DFX Voodoo Banshee 2D/3D Graphics Accelerator");
124 return BUS_PROBE_DEFAULT;
125 case PCI_DEVICE_3DFX_VOODOO3:
126 device_set_desc(dev, "3DFX Voodoo3 2D/3D Graphics Accelerator");
127 return BUS_PROBE_DEFAULT;*/
128 case PCI_DEVICE_3DFX_VOODOO1:
129 device_set_desc(dev, "3DFX Voodoo Graphics 3D Accelerator");
130 return BUS_PROBE_DEFAULT;
131 };
132
133 return ENXIO;
134 }
135
136 static int
137 tdfx_attach(device_t dev) {
138 /*
139 * The attach routine is called after the probe routine successfully says it
140 * supports a given card. We now proceed to initialize this card for use with
141 * the system. I want to map the device memory for userland allocation and
142 * fill an information structure with information on this card. I'd also like
143 * to set Write Combining with the MTRR code so that we can hopefully speed
144 * up memory writes. The last thing is to register the character device
145 * interface to the card, so we can open it from /dev/3dfxN, where N is a
146 * small, whole number.
147 */
148 struct tdfx_softc *tdfx_info;
149 u_long val;
150 /* rid value tells bus_alloc_resource where to find the addresses of ports or
151 * of memory ranges in the PCI config space*/
152 int rid = PCIR_BAR(0);
153
154 /* Increment the card counter (for the ioctl code) */
155 tdfx_count++;
156
157 /* Enable MemMap on Voodoo */
158 val = pci_read_config(dev, PCIR_COMMAND, 2);
159 val |= (PCIM_CMD_MEMEN);
160 pci_write_config(dev, PCIR_COMMAND, val, 2);
161 val = pci_read_config(dev, PCIR_COMMAND, 2);
162
163 /* Fill the soft config struct with info about this device*/
164 tdfx_info = device_get_softc(dev);
165 tdfx_info->dev = dev;
166 tdfx_info->vendor = pci_get_vendor(dev);
167 tdfx_info->type = pci_get_devid(dev) >> 16;
168 tdfx_info->bus = pci_get_bus(dev);
169 tdfx_info->dv = pci_get_slot(dev);
170 tdfx_info->curFile = NULL;
171
172 /*
173 * Get the Memory Location from the PCI Config, mask out lower word, since
174 * the config space register is only one word long (this is nicer than a
175 * bitshift).
176 */
177 tdfx_info->addr0 = (pci_read_config(dev, 0x10, 4) & 0xffff0000);
178 #ifdef DEBUG
179 device_printf(dev, "Base0 @ 0x%x\n", tdfx_info->addr0);
180 #endif
181 /* Notify the VM that we will be mapping some memory later */
182 tdfx_info->memrange = bus_alloc_resource_any(dev, SYS_RES_MEMORY,
183 &rid, RF_ACTIVE | RF_SHAREABLE);
184 if(tdfx_info->memrange == NULL) {
185 #ifdef DEBUG
186 device_printf(dev, "Error mapping mem, won't be able to use mmap()\n");
187 #endif
188 tdfx_info->memrid = 0;
189 }
190 else {
191 tdfx_info->memrid = rid;
192 #ifdef DEBUG
193 device_printf(dev, "Mapped to: 0x%x\n",
194 (unsigned int)rman_get_start(tdfx_info->memrange));
195 #endif
196 }
197
198 /* Setup for Voodoo3 and Banshee, PIO and an extram Memrange */
199 if(pci_get_devid(dev) == PCI_DEVICE_3DFX_VOODOO3 ||
200 pci_get_devid(dev) == PCI_DEVICE_3DFX_BANSHEE) {
201 rid = 0x14; /* 2nd mem map */
202 tdfx_info->addr1 = (pci_read_config(dev, 0x14, 4) & 0xffff0000);
203 #ifdef DEBUG
204 device_printf(dev, "Base1 @ 0x%x\n", tdfx_info->addr1);
205 #endif
206 tdfx_info->memrange2 = bus_alloc_resource_any(dev,
207 SYS_RES_MEMORY, &rid, RF_ACTIVE | RF_SHAREABLE);
208 if(tdfx_info->memrange2 == NULL) {
209 #ifdef DEBUG
210 device_printf(dev, "Mem1 couldn't be allocated, glide may not work.");
211 #endif
212 tdfx_info->memrid2 = 0;
213 }
214 else {
215 tdfx_info->memrid2 = rid;
216 }
217 /* Now to map the PIO stuff */
218 rid = PCIR_IOBASE0_2;
219 tdfx_info->pio0 = pci_read_config(dev, 0x2c, 2);
220 tdfx_info->pio0max = pci_read_config(dev, 0x30, 2) + tdfx_info->pio0;
221 tdfx_info->piorange = bus_alloc_resource_any(dev,
222 SYS_RES_IOPORT, &rid, RF_ACTIVE | RF_SHAREABLE);
223 if(tdfx_info->piorange == NULL) {
224 #ifdef DEBUG
225 device_printf(dev, "Couldn't map PIO range.");
226 #endif
227 tdfx_info->piorid = 0;
228 }
229 else {
230 tdfx_info->piorid = rid;
231 }
232 } else {
233 tdfx_info->addr1 = 0;
234 tdfx_info->memrange2 = NULL;
235 tdfx_info->piorange = NULL;
236 }
237
238 /*
239 * Set Writecombining, or at least Uncacheable for the memory region, if we
240 * are able to
241 */
242
243 if(tdfx_setmtrr(dev) != 0) {
244 #ifdef DEBUG
245 device_printf(dev, "Some weird error setting MTRRs");
246 #endif
247 return -1;
248 }
249
250 /*
251 * make_dev registers the cdev to access the 3dfx card from /dev
252 * use hex here for the dev num, simply to provide better support if > 10
253 * voodoo cards, for the mad. The user must set the link, or use MAKEDEV.
254 * Why would we want that many voodoo cards anyhow?
255 */
256 tdfx_info->devt = make_dev(&tdfx_cdev, device_get_unit(dev),
257 UID_ROOT, GID_WHEEL, 0600, "3dfx%x", device_get_unit(dev));
258 tdfx_info->devt->si_drv1 = tdfx_info;
259
260 return 0;
261 }
262
263 static int
264 tdfx_detach(device_t dev) {
265 struct tdfx_softc* tdfx_info;
266 int retval;
267 tdfx_info = device_get_softc(dev);
268
269 /* Delete allocated resource, of course */
270 bus_release_resource(dev, SYS_RES_MEMORY, tdfx_info->memrid,
271 tdfx_info->memrange);
272
273 /* Release extended Voodoo3/Banshee resources */
274 if(pci_get_devid(dev) == PCI_DEVICE_3DFX_BANSHEE ||
275 pci_get_devid(dev) == PCI_DEVICE_3DFX_VOODOO3) {
276 if(tdfx_info->memrange2 != NULL)
277 bus_release_resource(dev, SYS_RES_MEMORY, tdfx_info->memrid2,
278 tdfx_info->memrange);
279 /* if(tdfx_info->piorange != NULL)
280 bus_release_resource(dev, SYS_RES_IOPORT, tdfx_info->piorid,
281 tdfx_info->piorange);*/
282 }
283
284 /* Though it is safe to leave the WRCOMB support since the
285 mem driver checks for it, we should remove it in order
286 to free an MTRR for another device */
287 retval = tdfx_clrmtrr(dev);
288 #ifdef DEBUG
289 if(retval != 0)
290 printf("tdfx: For some reason, I couldn't clear the mtrr\n");
291 #endif
292 /* Remove device entry when it can no longer be accessed */
293 destroy_dev(tdfx_info->devt);
294 return(0);
295 }
296
297 static int
298 tdfx_shutdown(device_t dev) {
299 #ifdef DEBUG
300 device_printf(dev, "tdfx: Device Shutdown\n");
301 #endif
302 return 0;
303 }
304
305 static int
306 tdfx_clrmtrr(device_t dev) {
307 /* This function removes the MTRR set by the attach call, so it can be used
308 * in the future by other drivers.
309 */
310 int retval, act;
311 struct tdfx_softc *tdfx_info = device_get_softc(dev);
312
313 act = MEMRANGE_SET_REMOVE;
314 retval = mem_range_attr_set(&tdfx_info->mrdesc, &act);
315 return retval;
316 }
317
318 static int
319 tdfx_setmtrr(device_t dev) {
320 /*
321 * This is the MTRR setting function for the 3dfx card. It is called from
322 * tdfx_attach. If we can't set the MTRR properly, it's not the end of the
323 * world. We can still continue, just with slightly (very slightly) degraded
324 * performance.
325 */
326 int retval = 0, act;
327 struct tdfx_softc *tdfx_info = device_get_softc(dev);
328
329 /* The older Voodoo cards have a shorter memrange than the newer ones */
330 if((pci_get_devid(dev) == PCI_DEVICE_3DFX_VOODOO1) || (pci_get_devid(dev) ==
331 PCI_DEVICE_3DFX_VOODOO2)) {
332 tdfx_info->mrdesc.mr_len = 0x400000;
333
334 /* The memory descriptor is described as the top 15 bits of the real
335 address */
336 tdfx_info->mrdesc.mr_base = tdfx_info->addr0 & 0xfffe0000;
337 }
338 else if((pci_get_devid(dev) == PCI_DEVICE_3DFX_VOODOO3) ||
339 (pci_get_devid(dev) == PCI_DEVICE_3DFX_BANSHEE)) {
340 tdfx_info->mrdesc.mr_len = 0x1000000;
341 /* The Voodoo3 and Banshee LFB is the second memory address */
342 /* The memory descriptor is described as the top 15 bits of the real
343 address */
344 tdfx_info->mrdesc.mr_base = tdfx_info->addr1 & 0xfffe0000;
345 }
346 else
347 return 0;
348 /*
349 * The Alliance Pro Motion AT3D was not mentioned in the linux
350 * driver as far as MTRR support goes, so I just won't put the
351 * code in here for it. This is where it should go, though.
352 */
353
354 /* Firstly, try to set write combining */
355 tdfx_info->mrdesc.mr_flags = MDF_WRITECOMBINE;
356 bcopy("tdfx", &tdfx_info->mrdesc.mr_owner, 4);
357 act = MEMRANGE_SET_UPDATE;
358 retval = mem_range_attr_set(&tdfx_info->mrdesc, &act);
359
360 if(retval == 0) {
361 #ifdef DEBUG
362 device_printf(dev, "MTRR Set Correctly for tdfx\n");
363 #endif
364 } else if((pci_get_devid(dev) == PCI_DEVICE_3DFX_VOODOO2) ||
365 (pci_get_devid(dev) == PCI_DEVICE_3DFX_VOODOO1)) {
366 /* if, for some reason we can't set the WRCOMB range with the V1/V2, we
367 * can still possibly use the UNCACHEABLE region for it instead, and help
368 * out in a small way */
369 tdfx_info->mrdesc.mr_flags = MDF_UNCACHEABLE;
370 /* This length of 1000h was taken from the linux device driver... */
371 tdfx_info->mrdesc.mr_len = 0x1000;
372
373 /*
374 * If, for some reason, we can't set the MTRR (N/A?) we may still continue
375 */
376 #ifdef DEBUG
377 device_printf(dev, "MTRR Set Type Uncacheable %x\n",
378 (u_int32_t)tdfx_info->mrdesc.mr_base);
379 #endif
380 }
381 #ifdef DEBUG
382 else {
383 device_printf(dev, "Couldn't Set MTRR\n");
384 return 0;
385 }
386 #endif
387 return 0;
388 }
389
390 static int
391 tdfx_open(struct cdev *dev, int flags, int fmt, struct thread *td)
392 {
393 /*
394 * The open cdev method handles open(2) calls to /dev/3dfx[n]
395 * We can pretty much allow any opening of the device.
396 */
397 struct tdfx_softc *tdfx_info = dev->si_drv1;
398 if(tdfx_info->busy != 0) return EBUSY;
399 #ifdef DEBUG
400 printf("3dfx: Opened by #%d\n", td->td_proc->p_pid);
401 #endif
402 /* Set the driver as busy */
403 tdfx_info->busy++;
404 return 0;
405 }
406
407 static int
408 tdfx_close(struct cdev *dev, int fflag, int devtype, struct thread *td)
409 {
410 /*
411 * The close cdev method handles close(2) calls to /dev/3dfx[n]
412 * We'll always want to close the device when it's called.
413 */
414 struct tdfx_softc *tdfx_info = dev->si_drv1;
415 if(tdfx_info->busy == 0) return EBADF;
416 tdfx_info->busy = 0;
417 #ifdef DEBUG
418 printf("Closed by #%d\n", td->td_proc->p_pid);
419 #endif
420 return 0;
421 }
422
423 static int
424 tdfx_mmap(struct cdev *dev, vm_offset_t offset, vm_paddr_t *paddr, int nprot)
425 {
426 /*
427 * mmap(2) is called by a user process to request that an area of memory
428 * associated with this device be mapped for the process to work with. Nprot
429 * holds the protections requested, PROT_READ, PROT_WRITE, or both.
430 */
431
432 /**** OLD GET CONFIG ****/
433 /* struct tdfx_softc* tdfx_info; */
434
435 /* Get the configuration for our card XXX*/
436 /*tdfx_info = dev->si_drv1; */
437 /************************/
438
439 struct tdfx_softc* tdfx_info[2];
440
441 tdfx_info[0] = (struct tdfx_softc*)devclass_get_softc(tdfx_devclass, 0);
442
443 /* If, for some reason, its not configured, we bail out */
444 if(tdfx_info[0] == NULL) {
445 #ifdef DEBUG
446 printf("tdfx: tdfx_info (softc) is NULL\n");
447 #endif
448 return -1;
449 }
450
451 /* We must stay within the bound of our address space */
452 if((offset & 0xff000000) == tdfx_info[0]->addr0) {
453 offset &= 0xffffff;
454 *paddr = rman_get_start(tdfx_info[0]->memrange) + offset;
455 return 0;
456 }
457
458 if(tdfx_count > 1) {
459 tdfx_info[1] = (struct tdfx_softc*)devclass_get_softc(tdfx_devclass, 1);
460 if((offset & 0xff000000) == tdfx_info[1]->addr0) {
461 offset &= 0xffffff;
462 *paddr = rman_get_start(tdfx_info[1]->memrange) +
463 offset;
464 return 0;
465 }
466 }
467
468 /* See if the Banshee/V3 LFB is being requested */
469 /*if(tdfx_info->memrange2 != NULL && (offset & 0xff000000) ==
470 tdfx_info->addr1) {
471 offset &= 0xffffff;
472 return atop(rman_get_start(tdfx_info[1]->memrange2) + offset);
473 }*/ /* VoodooNG code */
474
475 /* The ret call */
476 /* atop -> address to page
477 * rman_get_start, get the (struct resource*)->r_start member,
478 * the mapping base address.
479 */
480 return -1;
481 }
482
483 static int
484 tdfx_query_boards(void) {
485 /*
486 * This returns the number of installed tdfx cards, we have been keeping
487 * count, look at tdfx_attach
488 */
489 return tdfx_count;
490 }
491
492 static int
493 tdfx_query_fetch(u_int cmd, struct tdfx_pio_data *piod)
494 {
495 /* XXX Comment this later, after careful inspection and spring cleaning :) */
496 /* Various return values 8bit-32bit */
497 u_int8_t ret_byte;
498 u_int16_t ret_word;
499 u_int32_t ret_dword;
500 struct tdfx_softc* tdfx_info = NULL;
501
502 /* This one depend on the tdfx_* structs being properly initialized */
503
504 /*piod->device &= 0xf;*/
505 if((piod == NULL) ||(tdfx_count <= piod->device) ||
506 (piod->device < 0)) {
507 #ifdef DEBUG
508 printf("tdfx: Bad device or internal struct in tdfx_query_fetch\n");
509 #endif
510 return -EINVAL;
511 }
512
513 tdfx_info = (struct tdfx_softc*)devclass_get_softc(tdfx_devclass,
514 piod->device);
515
516 if(tdfx_info == NULL) return -ENXIO;
517
518 /* We must restrict the size reads from the port, since to high or low of a
519 * size witll result in wrong data being passed, and that's bad */
520 /* A few of these were pulled during the attach phase */
521 switch(piod->port) {
522 case PCI_VENDOR_ID_FREEBSD:
523 if(piod->size != 2) return -EINVAL;
524 copyout(&tdfx_info->vendor, piod->value, piod->size);
525 return 0;
526 case PCI_DEVICE_ID_FREEBSD:
527 if(piod->size != 2) return -EINVAL;
528 copyout(&tdfx_info->type, piod->value, piod->size);
529 return 0;
530 case PCI_BASE_ADDRESS_0_FREEBSD:
531 if(piod->size != 4) return -EINVAL;
532 copyout(&tdfx_info->addr0, piod->value, piod->size);
533 return 0;
534 case PCI_BASE_ADDRESS_1_FREEBSD:
535 if(piod->size != 4) return -EINVAL;
536 copyout(&tdfx_info->addr1, piod->value, piod->size);
537 return 0;
538 case PCI_PRIBUS_FREEBSD:
539 if(piod->size != 1) return -EINVAL;
540 break;
541 case PCI_IOBASE_0_FREEBSD:
542 if(piod->size != 2) return -EINVAL;
543 break;
544 case PCI_IOLIMIT_0_FREEBSD:
545 if(piod->size != 2) return -EINVAL;
546 break;
547 case SST1_PCI_SPECIAL1_FREEBSD:
548 if(piod->size != 4) return -EINVAL;
549 break;
550 case PCI_REVISION_ID_FREEBSD:
551 if(piod->size != 1) return -EINVAL;
552 break;
553 case SST1_PCI_SPECIAL4_FREEBSD:
554 if(piod->size != 4) return -EINVAL;
555 break;
556 default:
557 return -EINVAL;
558 }
559
560
561 /* Read the value and return */
562 switch(piod->size) {
563 case 1:
564 ret_byte = pci_read_config(tdfx_info[piod->device].dev,
565 piod->port, 1);
566 copyout(&ret_byte, piod->value, 1);
567 break;
568 case 2:
569 ret_word = pci_read_config(tdfx_info[piod->device].dev,
570 piod->port, 2);
571 copyout(&ret_word, piod->value, 2);
572 break;
573 case 4:
574 ret_dword = pci_read_config(tdfx_info[piod->device].dev,
575 piod->port, 4);
576 copyout(&ret_dword, piod->value, 4);
577 break;
578 default:
579 return -EINVAL;
580 }
581 return 0;
582 }
583
584 static int
585 tdfx_query_update(u_int cmd, struct tdfx_pio_data *piod)
586 {
587 /* XXX Comment this later, after careful inspection and spring cleaning :) */
588 /* Return vals */
589 u_int8_t ret_byte;
590 u_int16_t ret_word;
591 u_int32_t ret_dword;
592
593 /* Port vals, mask */
594 u_int32_t retval, preval, mask;
595 struct tdfx_softc* tdfx_info = NULL;
596
597
598 if((piod == NULL) || (piod->device >= (tdfx_count &
599 0xf))) {
600 #ifdef DEBUG
601 printf("tdfx: Bad struct or device in tdfx_query_update\n");
602 #endif
603 return -EINVAL;
604 }
605
606 tdfx_info = (struct tdfx_softc*)devclass_get_softc(tdfx_devclass,
607 piod->device);
608 if(tdfx_info == NULL) return -ENXIO;
609 /* Code below this line in the fuction was taken from the
610 * Linux driver and converted for freebsd. */
611
612 /* Check the size for all the ports, to make sure stuff doesn't get messed up
613 * by poorly written clients */
614
615 switch(piod->port) {
616 case PCI_COMMAND_FREEBSD:
617 if(piod->size != 2) return -EINVAL;
618 break;
619 case SST1_PCI_SPECIAL1_FREEBSD:
620 if(piod->size != 4) return -EINVAL;
621 break;
622 case SST1_PCI_SPECIAL2_FREEBSD:
623 if(piod->size != 4) return -EINVAL;
624 break;
625 case SST1_PCI_SPECIAL3_FREEBSD:
626 if(piod->size != 4) return -EINVAL;
627 break;
628 case SST1_PCI_SPECIAL4_FREEBSD:
629 if(piod->size != 4) return -EINVAL;
630 break;
631 default:
632 return -EINVAL;
633 }
634 /* Read the current value */
635 retval = pci_read_config(tdfx_info->dev, piod->port & ~3, 4);
636
637 /* These set up a mask to use, since apparently they wanted to write 4 bytes
638 * at once to the ports */
639 switch (piod->size) {
640 case 1:
641 copyin(piod->value, &ret_byte, 1);
642 preval = ret_byte << (8 * (piod->port & 0x3));
643 mask = 0xff << (8 * (piod->port & 0x3));
644 break;
645 case 2:
646 copyin(piod->value, &ret_word, 2);
647 preval = ret_word << (8 * (piod->port & 0x3));
648 mask = 0xffff << (8 * (piod->port & 0x3));
649 break;
650 case 4:
651 copyin(piod->value, &ret_dword, 4);
652 preval = ret_dword;
653 mask = ~0;
654 break;
655 default:
656 return -EINVAL;
657 }
658 /* Finally, combine the values and write it to the port */
659 retval = (retval & ~mask) | preval;
660 pci_write_config(tdfx_info->dev, piod->port & ~3, retval, 4);
661
662 return 0;
663 }
664
665 /* For both of these, I added a variable named workport of type u_int so
666 * that I could eliminate the warning about my data type size. The
667 * applications expect the port to be of type short, so I needed to change
668 * this within the function */
669 static int
670 tdfx_do_pio_rd(struct tdfx_pio_data *piod)
671 {
672 /* Return val */
673 u_int8_t ret_byte;
674 u_int workport;
675 struct tdfx_softc *tdfx_info =
676 (struct tdfx_softc*)devclass_get_softc(tdfx_devclass, piod->device);
677
678 /* Restricts the access of ports other than those we use */
679 if(((piod->port != VGA_INPUT_STATUS_1C) || (piod->port != SC_INDEX) ||
680 (piod->port != SC_DATA) || (piod->port != VGA_MISC_OUTPUT_READ)) &&
681 (piod->port < tdfx_info->pio0) && (piod->port > tdfx_info->pio0max))
682 return -EPERM;
683
684 /* All VGA STATUS REGS are byte registers, size should never be > 1 */
685 if(piod->size != 1) {
686 return -EINVAL;
687 }
688
689 /* Write the data to the intended port */
690 workport = piod->port;
691 ret_byte = inb(workport);
692 copyout(&ret_byte, piod->value, sizeof(u_int8_t));
693 return 0;
694 }
695
696 static int
697 tdfx_do_pio_wt(struct tdfx_pio_data *piod)
698 {
699 /* return val */
700 u_int8_t ret_byte;
701 u_int workport;
702 struct tdfx_softc *tdfx_info = (struct
703 tdfx_softc*)devclass_get_softc(tdfx_devclass, piod->device);
704 /* Replace old switch w/ massive if(...) */
705 /* Restricts the access of ports other than those we use */
706 if(((piod->port != SC_INDEX) && (piod->port != SC_DATA) &&
707 (piod->port != VGA_MISC_OUTPUT_READ)) /* Can't write VGA_ST_1C */ &&
708 (piod->port < tdfx_info->pio0) && (piod->port > tdfx_info->pio0max))
709 return -EPERM;
710
711 /* All VGA STATUS REGS are byte registers, size should never be > 1 */
712 if(piod->size != 1) {
713 return -EINVAL;
714 }
715
716 /* Write the data to the intended port */
717 copyin(piod->value, &ret_byte, sizeof(u_int8_t));
718 workport = piod->port;
719 outb(workport, ret_byte);
720 return 0;
721 }
722
723 static int
724 tdfx_do_query(u_int cmd, struct tdfx_pio_data *piod)
725 {
726 /* There are three sub-commands to the query 0x33 */
727 switch(_IOC_NR(cmd)) {
728 case 2:
729 return tdfx_query_boards();
730 break;
731 case 3:
732 return tdfx_query_fetch(cmd, piod);
733 break;
734 case 4:
735 return tdfx_query_update(cmd, piod);
736 break;
737 default:
738 /* In case we are thrown a bogus sub-command! */
739 #ifdef DEBUG
740 printf("Bad Sub-cmd: 0x%x\n", _IOC_NR(cmd));
741 #endif
742 return -EINVAL;
743 }
744 }
745
746 static int
747 tdfx_do_pio(u_int cmd, struct tdfx_pio_data *piod)
748 {
749 /* Two types of PIO, INPUT and OUTPUT, as the name suggests */
750 switch(_IOC_DIR(cmd)) {
751 case IOCV_OUT:
752 return tdfx_do_pio_rd(piod);
753 break;
754 case IOCV_IN:
755 return tdfx_do_pio_wt(piod);
756 break;
757 default:
758 return -EINVAL;
759 }
760 }
761
762 /* Calls to ioctl(2) eventually end up here. Unhandled ioctls return an ENXIO,
763 * normally, you would read in the data pointed to by data, then write your
764 * output to it. The ioctl *should* normally return zero if everything is
765 * alright, but 3dfx didn't make it that way...
766 *
767 * For all of the ioctl code, in the event of a real error,
768 * we return -Exxxx rather than simply Exxxx. The reason for this
769 * is that the ioctls actually RET information back to the program
770 * sometimes, rather than filling it in the passed structure. We
771 * want to distinguish errors from useful data, and maintain compatibility.
772 *
773 * There is this portion of the proc struct called p_retval[], we can store a
774 * return value in td->td_retval[0] and place the return value if it is positive
775 * in there, then we can return 0 (good). If the return value is negative, we
776 * can return -retval and the error should be properly handled.
777 */
778 static int
779 tdfx_ioctl(struct cdev *dev, u_long cmd, caddr_t data, int flag, struct thread *td)
780 {
781 int retval = 0;
782 struct tdfx_pio_data *piod = (struct tdfx_pio_data*)data;
783 #ifdef DEBUG
784 printf("IOCTL'd by #%d, cmd: 0x%x, data: %p\n", td->td_proc->p_pid, (u_int32_t)cmd,
785 piod);
786 #endif
787 switch(_IOC_TYPE(cmd)) {
788 /* Return the real error if negative, or simply stick the valid return
789 * in td->td_retval */
790 case 0x33:
791 /* The '3'(0x33) type IOCTL is for querying the installed cards */
792 if((retval = tdfx_do_query(cmd, piod)) > 0) td->td_retval[0] = retval;
793 else return -retval;
794 break;
795 case 0:
796 /* The 0 type IOCTL is for programmed I/O methods */
797 if((tdfx_do_pio(cmd, piod)) > 0) td->td_retval[0] = retval;
798 else return -retval;
799 break;
800 default:
801 /* Technically, we won't reach this from linux emu, but when glide
802 * finally gets ported, watch out! */
803 #ifdef DEBUG
804 printf("Bad IOCTL from #%d\n", td->td_proc->p_pid);
805 #endif
806 return ENXIO;
807 }
808
809 return 0;
810 }
811
812 /* This is the device driver struct. This is sent to the driver subsystem to
813 * register the method structure and the info strcut space for this particular
814 * instance of the driver.
815 */
816 static driver_t tdfx_driver = {
817 "tdfx",
818 tdfx_methods,
819 sizeof(struct tdfx_softc),
820 };
821
822 /* Tell Mr. Kernel about us! */
823 DRIVER_MODULE(tdfx, pci, tdfx_driver, tdfx_devclass, 0, 0);
824 MODULE_DEPEND(tdfx, mem, 1, 1, 1);
825 MODULE_VERSION(tdfx, 1);
Cache object: 1edf8688aa54b49dc6baafe6cd93e8b7
|