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
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292
293
294
295
296
297
|
/*
comedi/drivers/icp_multi.h
Stuff for ICP Multi
Author: Anne Smorthit <anne.smorthit@sfwte.ch>
*/
#ifndef _ICP_MULTI_H_
#define _ICP_MULTI_H_
#include "../comedidev.h"
/****************************************************************************/
struct pcilst_struct {
struct pcilst_struct *next;
int used;
struct pci_dev *pcidev;
unsigned short vendor;
unsigned short device;
unsigned char pci_bus;
unsigned char pci_slot;
unsigned char pci_func;
resource_size_t io_addr[5];
unsigned int irq;
};
struct pcilst_struct *inova_devices;
/* ptr to root list of all Inova devices */
/****************************************************************************/
static void pci_card_list_init(unsigned short pci_vendor, char display);
static void pci_card_list_cleanup(unsigned short pci_vendor);
static struct pcilst_struct *find_free_pci_card_by_device(unsigned short
vendor_id,
unsigned short
device_id);
static int find_free_pci_card_by_position(unsigned short vendor_id,
unsigned short device_id,
unsigned short pci_bus,
unsigned short pci_slot,
struct pcilst_struct **card);
static struct pcilst_struct *select_and_alloc_pci_card(unsigned short vendor_id,
unsigned short device_id,
unsigned short pci_bus,
unsigned short pci_slot);
static int pci_card_alloc(struct pcilst_struct *amcc);
static int pci_card_free(struct pcilst_struct *amcc);
static void pci_card_list_display(void);
static int pci_card_data(struct pcilst_struct *amcc,
unsigned char *pci_bus, unsigned char *pci_slot,
unsigned char *pci_func, resource_size_t * io_addr,
unsigned int *irq);
/****************************************************************************/
/* build list of Inova cards in this system */
static void pci_card_list_init(unsigned short pci_vendor, char display)
{
struct pci_dev *pcidev = NULL;
struct pcilst_struct *inova, *last;
int i;
inova_devices = NULL;
last = NULL;
for_each_pci_dev(pcidev) {
if (pcidev->vendor == pci_vendor) {
inova = kzalloc(sizeof(*inova), GFP_KERNEL);
if (!inova) {
printk
("icp_multi: pci_card_list_init: allocation failed\n");
pci_dev_put(pcidev);
break;
}
inova->pcidev = pci_dev_get(pcidev);
if (last) {
last->next = inova;
} else {
inova_devices = inova;
}
last = inova;
inova->vendor = pcidev->vendor;
inova->device = pcidev->device;
inova->pci_bus = pcidev->bus->number;
inova->pci_slot = PCI_SLOT(pcidev->devfn);
inova->pci_func = PCI_FUNC(pcidev->devfn);
/* Note: resources may be invalid if PCI device
* not enabled, but they are corrected in
* pci_card_alloc. */
for (i = 0; i < 5; i++)
inova->io_addr[i] =
pci_resource_start(pcidev, i);
inova->irq = pcidev->irq;
}
}
if (display)
pci_card_list_display();
}
/****************************************************************************/
/* free up list of amcc cards in this system */
static void pci_card_list_cleanup(unsigned short pci_vendor)
{
struct pcilst_struct *inova, *next;
for (inova = inova_devices; inova; inova = next) {
next = inova->next;
pci_dev_put(inova->pcidev);
kfree(inova);
}
inova_devices = NULL;
}
/****************************************************************************/
/* find first unused card with this device_id */
static struct pcilst_struct *find_free_pci_card_by_device(unsigned short
vendor_id,
unsigned short
device_id)
{
struct pcilst_struct *inova, *next;
for (inova = inova_devices; inova; inova = next) {
next = inova->next;
if ((!inova->used) && (inova->device == device_id)
&& (inova->vendor == vendor_id))
return inova;
}
return NULL;
}
/****************************************************************************/
/* find card on requested position */
static int find_free_pci_card_by_position(unsigned short vendor_id,
unsigned short device_id,
unsigned short pci_bus,
unsigned short pci_slot,
struct pcilst_struct **card)
{
struct pcilst_struct *inova, *next;
*card = NULL;
for (inova = inova_devices; inova; inova = next) {
next = inova->next;
if ((inova->vendor == vendor_id) && (inova->device == device_id)
&& (inova->pci_bus == pci_bus)
&& (inova->pci_slot == pci_slot)) {
if (!(inova->used)) {
*card = inova;
return 0; /* ok, card is found */
} else {
return 2; /* card exist but is used */
}
}
}
return 1; /* no card found */
}
/****************************************************************************/
/* mark card as used */
static int pci_card_alloc(struct pcilst_struct *inova)
{
int i;
if (!inova) {
printk(" - BUG!! inova is NULL!\n");
return -1;
}
if (inova->used)
return 1;
if (comedi_pci_enable(inova->pcidev, "icp_multi")) {
printk(" - Can't enable PCI device and request regions!\n");
return -1;
}
/* Resources will be accurate now. */
for (i = 0; i < 5; i++)
inova->io_addr[i] = pci_resource_start(inova->pcidev, i);
inova->irq = inova->pcidev->irq;
inova->used = 1;
return 0;
}
/****************************************************************************/
/* mark card as free */
static int pci_card_free(struct pcilst_struct *inova)
{
if (!inova)
return -1;
if (!inova->used)
return 1;
inova->used = 0;
comedi_pci_disable(inova->pcidev);
return 0;
}
/****************************************************************************/
/* display list of found cards */
static void pci_card_list_display(void)
{
struct pcilst_struct *inova, *next;
printk("Anne's List of pci cards\n");
printk("bus:slot:func vendor device io_inova io_daq irq used\n");
for (inova = inova_devices; inova; inova = next) {
next = inova->next;
printk
("%2d %2d %2d 0x%4x 0x%4x 0x%8llx 0x%8llx %2u %2d\n",
inova->pci_bus, inova->pci_slot, inova->pci_func,
inova->vendor, inova->device,
(unsigned long long)inova->io_addr[0],
(unsigned long long)inova->io_addr[2], inova->irq,
inova->used);
}
}
/****************************************************************************/
/* return all card information for driver */
static int pci_card_data(struct pcilst_struct *inova,
unsigned char *pci_bus, unsigned char *pci_slot,
unsigned char *pci_func, resource_size_t * io_addr,
unsigned int *irq)
{
int i;
if (!inova)
return -1;
*pci_bus = inova->pci_bus;
*pci_slot = inova->pci_slot;
*pci_func = inova->pci_func;
for (i = 0; i < 5; i++)
io_addr[i] = inova->io_addr[i];
*irq = inova->irq;
return 0;
}
/****************************************************************************/
/* select and alloc card */
static struct pcilst_struct *select_and_alloc_pci_card(unsigned short vendor_id,
unsigned short device_id,
unsigned short pci_bus,
unsigned short pci_slot)
{
struct pcilst_struct *card;
int err;
if ((pci_bus < 1) & (pci_slot < 1)) { /* use autodetection */
card = find_free_pci_card_by_device(vendor_id, device_id);
if (card == NULL) {
printk(" - Unused card not found in system!\n");
return NULL;
}
} else {
switch (find_free_pci_card_by_position(vendor_id, device_id,
pci_bus, pci_slot,
&card)) {
case 1:
printk
(" - Card not found on requested position b:s %d:%d!\n",
pci_bus, pci_slot);
return NULL;
case 2:
printk
(" - Card on requested position is used b:s %d:%d!\n",
pci_bus, pci_slot);
return NULL;
}
}
err = pci_card_alloc(card);
if (err != 0) {
if (err > 0)
printk(" - Can't allocate card!\n");
/* else: error already printed. */
return NULL;
}
return card;
}
#endif
|
