Loading...
1/*
2 * PCI Express 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 * Copyright (C) 2003-2004 Intel Corporation
8 *
9 * All rights reserved.
10 *
11 * This program is free software; you can redistribute it and/or modify
12 * it under the terms of the GNU General Public License as published by
13 * the Free Software Foundation; either version 2 of the License, or (at
14 * your option) any later version.
15 *
16 * This program is distributed in the hope that it will be useful, but
17 * WITHOUT ANY WARRANTY; without even the implied warranty of
18 * MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE, GOOD TITLE or
19 * NON INFRINGEMENT. See the GNU General Public License for more
20 * details.
21 *
22 * You should have received a copy of the GNU General Public License
23 * along with this program; if not, write to the Free Software
24 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
25 *
26 * Send feedback to <greg@kroah.com>, <kristen.c.accardi@intel.com>
27 *
28 */
29
30#include <linux/module.h>
31#include <linux/kernel.h>
32#include <linux/types.h>
33#include <linux/slab.h>
34#include <linux/pci.h>
35#include "../pci.h"
36#include "pciehp.h"
37
38static void interrupt_event_handler(struct work_struct *work);
39
40static int queue_interrupt_event(struct slot *p_slot, u32 event_type)
41{
42 struct event_info *info;
43
44 info = kmalloc(sizeof(*info), GFP_ATOMIC);
45 if (!info)
46 return -ENOMEM;
47
48 info->event_type = event_type;
49 info->p_slot = p_slot;
50 INIT_WORK(&info->work, interrupt_event_handler);
51
52 queue_work(p_slot->wq, &info->work);
53
54 return 0;
55}
56
57u8 pciehp_handle_attention_button(struct slot *p_slot)
58{
59 u32 event_type;
60 struct controller *ctrl = p_slot->ctrl;
61
62 /* Attention Button Change */
63 ctrl_dbg(ctrl, "Attention button interrupt received\n");
64
65 /*
66 * Button pressed - See if need to TAKE ACTION!!!
67 */
68 ctrl_info(ctrl, "Button pressed on Slot(%s)\n", slot_name(p_slot));
69 event_type = INT_BUTTON_PRESS;
70
71 queue_interrupt_event(p_slot, event_type);
72
73 return 0;
74}
75
76u8 pciehp_handle_switch_change(struct slot *p_slot)
77{
78 u8 getstatus;
79 u32 event_type;
80 struct controller *ctrl = p_slot->ctrl;
81
82 /* Switch Change */
83 ctrl_dbg(ctrl, "Switch interrupt received\n");
84
85 pciehp_get_latch_status(p_slot, &getstatus);
86 if (getstatus) {
87 /*
88 * Switch opened
89 */
90 ctrl_info(ctrl, "Latch open on Slot(%s)\n", slot_name(p_slot));
91 event_type = INT_SWITCH_OPEN;
92 } else {
93 /*
94 * Switch closed
95 */
96 ctrl_info(ctrl, "Latch close on Slot(%s)\n", slot_name(p_slot));
97 event_type = INT_SWITCH_CLOSE;
98 }
99
100 queue_interrupt_event(p_slot, event_type);
101
102 return 1;
103}
104
105u8 pciehp_handle_presence_change(struct slot *p_slot)
106{
107 u32 event_type;
108 u8 presence_save;
109 struct controller *ctrl = p_slot->ctrl;
110
111 /* Presence Change */
112 ctrl_dbg(ctrl, "Presence/Notify input change\n");
113
114 /* Switch is open, assume a presence change
115 * Save the presence state
116 */
117 pciehp_get_adapter_status(p_slot, &presence_save);
118 if (presence_save) {
119 /*
120 * Card Present
121 */
122 ctrl_info(ctrl, "Card present on Slot(%s)\n", slot_name(p_slot));
123 event_type = INT_PRESENCE_ON;
124 } else {
125 /*
126 * Not Present
127 */
128 ctrl_info(ctrl, "Card not present on Slot(%s)\n",
129 slot_name(p_slot));
130 event_type = INT_PRESENCE_OFF;
131 }
132
133 queue_interrupt_event(p_slot, event_type);
134
135 return 1;
136}
137
138u8 pciehp_handle_power_fault(struct slot *p_slot)
139{
140 u32 event_type;
141 struct controller *ctrl = p_slot->ctrl;
142
143 /* power fault */
144 ctrl_dbg(ctrl, "Power fault interrupt received\n");
145 ctrl_err(ctrl, "Power fault on slot %s\n", slot_name(p_slot));
146 event_type = INT_POWER_FAULT;
147 ctrl_info(ctrl, "Power fault bit %x set\n", 0);
148 queue_interrupt_event(p_slot, event_type);
149
150 return 1;
151}
152
153void pciehp_handle_linkstate_change(struct slot *p_slot)
154{
155 u32 event_type;
156 struct controller *ctrl = p_slot->ctrl;
157
158 /* Link Status Change */
159 ctrl_dbg(ctrl, "Data Link Layer State change\n");
160
161 if (pciehp_check_link_active(ctrl)) {
162 ctrl_info(ctrl, "slot(%s): Link Up event\n",
163 slot_name(p_slot));
164 event_type = INT_LINK_UP;
165 } else {
166 ctrl_info(ctrl, "slot(%s): Link Down event\n",
167 slot_name(p_slot));
168 event_type = INT_LINK_DOWN;
169 }
170
171 queue_interrupt_event(p_slot, event_type);
172}
173
174/* The following routines constitute the bulk of the
175 hotplug controller logic
176 */
177
178static void set_slot_off(struct controller *ctrl, struct slot * pslot)
179{
180 /* turn off slot, turn on Amber LED, turn off Green LED if supported*/
181 if (POWER_CTRL(ctrl)) {
182 pciehp_power_off_slot(pslot);
183
184 /*
185 * After turning power off, we must wait for at least 1 second
186 * before taking any action that relies on power having been
187 * removed from the slot/adapter.
188 */
189 msleep(1000);
190 }
191
192 pciehp_green_led_off(pslot);
193 pciehp_set_attention_status(pslot, 1);
194}
195
196/**
197 * board_added - Called after a board has been added to the system.
198 * @p_slot: &slot where board is added
199 *
200 * Turns power on for the board.
201 * Configures board.
202 */
203static int board_added(struct slot *p_slot)
204{
205 int retval = 0;
206 struct controller *ctrl = p_slot->ctrl;
207 struct pci_bus *parent = ctrl->pcie->port->subordinate;
208
209 if (POWER_CTRL(ctrl)) {
210 /* Power on slot */
211 retval = pciehp_power_on_slot(p_slot);
212 if (retval)
213 return retval;
214 }
215
216 pciehp_green_led_blink(p_slot);
217
218 /* Check link training status */
219 retval = pciehp_check_link_status(ctrl);
220 if (retval) {
221 ctrl_err(ctrl, "Failed to check link status\n");
222 goto err_exit;
223 }
224
225 /* Check for a power fault */
226 if (ctrl->power_fault_detected || pciehp_query_power_fault(p_slot)) {
227 ctrl_err(ctrl, "Power fault on slot %s\n", slot_name(p_slot));
228 retval = -EIO;
229 goto err_exit;
230 }
231
232 retval = pciehp_configure_device(p_slot);
233 if (retval) {
234 ctrl_err(ctrl, "Cannot add device at %04x:%02x:00\n",
235 pci_domain_nr(parent), parent->number);
236 if (retval != -EEXIST)
237 goto err_exit;
238 }
239
240 pciehp_green_led_on(p_slot);
241 return 0;
242
243err_exit:
244 set_slot_off(ctrl, p_slot);
245 return retval;
246}
247
248/**
249 * remove_board - Turns off slot and LEDs
250 * @p_slot: slot where board is being removed
251 */
252static int remove_board(struct slot *p_slot)
253{
254 int retval;
255 struct controller *ctrl = p_slot->ctrl;
256
257 retval = pciehp_unconfigure_device(p_slot);
258 if (retval)
259 return retval;
260
261 if (POWER_CTRL(ctrl)) {
262 pciehp_power_off_slot(p_slot);
263
264 /*
265 * After turning power off, we must wait for at least 1 second
266 * before taking any action that relies on power having been
267 * removed from the slot/adapter.
268 */
269 msleep(1000);
270 }
271
272 /* turn off Green LED */
273 pciehp_green_led_off(p_slot);
274 return 0;
275}
276
277struct power_work_info {
278 struct slot *p_slot;
279 struct work_struct work;
280 unsigned int req;
281#define DISABLE_REQ 0
282#define ENABLE_REQ 1
283};
284
285/**
286 * pciehp_power_thread - handle pushbutton events
287 * @work: &struct work_struct describing work to be done
288 *
289 * Scheduled procedure to handle blocking stuff for the pushbuttons.
290 * Handles all pending events and exits.
291 */
292static void pciehp_power_thread(struct work_struct *work)
293{
294 struct power_work_info *info =
295 container_of(work, struct power_work_info, work);
296 struct slot *p_slot = info->p_slot;
297 int ret;
298
299 switch (info->req) {
300 case DISABLE_REQ:
301 ctrl_dbg(p_slot->ctrl,
302 "Disabling domain:bus:device=%04x:%02x:00\n",
303 pci_domain_nr(p_slot->ctrl->pcie->port->subordinate),
304 p_slot->ctrl->pcie->port->subordinate->number);
305 mutex_lock(&p_slot->hotplug_lock);
306 pciehp_disable_slot(p_slot);
307 mutex_unlock(&p_slot->hotplug_lock);
308 mutex_lock(&p_slot->lock);
309 p_slot->state = STATIC_STATE;
310 mutex_unlock(&p_slot->lock);
311 break;
312 case ENABLE_REQ:
313 ctrl_dbg(p_slot->ctrl,
314 "Enabling domain:bus:device=%04x:%02x:00\n",
315 pci_domain_nr(p_slot->ctrl->pcie->port->subordinate),
316 p_slot->ctrl->pcie->port->subordinate->number);
317 mutex_lock(&p_slot->hotplug_lock);
318 ret = pciehp_enable_slot(p_slot);
319 mutex_unlock(&p_slot->hotplug_lock);
320 if (ret)
321 pciehp_green_led_off(p_slot);
322 mutex_lock(&p_slot->lock);
323 p_slot->state = STATIC_STATE;
324 mutex_unlock(&p_slot->lock);
325 break;
326 default:
327 break;
328 }
329
330 kfree(info);
331}
332
333void pciehp_queue_pushbutton_work(struct work_struct *work)
334{
335 struct slot *p_slot = container_of(work, struct slot, work.work);
336 struct power_work_info *info;
337
338 info = kmalloc(sizeof(*info), GFP_KERNEL);
339 if (!info) {
340 ctrl_err(p_slot->ctrl, "%s: Cannot allocate memory\n",
341 __func__);
342 return;
343 }
344 info->p_slot = p_slot;
345 INIT_WORK(&info->work, pciehp_power_thread);
346
347 mutex_lock(&p_slot->lock);
348 switch (p_slot->state) {
349 case BLINKINGOFF_STATE:
350 p_slot->state = POWEROFF_STATE;
351 info->req = DISABLE_REQ;
352 break;
353 case BLINKINGON_STATE:
354 p_slot->state = POWERON_STATE;
355 info->req = ENABLE_REQ;
356 break;
357 default:
358 kfree(info);
359 goto out;
360 }
361 queue_work(p_slot->wq, &info->work);
362 out:
363 mutex_unlock(&p_slot->lock);
364}
365
366/*
367 * Note: This function must be called with slot->lock held
368 */
369static void handle_button_press_event(struct slot *p_slot)
370{
371 struct controller *ctrl = p_slot->ctrl;
372 u8 getstatus;
373
374 switch (p_slot->state) {
375 case STATIC_STATE:
376 pciehp_get_power_status(p_slot, &getstatus);
377 if (getstatus) {
378 p_slot->state = BLINKINGOFF_STATE;
379 ctrl_info(ctrl,
380 "PCI slot #%s - powering off due to button "
381 "press.\n", slot_name(p_slot));
382 } else {
383 p_slot->state = BLINKINGON_STATE;
384 ctrl_info(ctrl,
385 "PCI slot #%s - powering on due to button "
386 "press.\n", slot_name(p_slot));
387 }
388 /* blink green LED and turn off amber */
389 pciehp_green_led_blink(p_slot);
390 pciehp_set_attention_status(p_slot, 0);
391 queue_delayed_work(p_slot->wq, &p_slot->work, 5*HZ);
392 break;
393 case BLINKINGOFF_STATE:
394 case BLINKINGON_STATE:
395 /*
396 * Cancel if we are still blinking; this means that we
397 * press the attention again before the 5 sec. limit
398 * expires to cancel hot-add or hot-remove
399 */
400 ctrl_info(ctrl, "Button cancel on Slot(%s)\n", slot_name(p_slot));
401 cancel_delayed_work(&p_slot->work);
402 if (p_slot->state == BLINKINGOFF_STATE)
403 pciehp_green_led_on(p_slot);
404 else
405 pciehp_green_led_off(p_slot);
406 pciehp_set_attention_status(p_slot, 0);
407 ctrl_info(ctrl, "PCI slot #%s - action canceled "
408 "due to button press\n", slot_name(p_slot));
409 p_slot->state = STATIC_STATE;
410 break;
411 case POWEROFF_STATE:
412 case POWERON_STATE:
413 /*
414 * Ignore if the slot is on power-on or power-off state;
415 * this means that the previous attention button action
416 * to hot-add or hot-remove is undergoing
417 */
418 ctrl_info(ctrl, "Button ignore on Slot(%s)\n", slot_name(p_slot));
419 break;
420 default:
421 ctrl_warn(ctrl, "Not a valid state\n");
422 break;
423 }
424}
425
426/*
427 * Note: This function must be called with slot->lock held
428 */
429static void handle_surprise_event(struct slot *p_slot)
430{
431 u8 getstatus;
432 struct power_work_info *info;
433
434 info = kmalloc(sizeof(*info), GFP_KERNEL);
435 if (!info) {
436 ctrl_err(p_slot->ctrl, "%s: Cannot allocate memory\n",
437 __func__);
438 return;
439 }
440 info->p_slot = p_slot;
441 INIT_WORK(&info->work, pciehp_power_thread);
442
443 pciehp_get_adapter_status(p_slot, &getstatus);
444 if (!getstatus) {
445 p_slot->state = POWEROFF_STATE;
446 info->req = DISABLE_REQ;
447 } else {
448 p_slot->state = POWERON_STATE;
449 info->req = ENABLE_REQ;
450 }
451
452 queue_work(p_slot->wq, &info->work);
453}
454
455/*
456 * Note: This function must be called with slot->lock held
457 */
458static void handle_link_event(struct slot *p_slot, u32 event)
459{
460 struct controller *ctrl = p_slot->ctrl;
461 struct power_work_info *info;
462
463 info = kmalloc(sizeof(*info), GFP_KERNEL);
464 if (!info) {
465 ctrl_err(p_slot->ctrl, "%s: Cannot allocate memory\n",
466 __func__);
467 return;
468 }
469 info->p_slot = p_slot;
470 info->req = event == INT_LINK_UP ? ENABLE_REQ : DISABLE_REQ;
471 INIT_WORK(&info->work, pciehp_power_thread);
472
473 switch (p_slot->state) {
474 case BLINKINGON_STATE:
475 case BLINKINGOFF_STATE:
476 cancel_delayed_work(&p_slot->work);
477 /* Fall through */
478 case STATIC_STATE:
479 p_slot->state = event == INT_LINK_UP ?
480 POWERON_STATE : POWEROFF_STATE;
481 queue_work(p_slot->wq, &info->work);
482 break;
483 case POWERON_STATE:
484 if (event == INT_LINK_UP) {
485 ctrl_info(ctrl,
486 "Link Up event ignored on slot(%s): already powering on\n",
487 slot_name(p_slot));
488 kfree(info);
489 } else {
490 ctrl_info(ctrl,
491 "Link Down event queued on slot(%s): currently getting powered on\n",
492 slot_name(p_slot));
493 p_slot->state = POWEROFF_STATE;
494 queue_work(p_slot->wq, &info->work);
495 }
496 break;
497 case POWEROFF_STATE:
498 if (event == INT_LINK_UP) {
499 ctrl_info(ctrl,
500 "Link Up event queued on slot(%s): currently getting powered off\n",
501 slot_name(p_slot));
502 p_slot->state = POWERON_STATE;
503 queue_work(p_slot->wq, &info->work);
504 } else {
505 ctrl_info(ctrl,
506 "Link Down event ignored on slot(%s): already powering off\n",
507 slot_name(p_slot));
508 kfree(info);
509 }
510 break;
511 default:
512 ctrl_err(ctrl, "Not a valid state on slot(%s)\n",
513 slot_name(p_slot));
514 kfree(info);
515 break;
516 }
517}
518
519static void interrupt_event_handler(struct work_struct *work)
520{
521 struct event_info *info = container_of(work, struct event_info, work);
522 struct slot *p_slot = info->p_slot;
523 struct controller *ctrl = p_slot->ctrl;
524
525 mutex_lock(&p_slot->lock);
526 switch (info->event_type) {
527 case INT_BUTTON_PRESS:
528 handle_button_press_event(p_slot);
529 break;
530 case INT_POWER_FAULT:
531 if (!POWER_CTRL(ctrl))
532 break;
533 pciehp_set_attention_status(p_slot, 1);
534 pciehp_green_led_off(p_slot);
535 break;
536 case INT_PRESENCE_ON:
537 if (!HP_SUPR_RM(ctrl))
538 break;
539 ctrl_dbg(ctrl, "Surprise Insertion\n");
540 handle_surprise_event(p_slot);
541 break;
542 case INT_PRESENCE_OFF:
543 /*
544 * Regardless of surprise capability, we need to
545 * definitely remove a card that has been pulled out!
546 */
547 ctrl_dbg(ctrl, "Surprise Removal\n");
548 handle_surprise_event(p_slot);
549 break;
550 case INT_LINK_UP:
551 case INT_LINK_DOWN:
552 handle_link_event(p_slot, info->event_type);
553 break;
554 default:
555 break;
556 }
557 mutex_unlock(&p_slot->lock);
558
559 kfree(info);
560}
561
562/*
563 * Note: This function must be called with slot->hotplug_lock held
564 */
565int pciehp_enable_slot(struct slot *p_slot)
566{
567 u8 getstatus = 0;
568 int rc;
569 struct controller *ctrl = p_slot->ctrl;
570
571 pciehp_get_adapter_status(p_slot, &getstatus);
572 if (!getstatus) {
573 ctrl_info(ctrl, "No adapter on slot(%s)\n", slot_name(p_slot));
574 return -ENODEV;
575 }
576 if (MRL_SENS(p_slot->ctrl)) {
577 pciehp_get_latch_status(p_slot, &getstatus);
578 if (getstatus) {
579 ctrl_info(ctrl, "Latch open on slot(%s)\n",
580 slot_name(p_slot));
581 return -ENODEV;
582 }
583 }
584
585 if (POWER_CTRL(p_slot->ctrl)) {
586 pciehp_get_power_status(p_slot, &getstatus);
587 if (getstatus) {
588 ctrl_info(ctrl, "Already enabled on slot(%s)\n",
589 slot_name(p_slot));
590 return -EINVAL;
591 }
592 }
593
594 pciehp_get_latch_status(p_slot, &getstatus);
595
596 rc = board_added(p_slot);
597 if (rc)
598 pciehp_get_latch_status(p_slot, &getstatus);
599
600 return rc;
601}
602
603/*
604 * Note: This function must be called with slot->hotplug_lock held
605 */
606int pciehp_disable_slot(struct slot *p_slot)
607{
608 u8 getstatus = 0;
609 struct controller *ctrl = p_slot->ctrl;
610
611 if (!p_slot->ctrl)
612 return 1;
613
614 if (POWER_CTRL(p_slot->ctrl)) {
615 pciehp_get_power_status(p_slot, &getstatus);
616 if (!getstatus) {
617 ctrl_info(ctrl, "Already disabled on slot(%s)\n",
618 slot_name(p_slot));
619 return -EINVAL;
620 }
621 }
622
623 return remove_board(p_slot);
624}
625
626int pciehp_sysfs_enable_slot(struct slot *p_slot)
627{
628 int retval = -ENODEV;
629 struct controller *ctrl = p_slot->ctrl;
630
631 mutex_lock(&p_slot->lock);
632 switch (p_slot->state) {
633 case BLINKINGON_STATE:
634 cancel_delayed_work(&p_slot->work);
635 case STATIC_STATE:
636 p_slot->state = POWERON_STATE;
637 mutex_unlock(&p_slot->lock);
638 mutex_lock(&p_slot->hotplug_lock);
639 retval = pciehp_enable_slot(p_slot);
640 mutex_unlock(&p_slot->hotplug_lock);
641 mutex_lock(&p_slot->lock);
642 p_slot->state = STATIC_STATE;
643 break;
644 case POWERON_STATE:
645 ctrl_info(ctrl, "Slot %s is already in powering on state\n",
646 slot_name(p_slot));
647 break;
648 case BLINKINGOFF_STATE:
649 case POWEROFF_STATE:
650 ctrl_info(ctrl, "Already enabled on slot %s\n",
651 slot_name(p_slot));
652 break;
653 default:
654 ctrl_err(ctrl, "Not a valid state on slot %s\n",
655 slot_name(p_slot));
656 break;
657 }
658 mutex_unlock(&p_slot->lock);
659
660 return retval;
661}
662
663int pciehp_sysfs_disable_slot(struct slot *p_slot)
664{
665 int retval = -ENODEV;
666 struct controller *ctrl = p_slot->ctrl;
667
668 mutex_lock(&p_slot->lock);
669 switch (p_slot->state) {
670 case BLINKINGOFF_STATE:
671 cancel_delayed_work(&p_slot->work);
672 case STATIC_STATE:
673 p_slot->state = POWEROFF_STATE;
674 mutex_unlock(&p_slot->lock);
675 retval = pciehp_disable_slot(p_slot);
676 mutex_lock(&p_slot->lock);
677 p_slot->state = STATIC_STATE;
678 break;
679 case POWEROFF_STATE:
680 ctrl_info(ctrl, "Slot %s is already in powering off state\n",
681 slot_name(p_slot));
682 break;
683 case BLINKINGON_STATE:
684 case POWERON_STATE:
685 ctrl_info(ctrl, "Already disabled on slot %s\n",
686 slot_name(p_slot));
687 break;
688 default:
689 ctrl_err(ctrl, "Not a valid state on slot %s\n",
690 slot_name(p_slot));
691 break;
692 }
693 mutex_unlock(&p_slot->lock);
694
695 return retval;
696}
1/*
2 * PCI Express 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 * Copyright (C) 2003-2004 Intel Corporation
8 *
9 * All rights reserved.
10 *
11 * This program is free software; you can redistribute it and/or modify
12 * it under the terms of the GNU General Public License as published by
13 * the Free Software Foundation; either version 2 of the License, or (at
14 * your option) any later version.
15 *
16 * This program is distributed in the hope that it will be useful, but
17 * WITHOUT ANY WARRANTY; without even the implied warranty of
18 * MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE, GOOD TITLE or
19 * NON INFRINGEMENT. See the GNU General Public License for more
20 * details.
21 *
22 * You should have received a copy of the GNU General Public License
23 * along with this program; if not, write to the Free Software
24 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
25 *
26 * Send feedback to <greg@kroah.com>, <kristen.c.accardi@intel.com>
27 *
28 */
29
30#include <linux/module.h>
31#include <linux/kernel.h>
32#include <linux/types.h>
33#include <linux/slab.h>
34#include <linux/pci.h>
35#include "../pci.h"
36#include "pciehp.h"
37
38static void interrupt_event_handler(struct work_struct *work);
39
40void pciehp_queue_interrupt_event(struct slot *p_slot, u32 event_type)
41{
42 struct event_info *info;
43
44 info = kmalloc(sizeof(*info), GFP_ATOMIC);
45 if (!info) {
46 ctrl_err(p_slot->ctrl, "dropped event %d (ENOMEM)\n", event_type);
47 return;
48 }
49
50 INIT_WORK(&info->work, interrupt_event_handler);
51 info->event_type = event_type;
52 info->p_slot = p_slot;
53 queue_work(p_slot->wq, &info->work);
54}
55
56/* The following routines constitute the bulk of the
57 hotplug controller logic
58 */
59
60static void set_slot_off(struct controller *ctrl, struct slot *pslot)
61{
62 /* turn off slot, turn on Amber LED, turn off Green LED if supported*/
63 if (POWER_CTRL(ctrl)) {
64 pciehp_power_off_slot(pslot);
65
66 /*
67 * After turning power off, we must wait for at least 1 second
68 * before taking any action that relies on power having been
69 * removed from the slot/adapter.
70 */
71 msleep(1000);
72 }
73
74 pciehp_green_led_off(pslot);
75 pciehp_set_attention_status(pslot, 1);
76}
77
78/**
79 * board_added - Called after a board has been added to the system.
80 * @p_slot: &slot where board is added
81 *
82 * Turns power on for the board.
83 * Configures board.
84 */
85static int board_added(struct slot *p_slot)
86{
87 int retval = 0;
88 struct controller *ctrl = p_slot->ctrl;
89 struct pci_bus *parent = ctrl->pcie->port->subordinate;
90
91 if (POWER_CTRL(ctrl)) {
92 /* Power on slot */
93 retval = pciehp_power_on_slot(p_slot);
94 if (retval)
95 return retval;
96 }
97
98 pciehp_green_led_blink(p_slot);
99
100 /* Check link training status */
101 retval = pciehp_check_link_status(ctrl);
102 if (retval) {
103 ctrl_err(ctrl, "Failed to check link status\n");
104 goto err_exit;
105 }
106
107 /* Check for a power fault */
108 if (ctrl->power_fault_detected || pciehp_query_power_fault(p_slot)) {
109 ctrl_err(ctrl, "Power fault on slot %s\n", slot_name(p_slot));
110 retval = -EIO;
111 goto err_exit;
112 }
113
114 retval = pciehp_configure_device(p_slot);
115 if (retval) {
116 ctrl_err(ctrl, "Cannot add device at %04x:%02x:00\n",
117 pci_domain_nr(parent), parent->number);
118 if (retval != -EEXIST)
119 goto err_exit;
120 }
121
122 pciehp_green_led_on(p_slot);
123 return 0;
124
125err_exit:
126 set_slot_off(ctrl, p_slot);
127 return retval;
128}
129
130/**
131 * remove_board - Turns off slot and LEDs
132 * @p_slot: slot where board is being removed
133 */
134static int remove_board(struct slot *p_slot)
135{
136 int retval;
137 struct controller *ctrl = p_slot->ctrl;
138
139 retval = pciehp_unconfigure_device(p_slot);
140 if (retval)
141 return retval;
142
143 if (POWER_CTRL(ctrl)) {
144 pciehp_power_off_slot(p_slot);
145
146 /*
147 * After turning power off, we must wait for at least 1 second
148 * before taking any action that relies on power having been
149 * removed from the slot/adapter.
150 */
151 msleep(1000);
152 }
153
154 /* turn off Green LED */
155 pciehp_green_led_off(p_slot);
156 return 0;
157}
158
159struct power_work_info {
160 struct slot *p_slot;
161 struct work_struct work;
162 unsigned int req;
163#define DISABLE_REQ 0
164#define ENABLE_REQ 1
165};
166
167/**
168 * pciehp_power_thread - handle pushbutton events
169 * @work: &struct work_struct describing work to be done
170 *
171 * Scheduled procedure to handle blocking stuff for the pushbuttons.
172 * Handles all pending events and exits.
173 */
174static void pciehp_power_thread(struct work_struct *work)
175{
176 struct power_work_info *info =
177 container_of(work, struct power_work_info, work);
178 struct slot *p_slot = info->p_slot;
179 int ret;
180
181 switch (info->req) {
182 case DISABLE_REQ:
183 mutex_lock(&p_slot->hotplug_lock);
184 pciehp_disable_slot(p_slot);
185 mutex_unlock(&p_slot->hotplug_lock);
186 mutex_lock(&p_slot->lock);
187 p_slot->state = STATIC_STATE;
188 mutex_unlock(&p_slot->lock);
189 break;
190 case ENABLE_REQ:
191 mutex_lock(&p_slot->hotplug_lock);
192 ret = pciehp_enable_slot(p_slot);
193 mutex_unlock(&p_slot->hotplug_lock);
194 if (ret)
195 pciehp_green_led_off(p_slot);
196 mutex_lock(&p_slot->lock);
197 p_slot->state = STATIC_STATE;
198 mutex_unlock(&p_slot->lock);
199 break;
200 default:
201 break;
202 }
203
204 kfree(info);
205}
206
207static void pciehp_queue_power_work(struct slot *p_slot, int req)
208{
209 struct power_work_info *info;
210
211 p_slot->state = (req == ENABLE_REQ) ? POWERON_STATE : POWEROFF_STATE;
212
213 info = kmalloc(sizeof(*info), GFP_KERNEL);
214 if (!info) {
215 ctrl_err(p_slot->ctrl, "no memory to queue %s request\n",
216 (req == ENABLE_REQ) ? "poweron" : "poweroff");
217 return;
218 }
219 info->p_slot = p_slot;
220 INIT_WORK(&info->work, pciehp_power_thread);
221 info->req = req;
222 queue_work(p_slot->wq, &info->work);
223}
224
225void pciehp_queue_pushbutton_work(struct work_struct *work)
226{
227 struct slot *p_slot = container_of(work, struct slot, work.work);
228
229 mutex_lock(&p_slot->lock);
230 switch (p_slot->state) {
231 case BLINKINGOFF_STATE:
232 pciehp_queue_power_work(p_slot, DISABLE_REQ);
233 break;
234 case BLINKINGON_STATE:
235 pciehp_queue_power_work(p_slot, ENABLE_REQ);
236 break;
237 default:
238 break;
239 }
240 mutex_unlock(&p_slot->lock);
241}
242
243/*
244 * Note: This function must be called with slot->lock held
245 */
246static void handle_button_press_event(struct slot *p_slot)
247{
248 struct controller *ctrl = p_slot->ctrl;
249 u8 getstatus;
250
251 switch (p_slot->state) {
252 case STATIC_STATE:
253 pciehp_get_power_status(p_slot, &getstatus);
254 if (getstatus) {
255 p_slot->state = BLINKINGOFF_STATE;
256 ctrl_info(ctrl, "PCI slot #%s - powering off due to button press\n",
257 slot_name(p_slot));
258 } else {
259 p_slot->state = BLINKINGON_STATE;
260 ctrl_info(ctrl, "PCI slot #%s - powering on due to button press\n",
261 slot_name(p_slot));
262 }
263 /* blink green LED and turn off amber */
264 pciehp_green_led_blink(p_slot);
265 pciehp_set_attention_status(p_slot, 0);
266 queue_delayed_work(p_slot->wq, &p_slot->work, 5*HZ);
267 break;
268 case BLINKINGOFF_STATE:
269 case BLINKINGON_STATE:
270 /*
271 * Cancel if we are still blinking; this means that we
272 * press the attention again before the 5 sec. limit
273 * expires to cancel hot-add or hot-remove
274 */
275 ctrl_info(ctrl, "Button cancel on Slot(%s)\n", slot_name(p_slot));
276 cancel_delayed_work(&p_slot->work);
277 if (p_slot->state == BLINKINGOFF_STATE)
278 pciehp_green_led_on(p_slot);
279 else
280 pciehp_green_led_off(p_slot);
281 pciehp_set_attention_status(p_slot, 0);
282 ctrl_info(ctrl, "PCI slot #%s - action canceled due to button press\n",
283 slot_name(p_slot));
284 p_slot->state = STATIC_STATE;
285 break;
286 case POWEROFF_STATE:
287 case POWERON_STATE:
288 /*
289 * Ignore if the slot is on power-on or power-off state;
290 * this means that the previous attention button action
291 * to hot-add or hot-remove is undergoing
292 */
293 ctrl_info(ctrl, "Button ignore on Slot(%s)\n", slot_name(p_slot));
294 break;
295 default:
296 ctrl_warn(ctrl, "ignoring invalid state %#x\n", p_slot->state);
297 break;
298 }
299}
300
301/*
302 * Note: This function must be called with slot->lock held
303 */
304static void handle_surprise_event(struct slot *p_slot)
305{
306 u8 getstatus;
307
308 pciehp_get_adapter_status(p_slot, &getstatus);
309 if (!getstatus)
310 pciehp_queue_power_work(p_slot, DISABLE_REQ);
311 else
312 pciehp_queue_power_work(p_slot, ENABLE_REQ);
313}
314
315/*
316 * Note: This function must be called with slot->lock held
317 */
318static void handle_link_event(struct slot *p_slot, u32 event)
319{
320 struct controller *ctrl = p_slot->ctrl;
321
322 switch (p_slot->state) {
323 case BLINKINGON_STATE:
324 case BLINKINGOFF_STATE:
325 cancel_delayed_work(&p_slot->work);
326 /* Fall through */
327 case STATIC_STATE:
328 pciehp_queue_power_work(p_slot, event == INT_LINK_UP ?
329 ENABLE_REQ : DISABLE_REQ);
330 break;
331 case POWERON_STATE:
332 if (event == INT_LINK_UP) {
333 ctrl_info(ctrl,
334 "Link Up event ignored on slot(%s): already powering on\n",
335 slot_name(p_slot));
336 } else {
337 ctrl_info(ctrl,
338 "Link Down event queued on slot(%s): currently getting powered on\n",
339 slot_name(p_slot));
340 pciehp_queue_power_work(p_slot, DISABLE_REQ);
341 }
342 break;
343 case POWEROFF_STATE:
344 if (event == INT_LINK_UP) {
345 ctrl_info(ctrl,
346 "Link Up event queued on slot(%s): currently getting powered off\n",
347 slot_name(p_slot));
348 pciehp_queue_power_work(p_slot, ENABLE_REQ);
349 } else {
350 ctrl_info(ctrl,
351 "Link Down event ignored on slot(%s): already powering off\n",
352 slot_name(p_slot));
353 }
354 break;
355 default:
356 ctrl_err(ctrl, "ignoring invalid state %#x on slot(%s)\n",
357 p_slot->state, slot_name(p_slot));
358 break;
359 }
360}
361
362static void interrupt_event_handler(struct work_struct *work)
363{
364 struct event_info *info = container_of(work, struct event_info, work);
365 struct slot *p_slot = info->p_slot;
366 struct controller *ctrl = p_slot->ctrl;
367
368 mutex_lock(&p_slot->lock);
369 switch (info->event_type) {
370 case INT_BUTTON_PRESS:
371 handle_button_press_event(p_slot);
372 break;
373 case INT_POWER_FAULT:
374 if (!POWER_CTRL(ctrl))
375 break;
376 pciehp_set_attention_status(p_slot, 1);
377 pciehp_green_led_off(p_slot);
378 break;
379 case INT_PRESENCE_ON:
380 handle_surprise_event(p_slot);
381 break;
382 case INT_PRESENCE_OFF:
383 /*
384 * Regardless of surprise capability, we need to
385 * definitely remove a card that has been pulled out!
386 */
387 handle_surprise_event(p_slot);
388 break;
389 case INT_LINK_UP:
390 case INT_LINK_DOWN:
391 handle_link_event(p_slot, info->event_type);
392 break;
393 default:
394 break;
395 }
396 mutex_unlock(&p_slot->lock);
397
398 kfree(info);
399}
400
401/*
402 * Note: This function must be called with slot->hotplug_lock held
403 */
404int pciehp_enable_slot(struct slot *p_slot)
405{
406 u8 getstatus = 0;
407 int rc;
408 struct controller *ctrl = p_slot->ctrl;
409
410 pciehp_get_adapter_status(p_slot, &getstatus);
411 if (!getstatus) {
412 ctrl_info(ctrl, "No adapter on slot(%s)\n", slot_name(p_slot));
413 return -ENODEV;
414 }
415 if (MRL_SENS(p_slot->ctrl)) {
416 pciehp_get_latch_status(p_slot, &getstatus);
417 if (getstatus) {
418 ctrl_info(ctrl, "Latch open on slot(%s)\n",
419 slot_name(p_slot));
420 return -ENODEV;
421 }
422 }
423
424 if (POWER_CTRL(p_slot->ctrl)) {
425 pciehp_get_power_status(p_slot, &getstatus);
426 if (getstatus) {
427 ctrl_info(ctrl, "Already enabled on slot(%s)\n",
428 slot_name(p_slot));
429 return -EINVAL;
430 }
431 }
432
433 pciehp_get_latch_status(p_slot, &getstatus);
434
435 rc = board_added(p_slot);
436 if (rc)
437 pciehp_get_latch_status(p_slot, &getstatus);
438
439 return rc;
440}
441
442/*
443 * Note: This function must be called with slot->hotplug_lock held
444 */
445int pciehp_disable_slot(struct slot *p_slot)
446{
447 u8 getstatus = 0;
448 struct controller *ctrl = p_slot->ctrl;
449
450 if (!p_slot->ctrl)
451 return 1;
452
453 if (POWER_CTRL(p_slot->ctrl)) {
454 pciehp_get_power_status(p_slot, &getstatus);
455 if (!getstatus) {
456 ctrl_info(ctrl, "Already disabled on slot(%s)\n",
457 slot_name(p_slot));
458 return -EINVAL;
459 }
460 }
461
462 return remove_board(p_slot);
463}
464
465int pciehp_sysfs_enable_slot(struct slot *p_slot)
466{
467 int retval = -ENODEV;
468 struct controller *ctrl = p_slot->ctrl;
469
470 mutex_lock(&p_slot->lock);
471 switch (p_slot->state) {
472 case BLINKINGON_STATE:
473 cancel_delayed_work(&p_slot->work);
474 case STATIC_STATE:
475 p_slot->state = POWERON_STATE;
476 mutex_unlock(&p_slot->lock);
477 mutex_lock(&p_slot->hotplug_lock);
478 retval = pciehp_enable_slot(p_slot);
479 mutex_unlock(&p_slot->hotplug_lock);
480 mutex_lock(&p_slot->lock);
481 p_slot->state = STATIC_STATE;
482 break;
483 case POWERON_STATE:
484 ctrl_info(ctrl, "Slot %s is already in powering on state\n",
485 slot_name(p_slot));
486 break;
487 case BLINKINGOFF_STATE:
488 case POWEROFF_STATE:
489 ctrl_info(ctrl, "Already enabled on slot %s\n",
490 slot_name(p_slot));
491 break;
492 default:
493 ctrl_err(ctrl, "invalid state %#x on slot %s\n",
494 p_slot->state, slot_name(p_slot));
495 break;
496 }
497 mutex_unlock(&p_slot->lock);
498
499 return retval;
500}
501
502int pciehp_sysfs_disable_slot(struct slot *p_slot)
503{
504 int retval = -ENODEV;
505 struct controller *ctrl = p_slot->ctrl;
506
507 mutex_lock(&p_slot->lock);
508 switch (p_slot->state) {
509 case BLINKINGOFF_STATE:
510 cancel_delayed_work(&p_slot->work);
511 case STATIC_STATE:
512 p_slot->state = POWEROFF_STATE;
513 mutex_unlock(&p_slot->lock);
514 mutex_lock(&p_slot->hotplug_lock);
515 retval = pciehp_disable_slot(p_slot);
516 mutex_unlock(&p_slot->hotplug_lock);
517 mutex_lock(&p_slot->lock);
518 p_slot->state = STATIC_STATE;
519 break;
520 case POWEROFF_STATE:
521 ctrl_info(ctrl, "Slot %s is already in powering off state\n",
522 slot_name(p_slot));
523 break;
524 case BLINKINGON_STATE:
525 case POWERON_STATE:
526 ctrl_info(ctrl, "Already disabled on slot %s\n",
527 slot_name(p_slot));
528 break;
529 default:
530 ctrl_err(ctrl, "invalid state %#x on slot %s\n",
531 p_slot->state, slot_name(p_slot));
532 break;
533 }
534 mutex_unlock(&p_slot->lock);
535
536 return retval;
537}