1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
|
/*
* 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);
}
|
