133 lines
3.1 KiB
C
133 lines
3.1 KiB
C
/*
|
|
* Enabler for PCCARD. Used for testing drivers etc.
|
|
* Options:
|
|
* enabler slot driver [ -m card addr size ] [ -i iobase ] [ -q irq ]
|
|
*/
|
|
#include <stdio.h>
|
|
#include <unistd.h>
|
|
#include <stdlib.h>
|
|
#include <string.h>
|
|
#include <fcntl.h>
|
|
#include <sys/ioctl.h>
|
|
|
|
#include <pccard/card.h>
|
|
#include <pccard/cis.h>
|
|
|
|
void usage();
|
|
|
|
int
|
|
enabler_main(argc, argv)
|
|
int argc;
|
|
char *argv[];
|
|
{
|
|
struct drv_desc drv;
|
|
struct mem_desc mem;
|
|
struct io_desc io;
|
|
int fd, slot, i, card_addr;
|
|
char name[32];
|
|
char *p;
|
|
|
|
bzero(&drv, sizeof(drv));
|
|
if (argc < 3)
|
|
usage("arg count");
|
|
slot = atoi(argv[1]);
|
|
if (slot < 0 || slot >= MAXSLOT)
|
|
usage("Illegal slot number");
|
|
p = argv[2];
|
|
while (*p && (*p < '0' || *p > '9'))
|
|
p++;
|
|
if (*p == 0)
|
|
usage("No unit on device name");
|
|
drv.unit = atoi(p);
|
|
*p = 0;
|
|
strcpy(drv.name, argv[2]);
|
|
argv += 3;
|
|
argc -= 3;
|
|
while (argc > 1) {
|
|
if (strcmp(argv[0], "-m") == 0) {
|
|
if (argc < 4)
|
|
usage("Memory argument error");
|
|
if (sscanf(argv[1], "%x", &card_addr) != 1)
|
|
usage("Bad card address");
|
|
if (sscanf(argv[2], "%lx", &drv.mem) != 1)
|
|
usage("Bad memory address");
|
|
if (sscanf(argv[3], "%d", &i) != 1)
|
|
usage("Bad memory size");
|
|
drv.memsize = i * 1024;
|
|
argc -= 2;
|
|
argv += 2;
|
|
} else if (strcmp(argv[0], "-f") == 0) {
|
|
if (sscanf(argv[1], "%x", &drv.flags) != 1)
|
|
usage("Bad driver flags");
|
|
} else if (strcmp(argv[0], "-a") == 0) {
|
|
if (sscanf(argv[1], "%x", &drv.iobase) != 1)
|
|
usage("Bad I/O address");
|
|
} else if (strcmp(argv[0], "-i") == 0) {
|
|
if (sscanf(argv[1], "%d", &i) != 1 || i < 1 || i > 15)
|
|
usage("Illegal IRQ");
|
|
drv.irqmask = 1 << i;
|
|
}
|
|
argc -= 2;
|
|
argv += 2;
|
|
}
|
|
if (argc)
|
|
usage("no parameter for argument");
|
|
printf("drv %s%d, mem 0x%lx, size %d, io %d, irq 0x%x, flags 0x%x\n",
|
|
drv.name, drv.unit, drv.mem, drv.memsize, drv.iobase,
|
|
drv.irqmask, drv.flags);
|
|
sprintf(name, "/dev/card%d", slot);
|
|
fd = open(name, 2);
|
|
if (fd < 0) {
|
|
perror(name);
|
|
exit(1);
|
|
}
|
|
|
|
/* Map the memory and I/O contexts. */
|
|
if (drv.mem) {
|
|
mem.window = 0;
|
|
mem.flags = MDF_ACTIVE | MDF_16BITS;
|
|
mem.start = (caddr_t)drv.mem;
|
|
mem.size = drv.memsize;
|
|
mem.card = card_addr;
|
|
if (ioctl(fd, PIOCSMEM, &mem)) {
|
|
perror("Set memory context");
|
|
exit(1);
|
|
}
|
|
}
|
|
if (drv.iobase) {
|
|
io.window = 0;
|
|
io.flags = IODF_ACTIVE | IODF_CS16;
|
|
io.start = drv.iobase;
|
|
io.size = 32; /* Blah... */
|
|
if (ioctl(fd, PIOCSIO, &io)) {
|
|
perror("Set I/O context");
|
|
exit(1);
|
|
}
|
|
}
|
|
if (ioctl(fd, PIOCSDRV, &drv))
|
|
perror("set driver");
|
|
close(fd);
|
|
return 0;
|
|
}
|
|
|
|
/*
|
|
* usage - print usage and exit
|
|
*/
|
|
void
|
|
usage(msg)
|
|
char *msg;
|
|
{
|
|
fprintf(stderr, "enabler: %s\n", msg);
|
|
fprintf(stderr,
|
|
"Usage: enabler slot driver [ -m addr size ] [ -a iobase ] [ -i irq ]\n");
|
|
fprintf(stderr,
|
|
" -m card addr size : Card address (hex), host address (hex) & size (Kb)\n");
|
|
fprintf(stderr,
|
|
" -a iobase : I/O port address (hex)\n");
|
|
fprintf(stderr,
|
|
" -i irq : Interrupt request number (1-15)\n");
|
|
fprintf(stderr,
|
|
" Example: enabler 0 ed0 -m 2000 d4000 16 -a 300 -i 3\n");
|
|
exit(1);
|
|
}
|