Commit | Line | Data |
---|---|---|
1da177e4 LT |
1 | /* |
2 | * Compaq Hot Plug Controller Driver | |
3 | * | |
4 | * Copyright (C) 1995,2001 Compaq Computer Corporation | |
5 | * Copyright (C) 2001 Greg Kroah-Hartman (greg@kroah.com) | |
6 | * Copyright (C) 2001 IBM Corp. | |
7 | * | |
8 | * All rights reserved. | |
9 | * | |
10 | * This program is free software; you can redistribute it and/or modify | |
11 | * it under the terms of the GNU General Public License as published by | |
12 | * the Free Software Foundation; either version 2 of the License, or (at | |
13 | * your option) any later version. | |
14 | * | |
15 | * This program is distributed in the hope that it will be useful, but | |
16 | * WITHOUT ANY WARRANTY; without even the implied warranty of | |
17 | * MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE, GOOD TITLE or | |
18 | * NON INFRINGEMENT. See the GNU General Public License for more | |
19 | * details. | |
20 | * | |
21 | * You should have received a copy of the GNU General Public License | |
22 | * along with this program; if not, write to the Free Software | |
23 | * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. | |
24 | * | |
25 | * Send feedback to <greg@kroah.com> | |
26 | * | |
27 | */ | |
28 | ||
1da177e4 LT |
29 | #include <linux/module.h> |
30 | #include <linux/kernel.h> | |
31 | #include <linux/types.h> | |
32 | #include <linux/proc_fs.h> | |
33 | #include <linux/slab.h> | |
34 | #include <linux/workqueue.h> | |
35 | #include <linux/pci.h> | |
7a54f25c | 36 | #include <linux/pci_hotplug.h> |
1da177e4 LT |
37 | #include <asm/uaccess.h> |
38 | #include "cpqphp.h" | |
39 | #include "cpqphp_nvram.h" | |
40 | ||
41 | ||
42 | #define ROM_INT15_PHY_ADDR 0x0FF859 | |
43 | #define READ_EV 0xD8A4 | |
44 | #define WRITE_EV 0xD8A5 | |
45 | ||
46 | struct register_foo { | |
47 | union { | |
48 | unsigned long lword; /* eax */ | |
49 | unsigned short word; /* ax */ | |
50 | ||
51 | struct { | |
52 | unsigned char low; /* al */ | |
53 | unsigned char high; /* ah */ | |
54 | } byte; | |
55 | } data; | |
56 | ||
57 | unsigned char opcode; /* see below */ | |
58 | unsigned long length; /* if the reg. is a pointer, how much data */ | |
59 | } __attribute__ ((packed)); | |
60 | ||
61 | struct all_reg { | |
62 | struct register_foo eax_reg; | |
63 | struct register_foo ebx_reg; | |
64 | struct register_foo ecx_reg; | |
65 | struct register_foo edx_reg; | |
66 | struct register_foo edi_reg; | |
67 | struct register_foo esi_reg; | |
68 | struct register_foo eflags_reg; | |
69 | } __attribute__ ((packed)); | |
70 | ||
71 | ||
72 | struct ev_hrt_header { | |
73 | u8 Version; | |
74 | u8 num_of_ctrl; | |
75 | u8 next; | |
76 | }; | |
77 | ||
78 | struct ev_hrt_ctrl { | |
79 | u8 bus; | |
80 | u8 device; | |
81 | u8 function; | |
82 | u8 mem_avail; | |
83 | u8 p_mem_avail; | |
84 | u8 io_avail; | |
85 | u8 bus_avail; | |
86 | u8 next; | |
87 | }; | |
88 | ||
89 | ||
90 | static u8 evbuffer_init; | |
91 | static u8 evbuffer_length; | |
92 | static u8 evbuffer[1024]; | |
93 | ||
94 | static void __iomem *compaq_int15_entry_point; | |
95 | ||
427438c6 AC |
96 | /* lock for ordering int15_bios_call() */ |
97 | static spinlock_t int15_lock; | |
1da177e4 LT |
98 | |
99 | ||
100 | /* This is a series of function that deals with | |
427438c6 AC |
101 | * setting & getting the hotplug resource table in some environment variable. |
102 | */ | |
1da177e4 LT |
103 | |
104 | /* | |
105 | * We really shouldn't be doing this unless there is a _very_ good reason to!!! | |
106 | * greg k-h | |
107 | */ | |
108 | ||
109 | ||
3c78bc61 | 110 | static u32 add_byte(u32 **p_buffer, u8 value, u32 *used, u32 *avail) |
1da177e4 LT |
111 | { |
112 | u8 **tByte; | |
113 | ||
114 | if ((*used + 1) > *avail) | |
115 | return(1); | |
861fefbf | 116 | |
ff3ce480 BS |
117 | *((u8 *)*p_buffer) = value; |
118 | tByte = (u8 **)p_buffer; | |
1da177e4 | 119 | (*tByte)++; |
ff3ce480 | 120 | *used += 1; |
1da177e4 LT |
121 | return(0); |
122 | } | |
123 | ||
124 | ||
3c78bc61 | 125 | static u32 add_dword(u32 **p_buffer, u32 value, u32 *used, u32 *avail) |
1da177e4 LT |
126 | { |
127 | if ((*used + 4) > *avail) | |
128 | return(1); | |
129 | ||
130 | **p_buffer = value; | |
131 | (*p_buffer)++; | |
ff3ce480 | 132 | *used += 4; |
1da177e4 LT |
133 | return(0); |
134 | } | |
135 | ||
136 | ||
137 | /* | |
138 | * check_for_compaq_ROM | |
139 | * | |
140 | * this routine verifies that the ROM OEM string is 'COMPAQ' | |
141 | * | |
142 | * returns 0 for non-Compaq ROM, 1 for Compaq ROM | |
143 | */ | |
ff3ce480 | 144 | static int check_for_compaq_ROM(void __iomem *rom_start) |
1da177e4 LT |
145 | { |
146 | u8 temp1, temp2, temp3, temp4, temp5, temp6; | |
147 | int result = 0; | |
148 | ||
149 | temp1 = readb(rom_start + 0xffea + 0); | |
150 | temp2 = readb(rom_start + 0xffea + 1); | |
151 | temp3 = readb(rom_start + 0xffea + 2); | |
152 | temp4 = readb(rom_start + 0xffea + 3); | |
153 | temp5 = readb(rom_start + 0xffea + 4); | |
154 | temp6 = readb(rom_start + 0xffea + 5); | |
155 | if ((temp1 == 'C') && | |
156 | (temp2 == 'O') && | |
157 | (temp3 == 'M') && | |
158 | (temp4 == 'P') && | |
159 | (temp5 == 'A') && | |
160 | (temp6 == 'Q')) { | |
161 | result = 1; | |
162 | } | |
ff3ce480 | 163 | dbg("%s - returned %d\n", __func__, result); |
1da177e4 LT |
164 | return result; |
165 | } | |
166 | ||
167 | ||
ff3ce480 | 168 | static u32 access_EV(u16 operation, u8 *ev_name, u8 *buffer, u32 *buf_size) |
1da177e4 LT |
169 | { |
170 | unsigned long flags; | |
171 | int op = operation; | |
172 | int ret_val; | |
861fefbf | 173 | |
1da177e4 LT |
174 | if (!compaq_int15_entry_point) |
175 | return -ENODEV; | |
861fefbf | 176 | |
1da177e4 LT |
177 | spin_lock_irqsave(&int15_lock, flags); |
178 | __asm__ ( | |
179 | "xorl %%ebx,%%ebx\n" \ | |
180 | "xorl %%edx,%%edx\n" \ | |
181 | "pushf\n" \ | |
182 | "push %%cs\n" \ | |
183 | "cli\n" \ | |
184 | "call *%6\n" | |
185 | : "=c" (*buf_size), "=a" (ret_val) | |
186 | : "a" (op), "c" (*buf_size), "S" (ev_name), | |
187 | "D" (buffer), "m" (compaq_int15_entry_point) | |
188 | : "%ebx", "%edx"); | |
189 | spin_unlock_irqrestore(&int15_lock, flags); | |
861fefbf | 190 | |
1da177e4 LT |
191 | return((ret_val & 0xFF00) >> 8); |
192 | } | |
193 | ||
194 | ||
195 | /* | |
196 | * load_HRT | |
197 | * | |
198 | * Read the hot plug Resource Table from NVRAM | |
199 | */ | |
ff3ce480 | 200 | static int load_HRT(void __iomem *rom_start) |
1da177e4 LT |
201 | { |
202 | u32 available; | |
203 | u32 temp_dword; | |
204 | u8 temp_byte = 0xFF; | |
205 | u32 rc; | |
206 | ||
656f978f | 207 | if (!check_for_compaq_ROM(rom_start)) |
1da177e4 | 208 | return -ENODEV; |
1da177e4 LT |
209 | |
210 | available = 1024; | |
211 | ||
427438c6 | 212 | /* Now load the EV */ |
1da177e4 LT |
213 | temp_dword = available; |
214 | ||
215 | rc = access_EV(READ_EV, "CQTHPS", evbuffer, &temp_dword); | |
216 | ||
217 | evbuffer_length = temp_dword; | |
218 | ||
427438c6 AC |
219 | /* We're maintaining the resource lists so write FF to invalidate old |
220 | * info | |
221 | */ | |
1da177e4 LT |
222 | temp_dword = 1; |
223 | ||
224 | rc = access_EV(WRITE_EV, "CQTHPS", &temp_byte, &temp_dword); | |
225 | ||
226 | return rc; | |
227 | } | |
228 | ||
229 | ||
230 | /* | |
231 | * store_HRT | |
232 | * | |
233 | * Save the hot plug Resource Table in NVRAM | |
234 | */ | |
ff3ce480 | 235 | static u32 store_HRT(void __iomem *rom_start) |
1da177e4 LT |
236 | { |
237 | u32 *buffer; | |
238 | u32 *pFill; | |
239 | u32 usedbytes; | |
240 | u32 available; | |
241 | u32 temp_dword; | |
242 | u32 rc; | |
243 | u8 loop; | |
244 | u8 numCtrl = 0; | |
245 | struct controller *ctrl; | |
246 | struct pci_resource *resNode; | |
247 | struct ev_hrt_header *p_EV_header; | |
248 | struct ev_hrt_ctrl *p_ev_ctrl; | |
249 | ||
250 | available = 1024; | |
251 | ||
656f978f | 252 | if (!check_for_compaq_ROM(rom_start)) |
1da177e4 | 253 | return(1); |
1da177e4 | 254 | |
ff3ce480 | 255 | buffer = (u32 *) evbuffer; |
1da177e4 LT |
256 | |
257 | if (!buffer) | |
258 | return(1); | |
259 | ||
260 | pFill = buffer; | |
261 | usedbytes = 0; | |
262 | ||
263 | p_EV_header = (struct ev_hrt_header *) pFill; | |
264 | ||
265 | ctrl = cpqhp_ctrl_list; | |
861fefbf | 266 | |
427438c6 | 267 | /* The revision of this structure */ |
3c78bc61 | 268 | rc = add_byte(&pFill, 1 + ctrl->push_flag, &usedbytes, &available); |
1da177e4 LT |
269 | if (rc) |
270 | return(rc); | |
271 | ||
427438c6 | 272 | /* The number of controllers */ |
3c78bc61 | 273 | rc = add_byte(&pFill, 1, &usedbytes, &available); |
1da177e4 LT |
274 | if (rc) |
275 | return(rc); | |
276 | ||
277 | while (ctrl) { | |
278 | p_ev_ctrl = (struct ev_hrt_ctrl *) pFill; | |
279 | ||
280 | numCtrl++; | |
281 | ||
427438c6 | 282 | /* The bus number */ |
3c78bc61 | 283 | rc = add_byte(&pFill, ctrl->bus, &usedbytes, &available); |
1da177e4 LT |
284 | if (rc) |
285 | return(rc); | |
286 | ||
427438c6 | 287 | /* The device Number */ |
3c78bc61 | 288 | rc = add_byte(&pFill, PCI_SLOT(ctrl->pci_dev->devfn), &usedbytes, &available); |
1da177e4 LT |
289 | if (rc) |
290 | return(rc); | |
291 | ||
427438c6 | 292 | /* The function Number */ |
3c78bc61 | 293 | rc = add_byte(&pFill, PCI_FUNC(ctrl->pci_dev->devfn), &usedbytes, &available); |
1da177e4 LT |
294 | if (rc) |
295 | return(rc); | |
296 | ||
427438c6 | 297 | /* Skip the number of available entries */ |
3c78bc61 | 298 | rc = add_dword(&pFill, 0, &usedbytes, &available); |
1da177e4 LT |
299 | if (rc) |
300 | return(rc); | |
301 | ||
427438c6 | 302 | /* Figure out memory Available */ |
1da177e4 LT |
303 | |
304 | resNode = ctrl->mem_head; | |
305 | ||
306 | loop = 0; | |
307 | ||
308 | while (resNode) { | |
ff3ce480 | 309 | loop++; |
1da177e4 | 310 | |
427438c6 | 311 | /* base */ |
3c78bc61 | 312 | rc = add_dword(&pFill, resNode->base, &usedbytes, &available); |
1da177e4 LT |
313 | if (rc) |
314 | return(rc); | |
315 | ||
427438c6 | 316 | /* length */ |
3c78bc61 | 317 | rc = add_dword(&pFill, resNode->length, &usedbytes, &available); |
1da177e4 LT |
318 | if (rc) |
319 | return(rc); | |
320 | ||
321 | resNode = resNode->next; | |
322 | } | |
323 | ||
427438c6 | 324 | /* Fill in the number of entries */ |
1da177e4 LT |
325 | p_ev_ctrl->mem_avail = loop; |
326 | ||
427438c6 | 327 | /* Figure out prefetchable memory Available */ |
1da177e4 LT |
328 | |
329 | resNode = ctrl->p_mem_head; | |
330 | ||
331 | loop = 0; | |
332 | ||
333 | while (resNode) { | |
ff3ce480 | 334 | loop++; |
1da177e4 | 335 | |
427438c6 | 336 | /* base */ |
3c78bc61 | 337 | rc = add_dword(&pFill, resNode->base, &usedbytes, &available); |
1da177e4 LT |
338 | if (rc) |
339 | return(rc); | |
340 | ||
427438c6 | 341 | /* length */ |
3c78bc61 | 342 | rc = add_dword(&pFill, resNode->length, &usedbytes, &available); |
1da177e4 LT |
343 | if (rc) |
344 | return(rc); | |
345 | ||
346 | resNode = resNode->next; | |
347 | } | |
348 | ||
427438c6 | 349 | /* Fill in the number of entries */ |
1da177e4 LT |
350 | p_ev_ctrl->p_mem_avail = loop; |
351 | ||
427438c6 | 352 | /* Figure out IO Available */ |
1da177e4 LT |
353 | |
354 | resNode = ctrl->io_head; | |
355 | ||
356 | loop = 0; | |
357 | ||
358 | while (resNode) { | |
ff3ce480 | 359 | loop++; |
1da177e4 | 360 | |
427438c6 | 361 | /* base */ |
3c78bc61 | 362 | rc = add_dword(&pFill, resNode->base, &usedbytes, &available); |
1da177e4 LT |
363 | if (rc) |
364 | return(rc); | |
365 | ||
427438c6 | 366 | /* length */ |
3c78bc61 | 367 | rc = add_dword(&pFill, resNode->length, &usedbytes, &available); |
1da177e4 LT |
368 | if (rc) |
369 | return(rc); | |
370 | ||
371 | resNode = resNode->next; | |
372 | } | |
373 | ||
427438c6 | 374 | /* Fill in the number of entries */ |
1da177e4 LT |
375 | p_ev_ctrl->io_avail = loop; |
376 | ||
427438c6 | 377 | /* Figure out bus Available */ |
1da177e4 LT |
378 | |
379 | resNode = ctrl->bus_head; | |
380 | ||
381 | loop = 0; | |
382 | ||
383 | while (resNode) { | |
ff3ce480 | 384 | loop++; |
1da177e4 | 385 | |
427438c6 | 386 | /* base */ |
3c78bc61 | 387 | rc = add_dword(&pFill, resNode->base, &usedbytes, &available); |
1da177e4 LT |
388 | if (rc) |
389 | return(rc); | |
390 | ||
427438c6 | 391 | /* length */ |
3c78bc61 | 392 | rc = add_dword(&pFill, resNode->length, &usedbytes, &available); |
1da177e4 LT |
393 | if (rc) |
394 | return(rc); | |
395 | ||
396 | resNode = resNode->next; | |
397 | } | |
398 | ||
427438c6 | 399 | /* Fill in the number of entries */ |
1da177e4 LT |
400 | p_ev_ctrl->bus_avail = loop; |
401 | ||
402 | ctrl = ctrl->next; | |
403 | } | |
861fefbf | 404 | |
1da177e4 LT |
405 | p_EV_header->num_of_ctrl = numCtrl; |
406 | ||
427438c6 | 407 | /* Now store the EV */ |
1da177e4 LT |
408 | |
409 | temp_dword = usedbytes; | |
410 | ||
ff3ce480 | 411 | rc = access_EV(WRITE_EV, "CQTHPS", (u8 *) buffer, &temp_dword); |
1da177e4 LT |
412 | |
413 | dbg("usedbytes = 0x%x, length = 0x%x\n", usedbytes, temp_dword); | |
414 | ||
415 | evbuffer_length = temp_dword; | |
416 | ||
417 | if (rc) { | |
418 | err(msg_unable_to_save); | |
419 | return(1); | |
420 | } | |
421 | ||
422 | return(0); | |
423 | } | |
424 | ||
425 | ||
ff3ce480 | 426 | void compaq_nvram_init(void __iomem *rom_start) |
1da177e4 | 427 | { |
656f978f | 428 | if (rom_start) |
1da177e4 | 429 | compaq_int15_entry_point = (rom_start + ROM_INT15_PHY_ADDR - ROM_PHY_ADDR); |
656f978f | 430 | |
1da177e4 LT |
431 | dbg("int15 entry = %p\n", compaq_int15_entry_point); |
432 | ||
433 | /* initialize our int15 lock */ | |
434 | spin_lock_init(&int15_lock); | |
435 | } | |
436 | ||
437 | ||
ff3ce480 | 438 | int compaq_nvram_load(void __iomem *rom_start, struct controller *ctrl) |
1da177e4 LT |
439 | { |
440 | u8 bus, device, function; | |
441 | u8 nummem, numpmem, numio, numbus; | |
442 | u32 rc; | |
443 | u8 *p_byte; | |
444 | struct pci_resource *mem_node; | |
445 | struct pci_resource *p_mem_node; | |
446 | struct pci_resource *io_node; | |
447 | struct pci_resource *bus_node; | |
448 | struct ev_hrt_ctrl *p_ev_ctrl; | |
449 | struct ev_hrt_header *p_EV_header; | |
450 | ||
451 | if (!evbuffer_init) { | |
427438c6 | 452 | /* Read the resource list information in from NVRAM */ |
1da177e4 | 453 | if (load_HRT(rom_start)) |
ff3ce480 | 454 | memset(evbuffer, 0, 1024); |
1da177e4 LT |
455 | |
456 | evbuffer_init = 1; | |
457 | } | |
458 | ||
427438c6 | 459 | /* If we saved information in NVRAM, use it now */ |
1da177e4 LT |
460 | p_EV_header = (struct ev_hrt_header *) evbuffer; |
461 | ||
427438c6 AC |
462 | /* The following code is for systems where version 1.0 of this |
463 | * driver has been loaded, but doesn't support the hardware. | |
464 | * In that case, the driver would incorrectly store something | |
465 | * in NVRAM. | |
466 | */ | |
1da177e4 LT |
467 | if ((p_EV_header->Version == 2) || |
468 | ((p_EV_header->Version == 1) && !ctrl->push_flag)) { | |
469 | p_byte = &(p_EV_header->next); | |
470 | ||
471 | p_ev_ctrl = (struct ev_hrt_ctrl *) &(p_EV_header->next); | |
472 | ||
473 | p_byte += 3; | |
474 | ||
ff3ce480 | 475 | if (p_byte > ((u8 *)p_EV_header + evbuffer_length)) |
1da177e4 LT |
476 | return 2; |
477 | ||
478 | bus = p_ev_ctrl->bus; | |
479 | device = p_ev_ctrl->device; | |
480 | function = p_ev_ctrl->function; | |
481 | ||
482 | while ((bus != ctrl->bus) || | |
861fefbf | 483 | (device != PCI_SLOT(ctrl->pci_dev->devfn)) || |
1da177e4 LT |
484 | (function != PCI_FUNC(ctrl->pci_dev->devfn))) { |
485 | nummem = p_ev_ctrl->mem_avail; | |
486 | numpmem = p_ev_ctrl->p_mem_avail; | |
487 | numio = p_ev_ctrl->io_avail; | |
488 | numbus = p_ev_ctrl->bus_avail; | |
489 | ||
490 | p_byte += 4; | |
491 | ||
ff3ce480 | 492 | if (p_byte > ((u8 *)p_EV_header + evbuffer_length)) |
1da177e4 LT |
493 | return 2; |
494 | ||
427438c6 | 495 | /* Skip forward to the next entry */ |
1da177e4 LT |
496 | p_byte += (nummem + numpmem + numio + numbus) * 8; |
497 | ||
ff3ce480 | 498 | if (p_byte > ((u8 *)p_EV_header + evbuffer_length)) |
1da177e4 LT |
499 | return 2; |
500 | ||
501 | p_ev_ctrl = (struct ev_hrt_ctrl *) p_byte; | |
502 | ||
503 | p_byte += 3; | |
504 | ||
ff3ce480 | 505 | if (p_byte > ((u8 *)p_EV_header + evbuffer_length)) |
1da177e4 LT |
506 | return 2; |
507 | ||
508 | bus = p_ev_ctrl->bus; | |
509 | device = p_ev_ctrl->device; | |
510 | function = p_ev_ctrl->function; | |
511 | } | |
512 | ||
513 | nummem = p_ev_ctrl->mem_avail; | |
514 | numpmem = p_ev_ctrl->p_mem_avail; | |
515 | numio = p_ev_ctrl->io_avail; | |
516 | numbus = p_ev_ctrl->bus_avail; | |
517 | ||
518 | p_byte += 4; | |
519 | ||
ff3ce480 | 520 | if (p_byte > ((u8 *)p_EV_header + evbuffer_length)) |
1da177e4 LT |
521 | return 2; |
522 | ||
523 | while (nummem--) { | |
5cbded58 | 524 | mem_node = kmalloc(sizeof(struct pci_resource), GFP_KERNEL); |
1da177e4 LT |
525 | |
526 | if (!mem_node) | |
527 | break; | |
528 | ||
ff3ce480 BS |
529 | mem_node->base = *(u32 *)p_byte; |
530 | dbg("mem base = %8.8x\n", mem_node->base); | |
1da177e4 LT |
531 | p_byte += 4; |
532 | ||
ff3ce480 | 533 | if (p_byte > ((u8 *)p_EV_header + evbuffer_length)) { |
1da177e4 LT |
534 | kfree(mem_node); |
535 | return 2; | |
536 | } | |
537 | ||
ff3ce480 BS |
538 | mem_node->length = *(u32 *)p_byte; |
539 | dbg("mem length = %8.8x\n", mem_node->length); | |
1da177e4 LT |
540 | p_byte += 4; |
541 | ||
ff3ce480 | 542 | if (p_byte > ((u8 *)p_EV_header + evbuffer_length)) { |
1da177e4 LT |
543 | kfree(mem_node); |
544 | return 2; | |
545 | } | |
546 | ||
547 | mem_node->next = ctrl->mem_head; | |
548 | ctrl->mem_head = mem_node; | |
549 | } | |
550 | ||
551 | while (numpmem--) { | |
5cbded58 | 552 | p_mem_node = kmalloc(sizeof(struct pci_resource), GFP_KERNEL); |
1da177e4 LT |
553 | |
554 | if (!p_mem_node) | |
555 | break; | |
556 | ||
ff3ce480 BS |
557 | p_mem_node->base = *(u32 *)p_byte; |
558 | dbg("pre-mem base = %8.8x\n", p_mem_node->base); | |
1da177e4 LT |
559 | p_byte += 4; |
560 | ||
ff3ce480 | 561 | if (p_byte > ((u8 *)p_EV_header + evbuffer_length)) { |
1da177e4 LT |
562 | kfree(p_mem_node); |
563 | return 2; | |
564 | } | |
565 | ||
ff3ce480 BS |
566 | p_mem_node->length = *(u32 *)p_byte; |
567 | dbg("pre-mem length = %8.8x\n", p_mem_node->length); | |
1da177e4 LT |
568 | p_byte += 4; |
569 | ||
ff3ce480 | 570 | if (p_byte > ((u8 *)p_EV_header + evbuffer_length)) { |
1da177e4 LT |
571 | kfree(p_mem_node); |
572 | return 2; | |
573 | } | |
574 | ||
575 | p_mem_node->next = ctrl->p_mem_head; | |
576 | ctrl->p_mem_head = p_mem_node; | |
577 | } | |
578 | ||
579 | while (numio--) { | |
5cbded58 | 580 | io_node = kmalloc(sizeof(struct pci_resource), GFP_KERNEL); |
1da177e4 LT |
581 | |
582 | if (!io_node) | |
583 | break; | |
584 | ||
ff3ce480 BS |
585 | io_node->base = *(u32 *)p_byte; |
586 | dbg("io base = %8.8x\n", io_node->base); | |
1da177e4 LT |
587 | p_byte += 4; |
588 | ||
ff3ce480 | 589 | if (p_byte > ((u8 *)p_EV_header + evbuffer_length)) { |
1da177e4 LT |
590 | kfree(io_node); |
591 | return 2; | |
592 | } | |
593 | ||
ff3ce480 BS |
594 | io_node->length = *(u32 *)p_byte; |
595 | dbg("io length = %8.8x\n", io_node->length); | |
1da177e4 LT |
596 | p_byte += 4; |
597 | ||
ff3ce480 | 598 | if (p_byte > ((u8 *)p_EV_header + evbuffer_length)) { |
1da177e4 LT |
599 | kfree(io_node); |
600 | return 2; | |
601 | } | |
602 | ||
603 | io_node->next = ctrl->io_head; | |
604 | ctrl->io_head = io_node; | |
605 | } | |
606 | ||
607 | while (numbus--) { | |
5cbded58 | 608 | bus_node = kmalloc(sizeof(struct pci_resource), GFP_KERNEL); |
1da177e4 LT |
609 | |
610 | if (!bus_node) | |
611 | break; | |
612 | ||
ff3ce480 | 613 | bus_node->base = *(u32 *)p_byte; |
1da177e4 LT |
614 | p_byte += 4; |
615 | ||
ff3ce480 | 616 | if (p_byte > ((u8 *)p_EV_header + evbuffer_length)) { |
1da177e4 LT |
617 | kfree(bus_node); |
618 | return 2; | |
619 | } | |
620 | ||
ff3ce480 | 621 | bus_node->length = *(u32 *)p_byte; |
1da177e4 LT |
622 | p_byte += 4; |
623 | ||
ff3ce480 | 624 | if (p_byte > ((u8 *)p_EV_header + evbuffer_length)) { |
1da177e4 LT |
625 | kfree(bus_node); |
626 | return 2; | |
627 | } | |
628 | ||
629 | bus_node->next = ctrl->bus_head; | |
630 | ctrl->bus_head = bus_node; | |
631 | } | |
632 | ||
427438c6 AC |
633 | /* If all of the following fail, we don't have any resources for |
634 | * hot plug add | |
635 | */ | |
1da177e4 LT |
636 | rc = 1; |
637 | rc &= cpqhp_resource_sort_and_combine(&(ctrl->mem_head)); | |
638 | rc &= cpqhp_resource_sort_and_combine(&(ctrl->p_mem_head)); | |
639 | rc &= cpqhp_resource_sort_and_combine(&(ctrl->io_head)); | |
640 | rc &= cpqhp_resource_sort_and_combine(&(ctrl->bus_head)); | |
641 | ||
642 | if (rc) | |
643 | return(rc); | |
644 | } else { | |
861fefbf | 645 | if ((evbuffer[0] != 0) && (!ctrl->push_flag)) |
1da177e4 LT |
646 | return 1; |
647 | } | |
648 | ||
649 | return 0; | |
650 | } | |
651 | ||
861fefbf | 652 | |
ff3ce480 | 653 | int compaq_nvram_store(void __iomem *rom_start) |
1da177e4 LT |
654 | { |
655 | int rc = 1; | |
656 | ||
657 | if (rom_start == NULL) | |
658 | return -ENODEV; | |
659 | ||
660 | if (evbuffer_init) { | |
661 | rc = store_HRT(rom_start); | |
656f978f | 662 | if (rc) |
1da177e4 | 663 | err(msg_unable_to_save); |
1da177e4 LT |
664 | } |
665 | return rc; | |
666 | } | |
667 |