]> git.proxmox.com Git - mirror_ubuntu-zesty-kernel.git/blame - drivers/pci/hotplug/shpchp_ctrl.c
PCI: shcphp: remove 'name' parameter
[mirror_ubuntu-zesty-kernel.git] / drivers / pci / hotplug / shpchp_ctrl.c
CommitLineData
1da177e4
LT
1/*
2 * Standard 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 *
8cf4c195 26 * Send feedback to <greg@kroah.com>, <kristen.c.accardi@intel.com>
1da177e4
LT
27 *
28 */
29
1da177e4
LT
30#include <linux/module.h>
31#include <linux/kernel.h>
32#include <linux/types.h>
1da177e4 33#include <linux/pci.h>
f7391f53 34#include <linux/workqueue.h>
dbd7a788 35#include "../pci.h"
1da177e4 36#include "shpchp.h"
1da177e4 37
c4028958 38static void interrupt_event_handler(struct work_struct *work);
a246fa4e
KK
39static int shpchp_enable_slot(struct slot *p_slot);
40static int shpchp_disable_slot(struct slot *p_slot);
1da177e4 41
f7391f53
KK
42static int queue_interrupt_event(struct slot *p_slot, u32 event_type)
43{
44 struct event_info *info;
45
46 info = kmalloc(sizeof(*info), GFP_ATOMIC);
47 if (!info)
48 return -ENOMEM;
49
50 info->event_type = event_type;
51 info->p_slot = p_slot;
c4028958 52 INIT_WORK(&info->work, interrupt_event_handler);
f7391f53 53
a246fa4e 54 schedule_work(&info->work);
f7391f53
KK
55
56 return 0;
57}
1da177e4 58
0abe68ce 59u8 shpchp_handle_attention_button(u8 hp_slot, struct controller *ctrl)
1da177e4 60{
1da177e4 61 struct slot *p_slot;
f7391f53 62 u32 event_type;
1da177e4
LT
63
64 /* Attention Button Change */
65 dbg("shpchp: Attention button interrupt received.\n");
9f593e30 66
1da177e4 67 p_slot = shpchp_find_slot(ctrl, hp_slot + ctrl->slot_device_offset);
2178bfad 68 p_slot->hpc_ops->get_adapter_status(p_slot, &(p_slot->presence_save));
1da177e4
LT
69
70 /*
71 * Button pressed - See if need to TAKE ACTION!!!
72 */
66f17055 73 info("Button pressed on Slot(%s)\n", slot_name(p_slot));
f7391f53 74 event_type = INT_BUTTON_PRESS;
1da177e4 75
f7391f53 76 queue_interrupt_event(p_slot, event_type);
1da177e4
LT
77
78 return 0;
79
80}
81
0abe68ce 82u8 shpchp_handle_switch_change(u8 hp_slot, struct controller *ctrl)
1da177e4 83{
1da177e4 84 struct slot *p_slot;
1da177e4 85 u8 getstatus;
f7391f53 86 u32 event_type;
1da177e4
LT
87
88 /* Switch Change */
89 dbg("shpchp: Switch interrupt received.\n");
90
1da177e4 91 p_slot = shpchp_find_slot(ctrl, hp_slot + ctrl->slot_device_offset);
2178bfad 92 p_slot->hpc_ops->get_adapter_status(p_slot, &(p_slot->presence_save));
1da177e4 93 p_slot->hpc_ops->get_latch_status(p_slot, &getstatus);
66bef8c0 94 dbg("%s: Card present %x Power status %x\n", __func__,
2178bfad 95 p_slot->presence_save, p_slot->pwr_save);
1da177e4
LT
96
97 if (getstatus) {
98 /*
99 * Switch opened
100 */
66f17055 101 info("Latch open on Slot(%s)\n", slot_name(p_slot));
f7391f53 102 event_type = INT_SWITCH_OPEN;
2178bfad 103 if (p_slot->pwr_save && p_slot->presence_save) {
f7391f53 104 event_type = INT_POWER_FAULT;
1da177e4
LT
105 err("Surprise Removal of card\n");
106 }
107 } else {
108 /*
109 * Switch closed
110 */
66f17055 111 info("Latch close on Slot(%s)\n", slot_name(p_slot));
f7391f53 112 event_type = INT_SWITCH_CLOSE;
1da177e4
LT
113 }
114
f7391f53 115 queue_interrupt_event(p_slot, event_type);
1da177e4 116
f7391f53 117 return 1;
1da177e4
LT
118}
119
0abe68ce 120u8 shpchp_handle_presence_change(u8 hp_slot, struct controller *ctrl)
1da177e4 121{
1da177e4 122 struct slot *p_slot;
f7391f53 123 u32 event_type;
1da177e4
LT
124
125 /* Presence Change */
126 dbg("shpchp: Presence/Notify input change.\n");
127
1da177e4
LT
128 p_slot = shpchp_find_slot(ctrl, hp_slot + ctrl->slot_device_offset);
129
9f593e30 130 /*
1da177e4
LT
131 * Save the presence state
132 */
2178bfad
RS
133 p_slot->hpc_ops->get_adapter_status(p_slot, &(p_slot->presence_save));
134 if (p_slot->presence_save) {
1da177e4
LT
135 /*
136 * Card Present
137 */
66f17055 138 info("Card present on Slot(%s)\n", slot_name(p_slot));
f7391f53 139 event_type = INT_PRESENCE_ON;
1da177e4
LT
140 } else {
141 /*
142 * Not Present
143 */
66f17055 144 info("Card not present on Slot(%s)\n", slot_name(p_slot));
f7391f53 145 event_type = INT_PRESENCE_OFF;
1da177e4
LT
146 }
147
f7391f53 148 queue_interrupt_event(p_slot, event_type);
1da177e4 149
f7391f53 150 return 1;
1da177e4
LT
151}
152
0abe68ce 153u8 shpchp_handle_power_fault(u8 hp_slot, struct controller *ctrl)
1da177e4 154{
1da177e4 155 struct slot *p_slot;
f7391f53 156 u32 event_type;
1da177e4
LT
157
158 /* Power fault */
159 dbg("shpchp: Power fault interrupt received.\n");
160
1da177e4
LT
161 p_slot = shpchp_find_slot(ctrl, hp_slot + ctrl->slot_device_offset);
162
163 if ( !(p_slot->hpc_ops->query_power_fault(p_slot))) {
164 /*
165 * Power fault Cleared
166 */
66f17055 167 info("Power fault cleared on Slot(%s)\n", slot_name(p_slot));
2178bfad 168 p_slot->status = 0x00;
f7391f53 169 event_type = INT_POWER_FAULT_CLEAR;
1da177e4
LT
170 } else {
171 /*
172 * Power fault
173 */
66f17055 174 info("Power fault on Slot(%s)\n", slot_name(p_slot));
f7391f53 175 event_type = INT_POWER_FAULT;
1da177e4 176 /* set power fault status for this board */
2178bfad 177 p_slot->status = 0xFF;
1da177e4
LT
178 info("power fault bit %x set\n", hp_slot);
179 }
1da177e4 180
f7391f53
KK
181 queue_interrupt_event(p_slot, event_type);
182
183 return 1;
1da177e4
LT
184}
185
9f593e30 186/* The following routines constitute the bulk of the
1da177e4
LT
187 hotplug controller logic
188 */
ee138334
RS
189static int change_bus_speed(struct controller *ctrl, struct slot *p_slot,
190 enum pci_bus_speed speed)
9f593e30 191{
ee138334 192 int rc = 0;
1da177e4 193
66bef8c0 194 dbg("%s: change to speed %d\n", __func__, speed);
1da177e4 195 if ((rc = p_slot->hpc_ops->set_bus_speed_mode(p_slot, speed))) {
0afabe90 196 err("%s: Issue of set bus speed mode command failed\n",
66bef8c0 197 __func__);
1da177e4
LT
198 return WRONG_BUS_FREQUENCY;
199 }
1da177e4
LT
200 return rc;
201}
202
ee138334
RS
203static int fix_bus_speed(struct controller *ctrl, struct slot *pslot,
204 u8 flag, enum pci_bus_speed asp, enum pci_bus_speed bsp,
205 enum pci_bus_speed msp)
9f593e30 206{
ee138334 207 int rc = 0;
0afabe90
KK
208
209 /*
210 * If other slots on the same bus are occupied, we cannot
211 * change the bus speed.
212 */
213 if (flag) {
214 if (asp < bsp) {
215 err("%s: speed of bus %x and adapter %x mismatch\n",
66bef8c0 216 __func__, bsp, asp);
0afabe90 217 rc = WRONG_BUS_FREQUENCY;
1da177e4 218 }
0afabe90
KK
219 return rc;
220 }
221
222 if (asp < msp) {
223 if (bsp != asp)
224 rc = change_bus_speed(ctrl, pslot, asp);
1da177e4 225 } else {
0afabe90
KK
226 if (bsp != msp)
227 rc = change_bus_speed(ctrl, pslot, msp);
1da177e4
LT
228 }
229 return rc;
230}
231
232/**
233 * board_added - Called after a board has been added to the system.
26e6c66e 234 * @p_slot: target &slot
1da177e4 235 *
26e6c66e
RD
236 * Turns power on for the board.
237 * Configures board.
1da177e4 238 */
ee138334 239static int board_added(struct slot *p_slot)
1da177e4
LT
240{
241 u8 hp_slot;
242 u8 slots_not_empty = 0;
ee138334 243 int rc = 0;
0afabe90 244 enum pci_bus_speed asp, bsp, msp;
2178bfad 245 struct controller *ctrl = p_slot->ctrl;
1da177e4 246
2178bfad 247 hp_slot = p_slot->device - ctrl->slot_device_offset;
1da177e4 248
2178bfad 249 dbg("%s: p_slot->device, slot_offset, hp_slot = %d, %d ,%d\n",
66bef8c0 250 __func__, p_slot->device,
2178bfad 251 ctrl->slot_device_offset, hp_slot);
1da177e4 252
1da177e4
LT
253 /* Power on slot without connecting to bus */
254 rc = p_slot->hpc_ops->power_on_slot(p_slot);
255 if (rc) {
66bef8c0 256 err("%s: Failed to power on slot\n", __func__);
1da177e4
LT
257 return -1;
258 }
9f593e30 259
1da177e4
LT
260 if ((ctrl->pci_dev->vendor == 0x8086) && (ctrl->pci_dev->device == 0x0332)) {
261 if (slots_not_empty)
262 return WRONG_BUS_FREQUENCY;
9f593e30 263
1da177e4 264 if ((rc = p_slot->hpc_ops->set_bus_speed_mode(p_slot, PCI_SPEED_33MHz))) {
66bef8c0 265 err("%s: Issue of set bus speed mode command failed\n", __func__);
1da177e4
LT
266 return WRONG_BUS_FREQUENCY;
267 }
9f593e30 268
1da177e4
LT
269 /* turn on board, blink green LED, turn off Amber LED */
270 if ((rc = p_slot->hpc_ops->slot_enable(p_slot))) {
66bef8c0 271 err("%s: Issue of Slot Enable command failed\n", __func__);
1da177e4
LT
272 return rc;
273 }
1da177e4 274 }
9f593e30 275
0afabe90
KK
276 rc = p_slot->hpc_ops->get_adapter_speed(p_slot, &asp);
277 if (rc) {
278 err("%s: Can't get adapter speed or bus mode mismatch\n",
66bef8c0 279 __func__);
1da177e4
LT
280 return WRONG_BUS_FREQUENCY;
281 }
282
0afabe90
KK
283 rc = p_slot->hpc_ops->get_cur_bus_speed(p_slot, &bsp);
284 if (rc) {
66bef8c0 285 err("%s: Can't get bus operation speed\n", __func__);
1da177e4
LT
286 return WRONG_BUS_FREQUENCY;
287 }
288
0afabe90
KK
289 rc = p_slot->hpc_ops->get_max_bus_speed(p_slot, &msp);
290 if (rc) {
66bef8c0 291 err("%s: Can't get max bus operation speed\n", __func__);
0afabe90 292 msp = bsp;
1da177e4
LT
293 }
294
295 /* Check if there are other slots or devices on the same bus */
296 if (!list_empty(&ctrl->pci_dev->subordinate->devices))
297 slots_not_empty = 1;
298
0afabe90 299 dbg("%s: slots_not_empty %d, adapter_speed %d, bus_speed %d, "
66bef8c0 300 "max_bus_speed %d\n", __func__, slots_not_empty, asp,
0afabe90 301 bsp, msp);
1da177e4 302
0afabe90
KK
303 rc = fix_bus_speed(ctrl, p_slot, slots_not_empty, asp, bsp, msp);
304 if (rc)
305 return rc;
1da177e4 306
1da177e4
LT
307 /* turn on board, blink green LED, turn off Amber LED */
308 if ((rc = p_slot->hpc_ops->slot_enable(p_slot))) {
66bef8c0 309 err("%s: Issue of Slot Enable command failed\n", __func__);
1da177e4
LT
310 return rc;
311 }
1da177e4 312
1da177e4 313 /* Wait for ~1 second */
68c0b671 314 msleep(1000);
1da177e4 315
66bef8c0 316 dbg("%s: slot status = %x\n", __func__, p_slot->status);
1da177e4 317 /* Check for a power fault */
2178bfad 318 if (p_slot->status == 0xFF) {
1da177e4 319 /* power fault occurred, but it was benign */
66bef8c0 320 dbg("%s: power fault\n", __func__);
1da177e4 321 rc = POWER_FAILURE;
2178bfad 322 p_slot->status = 0;
dbd7a788 323 goto err_exit;
1da177e4
LT
324 }
325
dbd7a788
RS
326 if (shpchp_configure_device(p_slot)) {
327 err("Cannot add device at 0x%x:0x%x\n", p_slot->bus,
328 p_slot->device);
329 goto err_exit;
330 }
1da177e4 331
2178bfad
RS
332 p_slot->status = 0;
333 p_slot->is_a_board = 0x01;
334 p_slot->pwr_save = 1;
1da177e4 335
dbd7a788 336 p_slot->hpc_ops->green_led_on(p_slot);
1da177e4 337
dbd7a788 338 return 0;
1da177e4 339
dbd7a788 340err_exit:
dbd7a788
RS
341 /* turn off slot, turn on Amber LED, turn off Green LED */
342 rc = p_slot->hpc_ops->slot_disable(p_slot);
343 if (rc) {
66bef8c0 344 err("%s: Issue of Slot Disable command failed\n", __func__);
dbd7a788
RS
345 return rc;
346 }
1da177e4 347
dbd7a788 348 return(rc);
1da177e4
LT
349}
350
351
352/**
26e6c66e
RD
353 * remove_board - Turns off slot and LEDs
354 * @p_slot: target &slot
1da177e4 355 */
ee138334 356static int remove_board(struct slot *p_slot)
1da177e4 357{
2178bfad 358 struct controller *ctrl = p_slot->ctrl;
1da177e4 359 u8 hp_slot;
ee138334 360 int rc;
70b60919 361
2178bfad 362 if (shpchp_unconfigure_device(p_slot))
1da177e4
LT
363 return(1);
364
2178bfad 365 hp_slot = p_slot->device - ctrl->slot_device_offset;
1da177e4
LT
366 p_slot = shpchp_find_slot(ctrl, hp_slot + ctrl->slot_device_offset);
367
66bef8c0 368 dbg("In %s, hp_slot = %d\n", __func__, hp_slot);
1da177e4 369
1da177e4 370 /* Change status to shutdown */
2178bfad
RS
371 if (p_slot->is_a_board)
372 p_slot->status = 0x01;
1da177e4 373
1da177e4
LT
374 /* turn off slot, turn on Amber LED, turn off Green LED */
375 rc = p_slot->hpc_ops->slot_disable(p_slot);
376 if (rc) {
66bef8c0 377 err("%s: Issue of Slot Disable command failed\n", __func__);
1da177e4
LT
378 return rc;
379 }
9f593e30 380
1da177e4
LT
381 rc = p_slot->hpc_ops->set_attention_status(p_slot, 0);
382 if (rc) {
66bef8c0 383 err("%s: Issue of Set Attention command failed\n", __func__);
1da177e4
LT
384 return rc;
385 }
1da177e4 386
2178bfad
RS
387 p_slot->pwr_save = 0;
388 p_slot->is_a_board = 0;
1da177e4
LT
389
390 return 0;
391}
392
393
a246fa4e
KK
394struct pushbutton_work_info {
395 struct slot *p_slot;
396 struct work_struct work;
397};
398
1da177e4 399/**
26e6c66e
RD
400 * shpchp_pushbutton_thread - handle pushbutton events
401 * @work: &struct work_struct to be handled
1da177e4 402 *
26e6c66e 403 * Scheduled procedure to handle blocking stuff for the pushbuttons.
1da177e4 404 * Handles all pending events and exits.
1da177e4 405 */
c4028958 406static void shpchp_pushbutton_thread(struct work_struct *work)
1da177e4 407{
c4028958
DH
408 struct pushbutton_work_info *info =
409 container_of(work, struct pushbutton_work_info, work);
a246fa4e 410 struct slot *p_slot = info->p_slot;
1da177e4 411
a246fa4e
KK
412 mutex_lock(&p_slot->lock);
413 switch (p_slot->state) {
414 case POWEROFF_STATE:
415 mutex_unlock(&p_slot->lock);
1da177e4 416 shpchp_disable_slot(p_slot);
a246fa4e 417 mutex_lock(&p_slot->lock);
1da177e4 418 p_slot->state = STATIC_STATE;
a246fa4e
KK
419 break;
420 case POWERON_STATE:
421 mutex_unlock(&p_slot->lock);
d29aadda 422 if (shpchp_enable_slot(p_slot))
1da177e4 423 p_slot->hpc_ops->green_led_off(p_slot);
a246fa4e 424 mutex_lock(&p_slot->lock);
1da177e4 425 p_slot->state = STATIC_STATE;
a246fa4e
KK
426 break;
427 default:
428 break;
429 }
430 mutex_unlock(&p_slot->lock);
431
432 kfree(info);
433}
434
e325e1f0 435void shpchp_queue_pushbutton_work(struct work_struct *work)
a246fa4e 436{
c4028958 437 struct slot *p_slot = container_of(work, struct slot, work.work);
a246fa4e
KK
438 struct pushbutton_work_info *info;
439
440 info = kmalloc(sizeof(*info), GFP_KERNEL);
441 if (!info) {
66bef8c0 442 err("%s: Cannot allocate memory\n", __func__);
a246fa4e
KK
443 return;
444 }
445 info->p_slot = p_slot;
c4028958 446 INIT_WORK(&info->work, shpchp_pushbutton_thread);
a246fa4e
KK
447
448 mutex_lock(&p_slot->lock);
449 switch (p_slot->state) {
450 case BLINKINGOFF_STATE:
451 p_slot->state = POWEROFF_STATE;
452 break;
453 case BLINKINGON_STATE:
454 p_slot->state = POWERON_STATE;
455 break;
456 default:
457 goto out;
1da177e4 458 }
a246fa4e
KK
459 queue_work(shpchp_wq, &info->work);
460 out:
461 mutex_unlock(&p_slot->lock);
1da177e4
LT
462}
463
1da177e4
LT
464static int update_slot_info (struct slot *slot)
465{
466 struct hotplug_slot_info *info;
467 int result;
468
469 info = kmalloc(sizeof(*info), GFP_KERNEL);
470 if (!info)
471 return -ENOMEM;
472
473 slot->hpc_ops->get_power_status(slot, &(info->power_status));
474 slot->hpc_ops->get_attention_status(slot, &(info->attention_status));
475 slot->hpc_ops->get_latch_status(slot, &(info->latch_status));
476 slot->hpc_ops->get_adapter_status(slot, &(info->adapter_status));
477
478 result = pci_hp_change_slot_info(slot->hotplug_slot, info);
479 kfree (info);
480 return result;
481}
482
a246fa4e
KK
483/*
484 * Note: This function must be called with slot->lock held
485 */
486static void handle_button_press_event(struct slot *p_slot)
1da177e4 487{
1da177e4 488 u8 getstatus;
1da177e4 489
a246fa4e
KK
490 switch (p_slot->state) {
491 case STATIC_STATE:
f7391f53
KK
492 p_slot->hpc_ops->get_power_status(p_slot, &getstatus);
493 if (getstatus) {
494 p_slot->state = BLINKINGOFF_STATE;
8352e04e 495 info("PCI slot #%s - powering off due to button "
66f17055 496 "press.\n", slot_name(p_slot));
f7391f53
KK
497 } else {
498 p_slot->state = BLINKINGON_STATE;
8352e04e 499 info("PCI slot #%s - powering on due to button "
66f17055 500 "press.\n", slot_name(p_slot));
f7391f53
KK
501 }
502 /* blink green LED and turn off amber */
503 p_slot->hpc_ops->green_led_blink(p_slot);
504 p_slot->hpc_ops->set_attention_status(p_slot, 0);
1da177e4 505
a246fa4e
KK
506 schedule_delayed_work(&p_slot->work, 5*HZ);
507 break;
508 case BLINKINGOFF_STATE:
509 case BLINKINGON_STATE:
510 /*
511 * Cancel if we are still blinking; this means that we
512 * press the attention again before the 5 sec. limit
513 * expires to cancel hot-add or hot-remove
514 */
66f17055 515 info("Button cancel on Slot(%s)\n", slot_name(p_slot));
66bef8c0 516 dbg("%s: button cancel\n", __func__);
a246fa4e
KK
517 cancel_delayed_work(&p_slot->work);
518 if (p_slot->state == BLINKINGOFF_STATE)
519 p_slot->hpc_ops->green_led_on(p_slot);
520 else
521 p_slot->hpc_ops->green_led_off(p_slot);
522 p_slot->hpc_ops->set_attention_status(p_slot, 0);
8352e04e 523 info("PCI slot #%s - action canceled due to button press\n",
66f17055 524 slot_name(p_slot));
a246fa4e
KK
525 p_slot->state = STATIC_STATE;
526 break;
527 case POWEROFF_STATE:
528 case POWERON_STATE:
529 /*
530 * Ignore if the slot is on power-on or power-off state;
531 * this means that the previous attention button action
532 * to hot-add or hot-remove is undergoing
533 */
66f17055 534 info("Button ignore on Slot(%s)\n", slot_name(p_slot));
a246fa4e
KK
535 update_slot_info(p_slot);
536 break;
537 default:
538 warn("Not a valid state\n");
539 break;
540 }
541}
542
c4028958 543static void interrupt_event_handler(struct work_struct *work)
a246fa4e 544{
c4028958 545 struct event_info *info = container_of(work, struct event_info, work);
a246fa4e
KK
546 struct slot *p_slot = info->p_slot;
547
548 mutex_lock(&p_slot->lock);
549 switch (info->event_type) {
550 case INT_BUTTON_PRESS:
551 handle_button_press_event(p_slot);
f7391f53
KK
552 break;
553 case INT_POWER_FAULT:
66bef8c0 554 dbg("%s: power fault\n", __func__);
f7391f53
KK
555 p_slot->hpc_ops->set_attention_status(p_slot, 1);
556 p_slot->hpc_ops->green_led_off(p_slot);
557 break;
558 default:
559 update_slot_info(p_slot);
560 break;
1da177e4 561 }
a246fa4e 562 mutex_unlock(&p_slot->lock);
1da177e4 563
f7391f53 564 kfree(info);
1da177e4
LT
565}
566
567
a246fa4e 568static int shpchp_enable_slot (struct slot *p_slot)
1da177e4
LT
569{
570 u8 getstatus = 0;
ef3be547 571 int rc, retval = -ENODEV;
1da177e4
LT
572
573 /* Check to see if (latch closed, card present, power off) */
6aa4cdd0 574 mutex_lock(&p_slot->ctrl->crit_sect);
1da177e4
LT
575 rc = p_slot->hpc_ops->get_adapter_status(p_slot, &getstatus);
576 if (rc || !getstatus) {
66f17055 577 info("No adapter on slot(%s)\n", slot_name(p_slot));
ef3be547 578 goto out;
1da177e4
LT
579 }
580 rc = p_slot->hpc_ops->get_latch_status(p_slot, &getstatus);
581 if (rc || getstatus) {
66f17055 582 info("Latch open on slot(%s)\n", slot_name(p_slot));
ef3be547 583 goto out;
1da177e4
LT
584 }
585 rc = p_slot->hpc_ops->get_power_status(p_slot, &getstatus);
586 if (rc || getstatus) {
66f17055 587 info("Already enabled on slot(%s)\n", slot_name(p_slot));
ef3be547 588 goto out;
1da177e4 589 }
1da177e4 590
2178bfad 591 p_slot->is_a_board = 1;
1da177e4
LT
592
593 /* We have to save the presence info for these slots */
2178bfad
RS
594 p_slot->hpc_ops->get_adapter_status(p_slot, &(p_slot->presence_save));
595 p_slot->hpc_ops->get_power_status(p_slot, &(p_slot->pwr_save));
66bef8c0 596 dbg("%s: p_slot->pwr_save %x\n", __func__, p_slot->pwr_save);
1da177e4 597 p_slot->hpc_ops->get_latch_status(p_slot, &getstatus);
1da177e4 598
53044f35
KD
599 if(((p_slot->ctrl->pci_dev->vendor == PCI_VENDOR_ID_AMD) ||
600 (p_slot->ctrl->pci_dev->device == PCI_DEVICE_ID_AMD_POGO_7458))
601 && p_slot->ctrl->num_slots == 1) {
602 /* handle amd pogo errata; this must be done before enable */
603 amd_pogo_errata_save_misc_reg(p_slot);
ef3be547 604 retval = board_added(p_slot);
53044f35
KD
605 /* handle amd pogo errata; this must be done after enable */
606 amd_pogo_errata_restore_misc_reg(p_slot);
607 } else
ef3be547 608 retval = board_added(p_slot);
53044f35 609
ef3be547 610 if (retval) {
2178bfad
RS
611 p_slot->hpc_ops->get_adapter_status(p_slot,
612 &(p_slot->presence_save));
1da177e4 613 p_slot->hpc_ops->get_latch_status(p_slot, &getstatus);
1da177e4
LT
614 }
615
2178bfad 616 update_slot_info(p_slot);
ef3be547
KK
617 out:
618 mutex_unlock(&p_slot->ctrl->crit_sect);
619 return retval;
1da177e4
LT
620}
621
622
a246fa4e 623static int shpchp_disable_slot (struct slot *p_slot)
1da177e4 624{
1da177e4 625 u8 getstatus = 0;
ef3be547 626 int rc, retval = -ENODEV;
1da177e4
LT
627
628 if (!p_slot->ctrl)
ee17fd93 629 return -ENODEV;
1da177e4 630
1da177e4 631 /* Check to see if (latch closed, card present, power on) */
6aa4cdd0 632 mutex_lock(&p_slot->ctrl->crit_sect);
1da177e4 633
ef3be547
KK
634 rc = p_slot->hpc_ops->get_adapter_status(p_slot, &getstatus);
635 if (rc || !getstatus) {
66f17055 636 info("No adapter on slot(%s)\n", slot_name(p_slot));
ef3be547 637 goto out;
1da177e4 638 }
ef3be547
KK
639 rc = p_slot->hpc_ops->get_latch_status(p_slot, &getstatus);
640 if (rc || getstatus) {
66f17055 641 info("Latch open on slot(%s)\n", slot_name(p_slot));
ef3be547 642 goto out;
1da177e4 643 }
ef3be547
KK
644 rc = p_slot->hpc_ops->get_power_status(p_slot, &getstatus);
645 if (rc || !getstatus) {
66f17055 646 info("Already disabled slot(%s)\n", slot_name(p_slot));
ef3be547 647 goto out;
1da177e4 648 }
1da177e4 649
ef3be547 650 retval = remove_board(p_slot);
2178bfad 651 update_slot_info(p_slot);
ef3be547
KK
652 out:
653 mutex_unlock(&p_slot->ctrl->crit_sect);
654 return retval;
1da177e4
LT
655}
656
a246fa4e
KK
657int shpchp_sysfs_enable_slot(struct slot *p_slot)
658{
659 int retval = -ENODEV;
660
661 mutex_lock(&p_slot->lock);
662 switch (p_slot->state) {
663 case BLINKINGON_STATE:
664 cancel_delayed_work(&p_slot->work);
665 case STATIC_STATE:
666 p_slot->state = POWERON_STATE;
667 mutex_unlock(&p_slot->lock);
668 retval = shpchp_enable_slot(p_slot);
669 mutex_lock(&p_slot->lock);
670 p_slot->state = STATIC_STATE;
671 break;
672 case POWERON_STATE:
673 info("Slot %s is already in powering on state\n",
66f17055 674 slot_name(p_slot));
a246fa4e
KK
675 break;
676 case BLINKINGOFF_STATE:
677 case POWEROFF_STATE:
66f17055 678 info("Already enabled on slot %s\n", slot_name(p_slot));
a246fa4e
KK
679 break;
680 default:
66f17055 681 err("Not a valid state on slot %s\n", slot_name(p_slot));
a246fa4e
KK
682 break;
683 }
684 mutex_unlock(&p_slot->lock);
685
686 return retval;
687}
688
689int shpchp_sysfs_disable_slot(struct slot *p_slot)
690{
691 int retval = -ENODEV;
692
693 mutex_lock(&p_slot->lock);
694 switch (p_slot->state) {
695 case BLINKINGOFF_STATE:
696 cancel_delayed_work(&p_slot->work);
697 case STATIC_STATE:
698 p_slot->state = POWEROFF_STATE;
699 mutex_unlock(&p_slot->lock);
700 retval = shpchp_disable_slot(p_slot);
701 mutex_lock(&p_slot->lock);
702 p_slot->state = STATIC_STATE;
703 break;
704 case POWEROFF_STATE:
705 info("Slot %s is already in powering off state\n",
66f17055 706 slot_name(p_slot));
a246fa4e
KK
707 break;
708 case BLINKINGON_STATE:
709 case POWERON_STATE:
66f17055 710 info("Already disabled on slot %s\n", slot_name(p_slot));
a246fa4e
KK
711 break;
712 default:
66f17055 713 err("Not a valid state on slot %s\n", slot_name(p_slot));
a246fa4e
KK
714 break;
715 }
716 mutex_unlock(&p_slot->lock);
717
718 return retval;
719}