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