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(pciehp_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
153/* The following routines constitute the bulk of the
154 hotplug controller logic
155 */
156
157static void set_slot_off(struct controller *ctrl, struct slot * pslot)
158{
159 /* turn off slot, turn on Amber LED, turn off Green LED if supported*/
160 if (POWER_CTRL(ctrl)) {
161 if (pciehp_power_off_slot(pslot)) {
162 ctrl_err(ctrl,
163 "Issue of Slot Power Off command failed\n");
164 return;
165 }
166 /*
167 * After turning power off, we must wait for at least 1 second
168 * before taking any action that relies on power having been
169 * removed from the slot/adapter.
170 */
171 msleep(1000);
172 }
173
174 if (PWR_LED(ctrl))
175 pciehp_green_led_off(pslot);
176
177 if (ATTN_LED(ctrl)) {
178 if (pciehp_set_attention_status(pslot, 1)) {
179 ctrl_err(ctrl,
180 "Issue of Set Attention Led command failed\n");
181 return;
182 }
183 }
184}
185
186/**
187 * board_added - Called after a board has been added to the system.
188 * @p_slot: &slot where board is added
189 *
190 * Turns power on for the board.
191 * Configures board.
192 */
193static int board_added(struct slot *p_slot)
194{
195 int retval = 0;
196 struct controller *ctrl = p_slot->ctrl;
197 struct pci_bus *parent = ctrl->pcie->port->subordinate;
198
199 if (POWER_CTRL(ctrl)) {
200 /* Power on slot */
201 retval = pciehp_power_on_slot(p_slot);
202 if (retval)
203 return retval;
204 }
205
206 if (PWR_LED(ctrl))
207 pciehp_green_led_blink(p_slot);
208
209 /* Check link training status */
210 retval = pciehp_check_link_status(ctrl);
211 if (retval) {
212 ctrl_err(ctrl, "Failed to check link status\n");
213 goto err_exit;
214 }
215
216 /* Check for a power fault */
217 if (ctrl->power_fault_detected || pciehp_query_power_fault(p_slot)) {
218 ctrl_err(ctrl, "Power fault on slot %s\n", slot_name(p_slot));
219 retval = -EIO;
220 goto err_exit;
221 }
222
223 retval = pciehp_configure_device(p_slot);
224 if (retval) {
225 ctrl_err(ctrl, "Cannot add device at %04x:%02x:00\n",
226 pci_domain_nr(parent), parent->number);
227 goto err_exit;
228 }
229
230 if (PWR_LED(ctrl))
231 pciehp_green_led_on(p_slot);
232
233 return 0;
234
235err_exit:
236 set_slot_off(ctrl, p_slot);
237 return retval;
238}
239
240/**
241 * remove_board - Turns off slot and LEDs
242 * @p_slot: slot where board is being removed
243 */
244static int remove_board(struct slot *p_slot)
245{
246 int retval = 0;
247 struct controller *ctrl = p_slot->ctrl;
248
249 retval = pciehp_unconfigure_device(p_slot);
250 if (retval)
251 return retval;
252
253 if (POWER_CTRL(ctrl)) {
254 /* power off slot */
255 retval = pciehp_power_off_slot(p_slot);
256 if (retval) {
257 ctrl_err(ctrl,
258 "Issue of Slot Disable command failed\n");
259 return retval;
260 }
261 /*
262 * After turning power off, we must wait for at least 1 second
263 * before taking any action that relies on power having been
264 * removed from the slot/adapter.
265 */
266 msleep(1000);
267 }
268
269 /* turn off Green LED */
270 if (PWR_LED(ctrl))
271 pciehp_green_led_off(p_slot);
272
273 return 0;
274}
275
276struct power_work_info {
277 struct slot *p_slot;
278 struct work_struct work;
279};
280
281/**
282 * pciehp_power_thread - handle pushbutton events
283 * @work: &struct work_struct describing work to be done
284 *
285 * Scheduled procedure to handle blocking stuff for the pushbuttons.
286 * Handles all pending events and exits.
287 */
288static void pciehp_power_thread(struct work_struct *work)
289{
290 struct power_work_info *info =
291 container_of(work, struct power_work_info, work);
292 struct slot *p_slot = info->p_slot;
293
294 mutex_lock(&p_slot->lock);
295 switch (p_slot->state) {
296 case POWEROFF_STATE:
297 mutex_unlock(&p_slot->lock);
298 ctrl_dbg(p_slot->ctrl,
299 "Disabling domain:bus:device=%04x:%02x:00\n",
300 pci_domain_nr(p_slot->ctrl->pcie->port->subordinate),
301 p_slot->ctrl->pcie->port->subordinate->number);
302 pciehp_disable_slot(p_slot);
303 mutex_lock(&p_slot->lock);
304 p_slot->state = STATIC_STATE;
305 break;
306 case POWERON_STATE:
307 mutex_unlock(&p_slot->lock);
308 if (pciehp_enable_slot(p_slot) && PWR_LED(p_slot->ctrl))
309 pciehp_green_led_off(p_slot);
310 mutex_lock(&p_slot->lock);
311 p_slot->state = STATIC_STATE;
312 break;
313 default:
314 break;
315 }
316 mutex_unlock(&p_slot->lock);
317
318 kfree(info);
319}
320
321void pciehp_queue_pushbutton_work(struct work_struct *work)
322{
323 struct slot *p_slot = container_of(work, struct slot, work.work);
324 struct power_work_info *info;
325
326 info = kmalloc(sizeof(*info), GFP_KERNEL);
327 if (!info) {
328 ctrl_err(p_slot->ctrl, "%s: Cannot allocate memory\n",
329 __func__);
330 return;
331 }
332 info->p_slot = p_slot;
333 INIT_WORK(&info->work, pciehp_power_thread);
334
335 mutex_lock(&p_slot->lock);
336 switch (p_slot->state) {
337 case BLINKINGOFF_STATE:
338 p_slot->state = POWEROFF_STATE;
339 break;
340 case BLINKINGON_STATE:
341 p_slot->state = POWERON_STATE;
342 break;
343 default:
344 kfree(info);
345 goto out;
346 }
347 queue_work(pciehp_wq, &info->work);
348 out:
349 mutex_unlock(&p_slot->lock);
350}
351
352/*
353 * Note: This function must be called with slot->lock held
354 */
355static void handle_button_press_event(struct slot *p_slot)
356{
357 struct controller *ctrl = p_slot->ctrl;
358 u8 getstatus;
359
360 switch (p_slot->state) {
361 case STATIC_STATE:
362 pciehp_get_power_status(p_slot, &getstatus);
363 if (getstatus) {
364 p_slot->state = BLINKINGOFF_STATE;
365 ctrl_info(ctrl,
366 "PCI slot #%s - powering off due to button "
367 "press.\n", slot_name(p_slot));
368 } else {
369 p_slot->state = BLINKINGON_STATE;
370 ctrl_info(ctrl,
371 "PCI slot #%s - powering on due to button "
372 "press.\n", slot_name(p_slot));
373 }
374 /* blink green LED and turn off amber */
375 if (PWR_LED(ctrl))
376 pciehp_green_led_blink(p_slot);
377 if (ATTN_LED(ctrl))
378 pciehp_set_attention_status(p_slot, 0);
379
380 queue_delayed_work(pciehp_wq, &p_slot->work, 5*HZ);
381 break;
382 case BLINKINGOFF_STATE:
383 case BLINKINGON_STATE:
384 /*
385 * Cancel if we are still blinking; this means that we
386 * press the attention again before the 5 sec. limit
387 * expires to cancel hot-add or hot-remove
388 */
389 ctrl_info(ctrl, "Button cancel on Slot(%s)\n", slot_name(p_slot));
390 cancel_delayed_work(&p_slot->work);
391 if (p_slot->state == BLINKINGOFF_STATE) {
392 if (PWR_LED(ctrl))
393 pciehp_green_led_on(p_slot);
394 } else {
395 if (PWR_LED(ctrl))
396 pciehp_green_led_off(p_slot);
397 }
398 if (ATTN_LED(ctrl))
399 pciehp_set_attention_status(p_slot, 0);
400 ctrl_info(ctrl, "PCI slot #%s - action canceled "
401 "due to button press\n", slot_name(p_slot));
402 p_slot->state = STATIC_STATE;
403 break;
404 case POWEROFF_STATE:
405 case POWERON_STATE:
406 /*
407 * Ignore if the slot is on power-on or power-off state;
408 * this means that the previous attention button action
409 * to hot-add or hot-remove is undergoing
410 */
411 ctrl_info(ctrl, "Button ignore on Slot(%s)\n", slot_name(p_slot));
412 break;
413 default:
414 ctrl_warn(ctrl, "Not a valid state\n");
415 break;
416 }
417}
418
419/*
420 * Note: This function must be called with slot->lock held
421 */
422static void handle_surprise_event(struct slot *p_slot)
423{
424 u8 getstatus;
425 struct power_work_info *info;
426
427 info = kmalloc(sizeof(*info), GFP_KERNEL);
428 if (!info) {
429 ctrl_err(p_slot->ctrl, "%s: Cannot allocate memory\n",
430 __func__);
431 return;
432 }
433 info->p_slot = p_slot;
434 INIT_WORK(&info->work, pciehp_power_thread);
435
436 pciehp_get_adapter_status(p_slot, &getstatus);
437 if (!getstatus)
438 p_slot->state = POWEROFF_STATE;
439 else
440 p_slot->state = POWERON_STATE;
441
442 queue_work(pciehp_wq, &info->work);
443}
444
445static void interrupt_event_handler(struct work_struct *work)
446{
447 struct event_info *info = container_of(work, struct event_info, work);
448 struct slot *p_slot = info->p_slot;
449 struct controller *ctrl = p_slot->ctrl;
450
451 mutex_lock(&p_slot->lock);
452 switch (info->event_type) {
453 case INT_BUTTON_PRESS:
454 handle_button_press_event(p_slot);
455 break;
456 case INT_POWER_FAULT:
457 if (!POWER_CTRL(ctrl))
458 break;
459 if (ATTN_LED(ctrl))
460 pciehp_set_attention_status(p_slot, 1);
461 if (PWR_LED(ctrl))
462 pciehp_green_led_off(p_slot);
463 break;
464 case INT_PRESENCE_ON:
465 case INT_PRESENCE_OFF:
466 if (!HP_SUPR_RM(ctrl))
467 break;
468 ctrl_dbg(ctrl, "Surprise Removal\n");
469 handle_surprise_event(p_slot);
470 break;
471 default:
472 break;
473 }
474 mutex_unlock(&p_slot->lock);
475
476 kfree(info);
477}
478
479int pciehp_enable_slot(struct slot *p_slot)
480{
481 u8 getstatus = 0;
482 int rc;
483 struct controller *ctrl = p_slot->ctrl;
484
485 rc = pciehp_get_adapter_status(p_slot, &getstatus);
486 if (rc || !getstatus) {
487 ctrl_info(ctrl, "No adapter on slot(%s)\n", slot_name(p_slot));
488 return -ENODEV;
489 }
490 if (MRL_SENS(p_slot->ctrl)) {
491 rc = pciehp_get_latch_status(p_slot, &getstatus);
492 if (rc || getstatus) {
493 ctrl_info(ctrl, "Latch open on slot(%s)\n",
494 slot_name(p_slot));
495 return -ENODEV;
496 }
497 }
498
499 if (POWER_CTRL(p_slot->ctrl)) {
500 rc = pciehp_get_power_status(p_slot, &getstatus);
501 if (rc || getstatus) {
502 ctrl_info(ctrl, "Already enabled on slot(%s)\n",
503 slot_name(p_slot));
504 return -EINVAL;
505 }
506 }
507
508 pciehp_get_latch_status(p_slot, &getstatus);
509
510 rc = board_added(p_slot);
511 if (rc) {
512 pciehp_get_latch_status(p_slot, &getstatus);
513 }
514 return rc;
515}
516
517
518int pciehp_disable_slot(struct slot *p_slot)
519{
520 u8 getstatus = 0;
521 int ret = 0;
522 struct controller *ctrl = p_slot->ctrl;
523
524 if (!p_slot->ctrl)
525 return 1;
526
527 if (!HP_SUPR_RM(p_slot->ctrl)) {
528 ret = pciehp_get_adapter_status(p_slot, &getstatus);
529 if (ret || !getstatus) {
530 ctrl_info(ctrl, "No adapter on slot(%s)\n",
531 slot_name(p_slot));
532 return -ENODEV;
533 }
534 }
535
536 if (MRL_SENS(p_slot->ctrl)) {
537 ret = pciehp_get_latch_status(p_slot, &getstatus);
538 if (ret || getstatus) {
539 ctrl_info(ctrl, "Latch open on slot(%s)\n",
540 slot_name(p_slot));
541 return -ENODEV;
542 }
543 }
544
545 if (POWER_CTRL(p_slot->ctrl)) {
546 ret = pciehp_get_power_status(p_slot, &getstatus);
547 if (ret || !getstatus) {
548 ctrl_info(ctrl, "Already disabled on slot(%s)\n",
549 slot_name(p_slot));
550 return -EINVAL;
551 }
552 }
553
554 return remove_board(p_slot);
555}
556
557int pciehp_sysfs_enable_slot(struct slot *p_slot)
558{
559 int retval = -ENODEV;
560 struct controller *ctrl = p_slot->ctrl;
561
562 mutex_lock(&p_slot->lock);
563 switch (p_slot->state) {
564 case BLINKINGON_STATE:
565 cancel_delayed_work(&p_slot->work);
566 case STATIC_STATE:
567 p_slot->state = POWERON_STATE;
568 mutex_unlock(&p_slot->lock);
569 retval = pciehp_enable_slot(p_slot);
570 mutex_lock(&p_slot->lock);
571 p_slot->state = STATIC_STATE;
572 break;
573 case POWERON_STATE:
574 ctrl_info(ctrl, "Slot %s is already in powering on state\n",
575 slot_name(p_slot));
576 break;
577 case BLINKINGOFF_STATE:
578 case POWEROFF_STATE:
579 ctrl_info(ctrl, "Already enabled on slot %s\n",
580 slot_name(p_slot));
581 break;
582 default:
583 ctrl_err(ctrl, "Not a valid state on slot %s\n",
584 slot_name(p_slot));
585 break;
586 }
587 mutex_unlock(&p_slot->lock);
588
589 return retval;
590}
591
592int pciehp_sysfs_disable_slot(struct slot *p_slot)
593{
594 int retval = -ENODEV;
595 struct controller *ctrl = p_slot->ctrl;
596
597 mutex_lock(&p_slot->lock);
598 switch (p_slot->state) {
599 case BLINKINGOFF_STATE:
600 cancel_delayed_work(&p_slot->work);
601 case STATIC_STATE:
602 p_slot->state = POWEROFF_STATE;
603 mutex_unlock(&p_slot->lock);
604 retval = pciehp_disable_slot(p_slot);
605 mutex_lock(&p_slot->lock);
606 p_slot->state = STATIC_STATE;
607 break;
608 case POWEROFF_STATE:
609 ctrl_info(ctrl, "Slot %s is already in powering off state\n",
610 slot_name(p_slot));
611 break;
612 case BLINKINGON_STATE:
613 case POWERON_STATE:
614 ctrl_info(ctrl, "Already disabled on slot %s\n",
615 slot_name(p_slot));
616 break;
617 default:
618 ctrl_err(ctrl, "Not a valid state on slot %s\n",
619 slot_name(p_slot));
620 break;
621 }
622 mutex_unlock(&p_slot->lock);
623
624 return retval;
625}
1// SPDX-License-Identifier: GPL-2.0+
2/*
3 * PCI Express Hot Plug Controller Driver
4 *
5 * Copyright (C) 1995,2001 Compaq Computer Corporation
6 * Copyright (C) 2001 Greg Kroah-Hartman (greg@kroah.com)
7 * Copyright (C) 2001 IBM Corp.
8 * Copyright (C) 2003-2004 Intel Corporation
9 *
10 * All rights reserved.
11 *
12 * Send feedback to <greg@kroah.com>, <kristen.c.accardi@intel.com>
13 *
14 */
15
16#define dev_fmt(fmt) "pciehp: " fmt
17
18#include <linux/kernel.h>
19#include <linux/types.h>
20#include <linux/pm_runtime.h>
21#include <linux/pci.h>
22
23#include "../pci.h"
24#include "pciehp.h"
25
26/* The following routines constitute the bulk of the
27 hotplug controller logic
28 */
29
30#define SAFE_REMOVAL true
31#define SURPRISE_REMOVAL false
32
33static void set_slot_off(struct controller *ctrl)
34{
35 /*
36 * Turn off slot, turn on attention indicator, turn off power
37 * indicator
38 */
39 if (POWER_CTRL(ctrl)) {
40 pciehp_power_off_slot(ctrl);
41
42 /*
43 * After turning power off, we must wait for at least 1 second
44 * before taking any action that relies on power having been
45 * removed from the slot/adapter.
46 */
47 msleep(1000);
48 }
49
50 pciehp_set_indicators(ctrl, PCI_EXP_SLTCTL_PWR_IND_OFF,
51 PCI_EXP_SLTCTL_ATTN_IND_ON);
52}
53
54/**
55 * board_added - Called after a board has been added to the system.
56 * @ctrl: PCIe hotplug controller where board is added
57 *
58 * Turns power on for the board.
59 * Configures board.
60 */
61static int board_added(struct controller *ctrl)
62{
63 int retval = 0;
64 struct pci_bus *parent = ctrl->pcie->port->subordinate;
65
66 if (POWER_CTRL(ctrl)) {
67 /* Power on slot */
68 retval = pciehp_power_on_slot(ctrl);
69 if (retval)
70 return retval;
71 }
72
73 pciehp_set_indicators(ctrl, PCI_EXP_SLTCTL_PWR_IND_BLINK,
74 INDICATOR_NOOP);
75
76 /* Check link training status */
77 retval = pciehp_check_link_status(ctrl);
78 if (retval)
79 goto err_exit;
80
81 /* Check for a power fault */
82 if (ctrl->power_fault_detected || pciehp_query_power_fault(ctrl)) {
83 ctrl_err(ctrl, "Slot(%s): Power fault\n", slot_name(ctrl));
84 retval = -EIO;
85 goto err_exit;
86 }
87
88 retval = pciehp_configure_device(ctrl);
89 if (retval) {
90 if (retval != -EEXIST) {
91 ctrl_err(ctrl, "Cannot add device at %04x:%02x:00\n",
92 pci_domain_nr(parent), parent->number);
93 goto err_exit;
94 }
95 }
96
97 pciehp_set_indicators(ctrl, PCI_EXP_SLTCTL_PWR_IND_ON,
98 PCI_EXP_SLTCTL_ATTN_IND_OFF);
99 return 0;
100
101err_exit:
102 set_slot_off(ctrl);
103 return retval;
104}
105
106/**
107 * remove_board - Turn off slot and Power Indicator
108 * @ctrl: PCIe hotplug controller where board is being removed
109 * @safe_removal: whether the board is safely removed (versus surprise removed)
110 */
111static void remove_board(struct controller *ctrl, bool safe_removal)
112{
113 pciehp_unconfigure_device(ctrl, safe_removal);
114
115 if (POWER_CTRL(ctrl)) {
116 pciehp_power_off_slot(ctrl);
117
118 /*
119 * After turning power off, we must wait for at least 1 second
120 * before taking any action that relies on power having been
121 * removed from the slot/adapter.
122 */
123 msleep(1000);
124
125 /* Ignore link or presence changes caused by power off */
126 atomic_and(~(PCI_EXP_SLTSTA_DLLSC | PCI_EXP_SLTSTA_PDC),
127 &ctrl->pending_events);
128 }
129
130 pciehp_set_indicators(ctrl, PCI_EXP_SLTCTL_PWR_IND_OFF,
131 INDICATOR_NOOP);
132
133 /* Don't carry LBMS indications across */
134 pcie_reset_lbms_count(ctrl->pcie->port);
135}
136
137static int pciehp_enable_slot(struct controller *ctrl);
138static int pciehp_disable_slot(struct controller *ctrl, bool safe_removal);
139
140void pciehp_request(struct controller *ctrl, int action)
141{
142 atomic_or(action, &ctrl->pending_events);
143 if (!pciehp_poll_mode)
144 irq_wake_thread(ctrl->pcie->irq, ctrl);
145}
146
147void pciehp_queue_pushbutton_work(struct work_struct *work)
148{
149 struct controller *ctrl = container_of(work, struct controller,
150 button_work.work);
151
152 mutex_lock(&ctrl->state_lock);
153 switch (ctrl->state) {
154 case BLINKINGOFF_STATE:
155 pciehp_request(ctrl, DISABLE_SLOT);
156 break;
157 case BLINKINGON_STATE:
158 pciehp_request(ctrl, PCI_EXP_SLTSTA_PDC);
159 break;
160 default:
161 break;
162 }
163 mutex_unlock(&ctrl->state_lock);
164}
165
166void pciehp_handle_button_press(struct controller *ctrl)
167{
168 mutex_lock(&ctrl->state_lock);
169 switch (ctrl->state) {
170 case OFF_STATE:
171 case ON_STATE:
172 if (ctrl->state == ON_STATE) {
173 ctrl->state = BLINKINGOFF_STATE;
174 ctrl_info(ctrl, "Slot(%s): Button press: will power off in 5 sec\n",
175 slot_name(ctrl));
176 } else {
177 ctrl->state = BLINKINGON_STATE;
178 ctrl_info(ctrl, "Slot(%s): Button press: will power on in 5 sec\n",
179 slot_name(ctrl));
180 }
181 /* blink power indicator and turn off attention */
182 pciehp_set_indicators(ctrl, PCI_EXP_SLTCTL_PWR_IND_BLINK,
183 PCI_EXP_SLTCTL_ATTN_IND_OFF);
184 schedule_delayed_work(&ctrl->button_work, 5 * HZ);
185 break;
186 case BLINKINGOFF_STATE:
187 case BLINKINGON_STATE:
188 /*
189 * Cancel if we are still blinking; this means that we
190 * press the attention again before the 5 sec. limit
191 * expires to cancel hot-add or hot-remove
192 */
193 cancel_delayed_work(&ctrl->button_work);
194 if (ctrl->state == BLINKINGOFF_STATE) {
195 ctrl->state = ON_STATE;
196 pciehp_set_indicators(ctrl, PCI_EXP_SLTCTL_PWR_IND_ON,
197 PCI_EXP_SLTCTL_ATTN_IND_OFF);
198 ctrl_info(ctrl, "Slot(%s): Button press: canceling request to power off\n",
199 slot_name(ctrl));
200 } else {
201 ctrl->state = OFF_STATE;
202 pciehp_set_indicators(ctrl, PCI_EXP_SLTCTL_PWR_IND_OFF,
203 PCI_EXP_SLTCTL_ATTN_IND_OFF);
204 ctrl_info(ctrl, "Slot(%s): Button press: canceling request to power on\n",
205 slot_name(ctrl));
206 }
207 break;
208 default:
209 ctrl_err(ctrl, "Slot(%s): Button press: ignoring invalid state %#x\n",
210 slot_name(ctrl), ctrl->state);
211 break;
212 }
213 mutex_unlock(&ctrl->state_lock);
214}
215
216void pciehp_handle_disable_request(struct controller *ctrl)
217{
218 mutex_lock(&ctrl->state_lock);
219 switch (ctrl->state) {
220 case BLINKINGON_STATE:
221 case BLINKINGOFF_STATE:
222 cancel_delayed_work(&ctrl->button_work);
223 break;
224 }
225 ctrl->state = POWEROFF_STATE;
226 mutex_unlock(&ctrl->state_lock);
227
228 ctrl->request_result = pciehp_disable_slot(ctrl, SAFE_REMOVAL);
229}
230
231void pciehp_handle_presence_or_link_change(struct controller *ctrl, u32 events)
232{
233 int present, link_active;
234
235 /*
236 * If the slot is on and presence or link has changed, turn it off.
237 * Even if it's occupied again, we cannot assume the card is the same.
238 */
239 mutex_lock(&ctrl->state_lock);
240 switch (ctrl->state) {
241 case BLINKINGOFF_STATE:
242 cancel_delayed_work(&ctrl->button_work);
243 fallthrough;
244 case ON_STATE:
245 ctrl->state = POWEROFF_STATE;
246 mutex_unlock(&ctrl->state_lock);
247 if (events & PCI_EXP_SLTSTA_DLLSC)
248 ctrl_info(ctrl, "Slot(%s): Link Down\n",
249 slot_name(ctrl));
250 if (events & PCI_EXP_SLTSTA_PDC)
251 ctrl_info(ctrl, "Slot(%s): Card not present\n",
252 slot_name(ctrl));
253 pciehp_disable_slot(ctrl, SURPRISE_REMOVAL);
254 break;
255 default:
256 mutex_unlock(&ctrl->state_lock);
257 break;
258 }
259
260 /* Turn the slot on if it's occupied or link is up */
261 mutex_lock(&ctrl->state_lock);
262 present = pciehp_card_present(ctrl);
263 link_active = pciehp_check_link_active(ctrl);
264 if (present <= 0 && link_active <= 0) {
265 if (ctrl->state == BLINKINGON_STATE) {
266 ctrl->state = OFF_STATE;
267 cancel_delayed_work(&ctrl->button_work);
268 pciehp_set_indicators(ctrl, PCI_EXP_SLTCTL_PWR_IND_OFF,
269 INDICATOR_NOOP);
270 ctrl_info(ctrl, "Slot(%s): Card not present\n",
271 slot_name(ctrl));
272 }
273 mutex_unlock(&ctrl->state_lock);
274 return;
275 }
276
277 switch (ctrl->state) {
278 case BLINKINGON_STATE:
279 cancel_delayed_work(&ctrl->button_work);
280 fallthrough;
281 case OFF_STATE:
282 ctrl->state = POWERON_STATE;
283 mutex_unlock(&ctrl->state_lock);
284 if (present)
285 ctrl_info(ctrl, "Slot(%s): Card present\n",
286 slot_name(ctrl));
287 if (link_active)
288 ctrl_info(ctrl, "Slot(%s): Link Up\n",
289 slot_name(ctrl));
290 ctrl->request_result = pciehp_enable_slot(ctrl);
291 break;
292 default:
293 mutex_unlock(&ctrl->state_lock);
294 break;
295 }
296}
297
298static int __pciehp_enable_slot(struct controller *ctrl)
299{
300 u8 getstatus = 0;
301
302 if (MRL_SENS(ctrl)) {
303 pciehp_get_latch_status(ctrl, &getstatus);
304 if (getstatus) {
305 ctrl_info(ctrl, "Slot(%s): Latch open\n",
306 slot_name(ctrl));
307 return -ENODEV;
308 }
309 }
310
311 if (POWER_CTRL(ctrl)) {
312 pciehp_get_power_status(ctrl, &getstatus);
313 if (getstatus) {
314 ctrl_info(ctrl, "Slot(%s): Already enabled\n",
315 slot_name(ctrl));
316 return 0;
317 }
318 }
319
320 return board_added(ctrl);
321}
322
323static int pciehp_enable_slot(struct controller *ctrl)
324{
325 int ret;
326
327 pm_runtime_get_sync(&ctrl->pcie->port->dev);
328 ret = __pciehp_enable_slot(ctrl);
329 if (ret && ATTN_BUTTN(ctrl))
330 /* may be blinking */
331 pciehp_set_indicators(ctrl, PCI_EXP_SLTCTL_PWR_IND_OFF,
332 INDICATOR_NOOP);
333 pm_runtime_put(&ctrl->pcie->port->dev);
334
335 mutex_lock(&ctrl->state_lock);
336 ctrl->state = ret ? OFF_STATE : ON_STATE;
337 mutex_unlock(&ctrl->state_lock);
338
339 return ret;
340}
341
342static int __pciehp_disable_slot(struct controller *ctrl, bool safe_removal)
343{
344 u8 getstatus = 0;
345
346 if (POWER_CTRL(ctrl)) {
347 pciehp_get_power_status(ctrl, &getstatus);
348 if (!getstatus) {
349 ctrl_info(ctrl, "Slot(%s): Already disabled\n",
350 slot_name(ctrl));
351 return -EINVAL;
352 }
353 }
354
355 remove_board(ctrl, safe_removal);
356 return 0;
357}
358
359static int pciehp_disable_slot(struct controller *ctrl, bool safe_removal)
360{
361 int ret;
362
363 pm_runtime_get_sync(&ctrl->pcie->port->dev);
364 ret = __pciehp_disable_slot(ctrl, safe_removal);
365 pm_runtime_put(&ctrl->pcie->port->dev);
366
367 mutex_lock(&ctrl->state_lock);
368 ctrl->state = OFF_STATE;
369 mutex_unlock(&ctrl->state_lock);
370
371 return ret;
372}
373
374int pciehp_sysfs_enable_slot(struct hotplug_slot *hotplug_slot)
375{
376 struct controller *ctrl = to_ctrl(hotplug_slot);
377
378 mutex_lock(&ctrl->state_lock);
379 switch (ctrl->state) {
380 case BLINKINGON_STATE:
381 case OFF_STATE:
382 mutex_unlock(&ctrl->state_lock);
383 /*
384 * The IRQ thread becomes a no-op if the user pulls out the
385 * card before the thread wakes up, so initialize to -ENODEV.
386 */
387 ctrl->request_result = -ENODEV;
388 pciehp_request(ctrl, PCI_EXP_SLTSTA_PDC);
389 wait_event(ctrl->requester,
390 !atomic_read(&ctrl->pending_events) &&
391 !ctrl->ist_running);
392 return ctrl->request_result;
393 case POWERON_STATE:
394 ctrl_info(ctrl, "Slot(%s): Already in powering on state\n",
395 slot_name(ctrl));
396 break;
397 case BLINKINGOFF_STATE:
398 case ON_STATE:
399 case POWEROFF_STATE:
400 ctrl_info(ctrl, "Slot(%s): Already enabled\n",
401 slot_name(ctrl));
402 break;
403 default:
404 ctrl_err(ctrl, "Slot(%s): Invalid state %#x\n",
405 slot_name(ctrl), ctrl->state);
406 break;
407 }
408 mutex_unlock(&ctrl->state_lock);
409
410 return -ENODEV;
411}
412
413int pciehp_sysfs_disable_slot(struct hotplug_slot *hotplug_slot)
414{
415 struct controller *ctrl = to_ctrl(hotplug_slot);
416
417 mutex_lock(&ctrl->state_lock);
418 switch (ctrl->state) {
419 case BLINKINGOFF_STATE:
420 case ON_STATE:
421 mutex_unlock(&ctrl->state_lock);
422 pciehp_request(ctrl, DISABLE_SLOT);
423 wait_event(ctrl->requester,
424 !atomic_read(&ctrl->pending_events) &&
425 !ctrl->ist_running);
426 return ctrl->request_result;
427 case POWEROFF_STATE:
428 ctrl_info(ctrl, "Slot(%s): Already in powering off state\n",
429 slot_name(ctrl));
430 break;
431 case BLINKINGON_STATE:
432 case OFF_STATE:
433 case POWERON_STATE:
434 ctrl_info(ctrl, "Slot(%s): Already disabled\n",
435 slot_name(ctrl));
436 break;
437 default:
438 ctrl_err(ctrl, "Slot(%s): Invalid state %#x\n",
439 slot_name(ctrl), ctrl->state);
440 break;
441 }
442 mutex_unlock(&ctrl->state_lock);
443
444 return -ENODEV;
445}