drivers/pci/hotplug/shpchp_ctrl.c

   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/smp_lock.h>
  34 #include <linux/pci.h>
  35 #include "../pci.h"
  36 #include "shpchp.h"
  37
  38 static void interrupt_event_handler(struct controller *ctrl);
  39
  40 static struct semaphore event_semaphore;        /* mutex for process loop (up if something to process) */
  41 static struct semaphore event_exit;             /* guard ensure thread has exited before calling it quits */
  42 static int event_finished;
  43 static unsigned long pushbutton_pending;        /* = 0 */
  44
  45 u8 shpchp_handle_attention_button(u8 hp_slot, void *inst_id)
  46 {
  47         struct controller *ctrl = (struct controller *) inst_id;
  48         struct slot *p_slot;
  49         u8 rc = 0;
  50         u8 getstatus;
  51         struct event_info *taskInfo;
  52
  53         /* Attention Button Change */
  54         dbg("shpchp:  Attention button interrupt received.\n");
  55
  56         /* This is the structure that tells the worker thread what to do */
  57         taskInfo = &(ctrl->event_queue[ctrl->next_event]);
  58         p_slot = shpchp_find_slot(ctrl, hp_slot + ctrl->slot_device_offset);
  59
  60         p_slot->hpc_ops->get_adapter_status(p_slot, &(p_slot->presence_save));
  61         p_slot->hpc_ops->get_latch_status(p_slot, &getstatus);
  62
  63         ctrl->next_event = (ctrl->next_event + 1) % 10;
  64         taskInfo->hp_slot = hp_slot;
  65
  66         rc++;
  67
  68         /*
  69          *  Button pressed - See if need to TAKE ACTION!!!
  70          */
  71         info("Button pressed on Slot(%d)\n", ctrl->first_slot + hp_slot);
  72         taskInfo->event_type = INT_BUTTON_PRESS;
  73
  74         if ((p_slot->state == BLINKINGON_STATE)
  75             || (p_slot->state == BLINKINGOFF_STATE)) {
  76                 /* Cancel if we are still blinking; this means that we press the
  77                  * attention again before the 5 sec. limit expires to cancel hot-add
  78                  * or hot-remove
  79                  */
  80                 taskInfo->event_type = INT_BUTTON_CANCEL;
  81                 info("Button cancel on Slot(%d)\n", ctrl->first_slot + hp_slot);
  82         } else if ((p_slot->state == POWERON_STATE)
  83                    || (p_slot->state == POWEROFF_STATE)) {
  84                 /* Ignore if the slot is on power-on or power-off state; this
  85                  * means that the previous attention button action to hot-add or
  86                  * hot-remove is undergoing
  87                  */
  88                 taskInfo->event_type = INT_BUTTON_IGNORE;
  89                 info("Button ignore on Slot(%d)\n", ctrl->first_slot + hp_slot);
  90         }
  91
  92         if (rc)
  93                 up(&event_semaphore);   /* signal event thread that new event is posted */
  94
  95         return 0;
  96
  97 }
  98
  99 u8 shpchp_handle_switch_change(u8 hp_slot, void *inst_id)
 100 {
 101         struct controller *ctrl = (struct controller *) inst_id;
 102         struct slot *p_slot;
 103         u8 rc = 0;
 104         u8 getstatus;
 105         struct event_info *taskInfo;
 106
 107         /* Switch Change */
 108         dbg("shpchp:  Switch interrupt received.\n");
 109
 110         /* This is the structure that tells the worker thread
 111          * what to do
 112          */
 113         taskInfo = &(ctrl->event_queue[ctrl->next_event]);
 114         ctrl->next_event = (ctrl->next_event + 1) % 10;
 115         taskInfo->hp_slot = hp_slot;
 116
 117         rc++;
 118         p_slot = shpchp_find_slot(ctrl, hp_slot + ctrl->slot_device_offset);
 119         p_slot->hpc_ops->get_adapter_status(p_slot, &(p_slot->presence_save));
 120         p_slot->hpc_ops->get_latch_status(p_slot, &getstatus);
 121         dbg("%s: Card present %x Power status %x\n", __FUNCTION__,
 122                 p_slot->presence_save, p_slot->pwr_save);
 123
 124         if (getstatus) {
 125                 /*
 126                  * Switch opened
 127                  */
 128                 info("Latch open on Slot(%d)\n", ctrl->first_slot + hp_slot);
 129                 taskInfo->event_type = INT_SWITCH_OPEN;
 130                 if (p_slot->pwr_save && p_slot->presence_save) {
 131                         taskInfo->event_type = INT_POWER_FAULT;
 132                         err("Surprise Removal of card\n");
 133                 }
 134         } else {
 135                 /*
 136                  *  Switch closed
 137                  */
 138                 info("Latch close on Slot(%d)\n", ctrl->first_slot + hp_slot);
 139                 taskInfo->event_type = INT_SWITCH_CLOSE;
 140         }
 141
 142         if (rc)
 143                 up(&event_semaphore);   /* signal event thread that new event is posted */
 144
 145         return rc;
 146 }
 147
 148 u8 shpchp_handle_presence_change(u8 hp_slot, void *inst_id)
 149 {
 150         struct controller *ctrl = (struct controller *) inst_id;
 151         struct slot *p_slot;
 152         u8 rc = 0;
 153         /*u8 temp_byte;*/
 154         struct event_info *taskInfo;
 155
 156         /* Presence Change */
 157         dbg("shpchp:  Presence/Notify input change.\n");
 158
 159         /* This is the structure that tells the worker thread
 160          * what to do
 161          */
 162         taskInfo = &(ctrl->event_queue[ctrl->next_event]);
 163         ctrl->next_event = (ctrl->next_event + 1) % 10;
 164         taskInfo->hp_slot = hp_slot;
 165
 166         rc++;
 167         p_slot = shpchp_find_slot(ctrl, hp_slot + ctrl->slot_device_offset);
 168
 169         /*
 170          * Save the presence state
 171          */
 172         p_slot->hpc_ops->get_adapter_status(p_slot, &(p_slot->presence_save));
 173         if (p_slot->presence_save) {
 174                 /*
 175                  * Card Present
 176                  */
 177                 info("Card present on Slot(%d)\n", ctrl->first_slot + hp_slot);
 178                 taskInfo->event_type = INT_PRESENCE_ON;
 179         } else {
 180                 /*
 181                  * Not Present
 182                  */
 183                 info("Card not present on Slot(%d)\n", ctrl->first_slot + hp_slot);
 184                 taskInfo->event_type = INT_PRESENCE_OFF;
 185         }
 186
 187         if (rc)
 188                 up(&event_semaphore);   /* signal event thread that new event is posted */
 189
 190         return rc;
 191 }
 192
 193 u8 shpchp_handle_power_fault(u8 hp_slot, void *inst_id)
 194 {
 195         struct controller *ctrl = (struct controller *) inst_id;
 196         struct slot *p_slot;
 197         u8 rc = 0;
 198         struct event_info *taskInfo;
 199
 200         /* Power fault */
 201         dbg("shpchp:  Power fault interrupt received.\n");
 202
 203         /* This is the structure that tells the worker thread
 204          * what to do
 205          */
 206         taskInfo = &(ctrl->event_queue[ctrl->next_event]);
 207         ctrl->next_event = (ctrl->next_event + 1) % 10;
 208         taskInfo->hp_slot = hp_slot;
 209
 210         rc++;
 211         p_slot = shpchp_find_slot(ctrl, hp_slot + ctrl->slot_device_offset);
 212
 213         if ( !(p_slot->hpc_ops->query_power_fault(p_slot))) {
 214                 /*
 215                  * Power fault Cleared
 216                  */
 217                 info("Power fault cleared on Slot(%d)\n", ctrl->first_slot + hp_slot);
 218                 p_slot->status = 0x00;
 219                 taskInfo->event_type = INT_POWER_FAULT_CLEAR;
 220         } else {
 221                 /*
 222                  *   Power fault
 223                  */
 224                 info("Power fault on Slot(%d)\n", ctrl->first_slot + hp_slot);
 225                 taskInfo->event_type = INT_POWER_FAULT;
 226                 /* set power fault status for this board */
 227                 p_slot->status = 0xFF;
 228                 info("power fault bit %x set\n", hp_slot);
 229         }
 230         if (rc)
 231                 up(&event_semaphore);   /* signal event thread that new event is posted */
 232
 233         return rc;
 234 }
 235
 236 /* The following routines constitute the bulk of the
 237    hotplug controller logic
 238  */
 239 static int change_bus_speed(struct controller *ctrl, struct slot *p_slot,
 240                 enum pci_bus_speed speed)
 241 {
 242         int rc = 0;
 243
 244         dbg("%s: change to speed %d\n", __FUNCTION__, speed);
 245         down(&ctrl->crit_sect);
 246         if ((rc = p_slot->hpc_ops->set_bus_speed_mode(p_slot, speed))) {
 247                 err("%s: Issue of set bus speed mode command failed\n", __FUNCTION__);
 248                 up(&ctrl->crit_sect);
 249                 return WRONG_BUS_FREQUENCY;
 250         }
 251
 252         if ((rc = p_slot->hpc_ops->check_cmd_status(ctrl))) {
 253                 err("%s: Can't set bus speed/mode in the case of adapter & bus mismatch\n",
 254                           __FUNCTION__);
 255                 err("%s: Error code (%d)\n", __FUNCTION__, rc);
 256                 up(&ctrl->crit_sect);
 257                 return WRONG_BUS_FREQUENCY;
 258         }
 259         up(&ctrl->crit_sect);
 260         return rc;
 261 }
 262
 263 static int fix_bus_speed(struct controller *ctrl, struct slot *pslot,
 264                 u8 flag, enum pci_bus_speed asp, enum pci_bus_speed bsp,
 265                 enum pci_bus_speed msp)
 266 {
 267         int rc = 0;
 268
 269         if (flag != 0) { /* Other slots on the same bus are occupied */
 270                 if ( asp < bsp ) {
 271                         err("%s: speed of bus %x and adapter %x mismatch\n", __FUNCTION__, bsp, asp);
 272                         return WRONG_BUS_FREQUENCY;
 273                 }
 274         } else {
 275                 /* Other slots on the same bus are empty */
 276                 if (msp == bsp) {
 277                 /* if adapter_speed >= bus_speed, do nothing */
 278                         if (asp < bsp) {
 279                                 /*
 280                                 * Try to lower bus speed to accommodate the adapter if other slots
 281                                 * on the same controller are empty
 282                                 */
 283                                 if ((rc = change_bus_speed(ctrl, pslot, asp)))
 284                                         return rc;
 285                         }
 286                 } else {
 287                         if (asp < msp) {
 288                                 if ((rc = change_bus_speed(ctrl, pslot, asp)))
 289                                         return rc;
 290                         } else {
 291                                 if ((rc = change_bus_speed(ctrl, pslot, msp)))
 292                                         return rc;
 293                         }
 294                 }
 295         }
 296         return rc;
 297 }
 298
 299 /**
 300  * board_added - Called after a board has been added to the system.
 301  *
 302  * Turns power on for the board
 303  * Configures board
 304  *
 305  */
 306 static int board_added(struct slot *p_slot)
 307 {
 308         u8 hp_slot;
 309         u8 slots_not_empty = 0;
 310         int rc = 0;
 311         enum pci_bus_speed adapter_speed, bus_speed, max_bus_speed;
 312         u8 pi, mode;
 313         struct controller *ctrl = p_slot->ctrl;
 314
 315         hp_slot = p_slot->device - ctrl->slot_device_offset;
 316
 317         dbg("%s: p_slot->device, slot_offset, hp_slot = %d, %d ,%d\n",
 318                         __FUNCTION__, p_slot->device,
 319                         ctrl->slot_device_offset, hp_slot);
 320
 321         /* Wait for exclusive access to hardware */
 322         down(&ctrl->crit_sect);
 323
 324         /* Power on slot without connecting to bus */
 325         rc = p_slot->hpc_ops->power_on_slot(p_slot);
 326         if (rc) {
 327                 err("%s: Failed to power on slot\n", __FUNCTION__);
 328                 /* Done with exclusive hardware access */
 329                 up(&ctrl->crit_sect);
 330                 return -1;
 331         }
 332
 333         rc = p_slot->hpc_ops->check_cmd_status(ctrl);
 334         if (rc) {
 335                 err("%s: Failed to power on slot, error code(%d)\n", __FUNCTION__, rc);
 336                 /* Done with exclusive hardware access */
 337                 up(&ctrl->crit_sect);
 338                 return -1;
 339         }
 340
 341
 342         if ((ctrl->pci_dev->vendor == 0x8086) && (ctrl->pci_dev->device == 0x0332)) {
 343                 if (slots_not_empty)
 344                         return WRONG_BUS_FREQUENCY;
 345
 346                 if ((rc = p_slot->hpc_ops->set_bus_speed_mode(p_slot, PCI_SPEED_33MHz))) {
 347                         err("%s: Issue of set bus speed mode command failed\n", __FUNCTION__);
 348                         up(&ctrl->crit_sect);
 349                         return WRONG_BUS_FREQUENCY;
 350                 }
 351
 352                 if ((rc = p_slot->hpc_ops->check_cmd_status(ctrl))) {
 353                         err("%s: Can't set bus speed/mode in the case of adapter & bus mismatch\n",
 354                                   __FUNCTION__);
 355                         err("%s: Error code (%d)\n", __FUNCTION__, rc);
 356                         up(&ctrl->crit_sect);
 357                         return WRONG_BUS_FREQUENCY;
 358                 }
 359                 /* turn on board, blink green LED, turn off Amber LED */
 360                 if ((rc = p_slot->hpc_ops->slot_enable(p_slot))) {
 361                         err("%s: Issue of Slot Enable command failed\n", __FUNCTION__);
 362                         up(&ctrl->crit_sect);
 363                         return rc;
 364                 }
 365
 366                 if ((rc = p_slot->hpc_ops->check_cmd_status(ctrl))) {
 367                         err("%s: Failed to enable slot, error code(%d)\n", __FUNCTION__, rc);
 368                         up(&ctrl->crit_sect);
 369                         return rc;
 370                 }
 371         }
 372
 373         rc = p_slot->hpc_ops->get_adapter_speed(p_slot, &adapter_speed);
 374         /* 0 = PCI 33Mhz, 1 = PCI 66 Mhz, 2 = PCI-X 66 PA, 4 = PCI-X 66 ECC, */
 375         /* 5 = PCI-X 133 PA, 7 = PCI-X 133 ECC,  0xa = PCI-X 133 Mhz 266, */
 376         /* 0xd = PCI-X 133 Mhz 533 */
 377         /* This encoding is different from the one used in cur_bus_speed & */
 378         /* max_bus_speed */
 379
 380         if (rc  || adapter_speed == PCI_SPEED_UNKNOWN) {
 381                 err("%s: Can't get adapter speed or bus mode mismatch\n", __FUNCTION__);
 382                 /* Done with exclusive hardware access */
 383                 up(&ctrl->crit_sect);
 384                 return WRONG_BUS_FREQUENCY;
 385         }
 386
 387         rc = p_slot->hpc_ops->get_cur_bus_speed(p_slot, &bus_speed);
 388         if (rc || bus_speed == PCI_SPEED_UNKNOWN) {
 389                 err("%s: Can't get bus operation speed\n", __FUNCTION__);
 390                 /* Done with exclusive hardware access */
 391                 up(&ctrl->crit_sect);
 392                 return WRONG_BUS_FREQUENCY;
 393         }
 394
 395         rc = p_slot->hpc_ops->get_max_bus_speed(p_slot, &max_bus_speed);
 396         if (rc || max_bus_speed == PCI_SPEED_UNKNOWN) {
 397                 err("%s: Can't get max bus operation speed\n", __FUNCTION__);
 398                 max_bus_speed = bus_speed;
 399         }
 400
 401         /* Done with exclusive hardware access */
 402         up(&ctrl->crit_sect);
 403
 404         if ((rc  = p_slot->hpc_ops->get_prog_int(p_slot, &pi))) {
 405                 err("%s: Can't get controller programming interface, set it to 1\n", __FUNCTION__);
 406                 pi = 1;
 407         }
 408
 409         /* Check if there are other slots or devices on the same bus */
 410         if (!list_empty(&ctrl->pci_dev->subordinate->devices))
 411                 slots_not_empty = 1;
 412
 413         dbg("%s: slots_not_empty %d, pi %d\n", __FUNCTION__,
 414                 slots_not_empty, pi);
 415         dbg("adapter_speed %d, bus_speed %d, max_bus_speed %d\n",
 416                 adapter_speed, bus_speed, max_bus_speed);
 417
 418         if (pi == 2) {
 419                 dbg("%s: In PI = %d\n", __FUNCTION__, pi);
 420                 if ((rc = p_slot->hpc_ops->get_mode1_ECC_cap(p_slot, &mode))) {
 421                         err("%s: Can't get Mode1_ECC, set mode to 0\n", __FUNCTION__);
 422                         mode = 0;
 423                 }
 424
 425                 switch (adapter_speed) {
 426                 case PCI_SPEED_133MHz_PCIX_533:
 427                 case PCI_SPEED_133MHz_PCIX_266:
 428                         if ((bus_speed != adapter_speed) &&
 429                            ((rc = fix_bus_speed(ctrl, p_slot, slots_not_empty, adapter_speed, bus_speed, max_bus_speed))))
 430                                 return rc;
 431                         break;
 432                 case PCI_SPEED_133MHz_PCIX_ECC:
 433                 case PCI_SPEED_133MHz_PCIX:
 434                         if (mode) { /* Bus - Mode 1 ECC */
 435                                 if ((bus_speed != 0x7) &&
 436                                    ((rc = fix_bus_speed(ctrl, p_slot, slots_not_empty, adapter_speed, bus_speed, max_bus_speed))))
 437                                         return rc;
 438                         } else {
 439                                 if ((bus_speed != 0x4) &&
 440                                    ((rc = fix_bus_speed(ctrl, p_slot, slots_not_empty, adapter_speed, bus_speed, max_bus_speed))))
 441                                         return rc;
 442                         }
 443                         break;
 444                 case PCI_SPEED_66MHz_PCIX_ECC:
 445                 case PCI_SPEED_66MHz_PCIX:
 446                         if (mode) { /* Bus - Mode 1 ECC */
 447                                 if ((bus_speed != 0x5) &&
 448                                    ((rc = fix_bus_speed(ctrl, p_slot, slots_not_empty, adapter_speed, bus_speed, max_bus_speed))))
 449                                         return rc;
 450                         } else {
 451                                 if ((bus_speed != 0x2) &&
 452                                    ((rc = fix_bus_speed(ctrl, p_slot, slots_not_empty, adapter_speed, bus_speed, max_bus_speed))))
 453                                         return rc;
 454                         }
 455                         break;
 456                 case PCI_SPEED_66MHz:
 457                         if ((bus_speed != 0x1) &&
 458                            ((rc = fix_bus_speed(ctrl, p_slot, slots_not_empty, adapter_speed, bus_speed, max_bus_speed))))
 459                                 return rc;
 460                         break;
 461                 case PCI_SPEED_33MHz:
 462                         if (bus_speed > 0x0) {
 463                                 if (slots_not_empty == 0) {
 464                                         if ((rc = change_bus_speed(ctrl, p_slot, adapter_speed)))
 465                                                 return rc;
 466                                 } else {
 467                                         err("%s: speed of bus %x and adapter %x mismatch\n", __FUNCTION__, bus_speed, adapter_speed);
 468                                         return WRONG_BUS_FREQUENCY;
 469                                 }
 470                         }
 471                         break;
 472                 default:
 473                         err("%s: speed of bus %x and adapter %x mismatch\n", __FUNCTION__, bus_speed, adapter_speed);
 474                         return WRONG_BUS_FREQUENCY;
 475                 }
 476         } else {
 477                 /* If adpater_speed == bus_speed, nothing to do here */
 478                 dbg("%s: In PI = %d\n", __FUNCTION__, pi);
 479                 if ((adapter_speed != bus_speed) &&
 480                    ((rc = fix_bus_speed(ctrl, p_slot, slots_not_empty, adapter_speed, bus_speed, max_bus_speed))))
 481                                 return rc;
 482         }
 483
 484         down(&ctrl->crit_sect);
 485         /* turn on board, blink green LED, turn off Amber LED */
 486         if ((rc = p_slot->hpc_ops->slot_enable(p_slot))) {
 487                 err("%s: Issue of Slot Enable command failed\n", __FUNCTION__);
 488                 up(&ctrl->crit_sect);
 489                 return rc;
 490         }
 491
 492         if ((rc = p_slot->hpc_ops->check_cmd_status(ctrl))) {
 493                 err("%s: Failed to enable slot, error code(%d)\n", __FUNCTION__, rc);
 494                 up(&ctrl->crit_sect);
 495                 return rc;
 496         }
 497
 498         up(&ctrl->crit_sect);
 499
 500         /* Wait for ~1 second */
 501         wait_for_ctrl_irq (ctrl);
 502
 503         dbg("%s: slot status = %x\n", __FUNCTION__, p_slot->status);
 504         /* Check for a power fault */
 505         if (p_slot->status == 0xFF) {
 506                 /* power fault occurred, but it was benign */
 507                 dbg("%s: power fault\n", __FUNCTION__);
 508                 rc = POWER_FAILURE;
 509                 p_slot->status = 0;
 510                 goto err_exit;
 511         }
 512
 513         if (shpchp_configure_device(p_slot)) {
 514                 err("Cannot add device at 0x%x:0x%x\n", p_slot->bus,
 515                                 p_slot->device);
 516                 goto err_exit;
 517         }
 518
 519         p_slot->status = 0;
 520         p_slot->is_a_board = 0x01;
 521         p_slot->pwr_save = 1;
 522
 523         /* Wait for exclusive access to hardware */
 524         down(&ctrl->crit_sect);
 525
 526         p_slot->hpc_ops->green_led_on(p_slot);
 527
 528         /* Done with exclusive hardware access */
 529         up(&ctrl->crit_sect);
 530
 531         return 0;
 532
 533 err_exit:
 534         /* Wait for exclusive access to hardware */
 535         down(&ctrl->crit_sect);
 536
 537         /* turn off slot, turn on Amber LED, turn off Green LED */
 538         rc = p_slot->hpc_ops->slot_disable(p_slot);
 539         if (rc) {
 540                 err("%s: Issue of Slot Disable command failed\n", __FUNCTION__);
 541                 /* Done with exclusive hardware access */
 542                 up(&ctrl->crit_sect);
 543                 return rc;
 544         }
 545
 546         rc = p_slot->hpc_ops->check_cmd_status(ctrl);
 547         if (rc) {
 548                 err("%s: Failed to disable slot, error code(%d)\n", __FUNCTION__, rc);
 549                 /* Done with exclusive hardware access */
 550                 up(&ctrl->crit_sect);
 551                 return rc;
 552         }
 553
 554         /* Done with exclusive hardware access */
 555         up(&ctrl->crit_sect);
 556
 557         return(rc);
 558 }
 559
 560
 561 /**
 562  * remove_board - Turns off slot and LED's
 563  *
 564  */
 565 static int remove_board(struct slot *p_slot)
 566 {
 567         struct controller *ctrl = p_slot->ctrl;
 568         u8 hp_slot;
 569         int rc;
 570
 571         if (shpchp_unconfigure_device(p_slot))
 572                 return(1);
 573
 574         hp_slot = p_slot->device - ctrl->slot_device_offset;
 575         p_slot = shpchp_find_slot(ctrl, hp_slot + ctrl->slot_device_offset);
 576
 577         dbg("In %s, hp_slot = %d\n", __FUNCTION__, hp_slot);
 578
 579         /* Change status to shutdown */
 580         if (p_slot->is_a_board)
 581                 p_slot->status = 0x01;
 582
 583         /* Wait for exclusive access to hardware */
 584         down(&ctrl->crit_sect);
 585
 586         /* turn off slot, turn on Amber LED, turn off Green LED */
 587         rc = p_slot->hpc_ops->slot_disable(p_slot);
 588         if (rc) {
 589                 err("%s: Issue of Slot Disable command failed\n", __FUNCTION__);
 590                 /* Done with exclusive hardware access */
 591                 up(&ctrl->crit_sect);
 592                 return rc;
 593         }
 594
 595         rc = p_slot->hpc_ops->check_cmd_status(ctrl);
 596         if (rc) {
 597                 err("%s: Failed to disable slot, error code(%d)\n", __FUNCTION__, rc);
 598                 /* Done with exclusive hardware access */
 599                 up(&ctrl->crit_sect);
 600                 return rc;
 601         }
 602
 603         rc = p_slot->hpc_ops->set_attention_status(p_slot, 0);
 604         if (rc) {
 605                 err("%s: Issue of Set Attention command failed\n", __FUNCTION__);
 606                 /* Done with exclusive hardware access */
 607                 up(&ctrl->crit_sect);
 608                 return rc;
 609         }
 610
 611         /* Done with exclusive hardware access */
 612         up(&ctrl->crit_sect);
 613
 614         p_slot->pwr_save = 0;
 615         p_slot->is_a_board = 0;
 616
 617         return 0;
 618 }
 619
 620
 621 static void pushbutton_helper_thread (unsigned long data)
 622 {
 623         pushbutton_pending = data;
 624
 625         up(&event_semaphore);
 626 }
 627
 628
 629 /**
 630  * shpchp_pushbutton_thread
 631  *
 632  * Scheduled procedure to handle blocking stuff for the pushbuttons
 633  * Handles all pending events and exits.
 634  *
 635  */
 636 static void shpchp_pushbutton_thread (unsigned long slot)
 637 {
 638         struct slot *p_slot = (struct slot *) slot;
 639         u8 getstatus;
 640
 641         pushbutton_pending = 0;
 642
 643         if (!p_slot) {
 644                 dbg("%s: Error! slot NULL\n", __FUNCTION__);
 645                 return;
 646         }
 647
 648         p_slot->hpc_ops->get_power_status(p_slot, &getstatus);
 649         if (getstatus) {
 650                 p_slot->state = POWEROFF_STATE;
 651
 652                 shpchp_disable_slot(p_slot);
 653                 p_slot->state = STATIC_STATE;
 654         } else {
 655                 p_slot->state = POWERON_STATE;
 656
 657                 if (shpchp_enable_slot(p_slot)) {
 658                         /* Wait for exclusive access to hardware */
 659                         down(&p_slot->ctrl->crit_sect);
 660
 661                         p_slot->hpc_ops->green_led_off(p_slot);
 662
 663                         /* Done with exclusive hardware access */
 664                         up(&p_slot->ctrl->crit_sect);
 665                 }
 666                 p_slot->state = STATIC_STATE;
 667         }
 668
 669         return;
 670 }
 671
 672
 673 /* this is the main worker thread */
 674 static int event_thread(void* data)
 675 {
 676         struct controller *ctrl;
 677         lock_kernel();
 678         daemonize("shpchpd_event");
 679         unlock_kernel();
 680
 681         while (1) {
 682                 dbg("!!!!event_thread sleeping\n");
 683                 down_interruptible (&event_semaphore);
 684                 dbg("event_thread woken finished = %d\n", event_finished);
 685                 if (event_finished || signal_pending(current))
 686                         break;
 687                 /* Do stuff here */
 688                 if (pushbutton_pending)
 689                         shpchp_pushbutton_thread(pushbutton_pending);
 690                 else
 691                         for (ctrl = shpchp_ctrl_list; ctrl; ctrl=ctrl->next)
 692                                 interrupt_event_handler(ctrl);
 693         }
 694         dbg("event_thread signals exit\n");
 695         up(&event_exit);
 696         return 0;
 697 }
 698
 699 int shpchp_event_start_thread (void)
 700 {
 701         int pid;
 702
 703         /* initialize our semaphores */
 704         init_MUTEX_LOCKED(&event_exit);
 705         event_finished=0;
 706
 707         init_MUTEX_LOCKED(&event_semaphore);
 708         pid = kernel_thread(event_thread, NULL, 0);
 709
 710         if (pid < 0) {
 711                 err ("Can't start up our event thread\n");
 712                 return -1;
 713         }
 714         return 0;
 715 }
 716
 717
 718 void shpchp_event_stop_thread (void)
 719 {
 720         event_finished = 1;
 721         up(&event_semaphore);
 722         down(&event_exit);
 723 }
 724
 725
 726 static int update_slot_info (struct slot *slot)
 727 {
 728         struct hotplug_slot_info *info;
 729         int result;
 730
 731         info = kmalloc(sizeof(*info), GFP_KERNEL);
 732         if (!info)
 733                 return -ENOMEM;
 734
 735         slot->hpc_ops->get_power_status(slot, &(info->power_status));
 736         slot->hpc_ops->get_attention_status(slot, &(info->attention_status));
 737         slot->hpc_ops->get_latch_status(slot, &(info->latch_status));
 738         slot->hpc_ops->get_adapter_status(slot, &(info->adapter_status));
 739
 740         result = pci_hp_change_slot_info(slot->hotplug_slot, info);
 741         kfree (info);
 742         return result;
 743 }
 744
 745 static void interrupt_event_handler(struct controller *ctrl)
 746 {
 747         int loop = 0;
 748         int change = 1;
 749         u8 hp_slot;
 750         u8 getstatus;
 751         struct slot *p_slot;
 752
 753         while (change) {
 754                 change = 0;
 755
 756                 for (loop = 0; loop < 10; loop++) {
 757                         if (ctrl->event_queue[loop].event_type != 0) {
 758                                 dbg("%s:loop %x event_type %x\n", __FUNCTION__, loop,
 759                                         ctrl->event_queue[loop].event_type);
 760                                 hp_slot = ctrl->event_queue[loop].hp_slot;
 761
 762                                 p_slot = shpchp_find_slot(ctrl, hp_slot + ctrl->slot_device_offset);
 763
 764                                 if (ctrl->event_queue[loop].event_type == INT_BUTTON_CANCEL) {
 765                                         dbg("%s: button cancel\n", __FUNCTION__);
 766                                         del_timer(&p_slot->task_event);
 767
 768                                         switch (p_slot->state) {
 769                                         case BLINKINGOFF_STATE:
 770                                                 /* Wait for exclusive access to hardware */
 771                                                 down(&ctrl->crit_sect);
 772
 773                                                 p_slot->hpc_ops->green_led_on(p_slot);
 774
 775                                                 p_slot->hpc_ops->set_attention_status(p_slot, 0);
 776
 777                                                 /* Done with exclusive hardware access */
 778                                                 up(&ctrl->crit_sect);
 779                                                 break;
 780                                         case BLINKINGON_STATE:
 781                                                 /* Wait for exclusive access to hardware */
 782                                                 down(&ctrl->crit_sect);
 783
 784                                                 p_slot->hpc_ops->green_led_off(p_slot);
 785
 786                                                 p_slot->hpc_ops->set_attention_status(p_slot, 0);
 787
 788                                                 /* Done with exclusive hardware access */
 789                                                 up(&ctrl->crit_sect);
 790
 791                                                 break;
 792                                         default:
 793                                                 warn("Not a valid state\n");
 794                                                 return;
 795                                         }
 796                                         info(msg_button_cancel, p_slot->number);
 797                                         p_slot->state = STATIC_STATE;
 798                                 } else if (ctrl->event_queue[loop].event_type == INT_BUTTON_PRESS) {
 799                                         /* Button Pressed (No action on 1st press...) */
 800                                         dbg("%s: Button pressed\n", __FUNCTION__);
 801
 802                                         p_slot->hpc_ops->get_power_status(p_slot, &getstatus);
 803                                         if (getstatus) {
 804                                                 /* slot is on */
 805                                                 dbg("%s: slot is on\n", __FUNCTION__);
 806                                                 p_slot->state = BLINKINGOFF_STATE;
 807                                                 info(msg_button_off, p_slot->number);
 808                                         } else {
 809                                                 /* slot is off */
 810                                                 dbg("%s: slot is off\n", __FUNCTION__);
 811                                                 p_slot->state = BLINKINGON_STATE;
 812                                                 info(msg_button_on, p_slot->number);
 813                                         }
 814
 815                                         /* Wait for exclusive access to hardware */
 816                                         down(&ctrl->crit_sect);
 817
 818                                         /* blink green LED and turn off amber */
 819                                         p_slot->hpc_ops->green_led_blink(p_slot);
 820
 821                                         p_slot->hpc_ops->set_attention_status(p_slot, 0);
 822
 823                                         /* Done with exclusive hardware access */
 824                                         up(&ctrl->crit_sect);
 825
 826                                         init_timer(&p_slot->task_event);
 827                                         p_slot->task_event.expires = jiffies + 5 * HZ;   /* 5 second delay */
 828                                         p_slot->task_event.function = (void (*)(unsigned long)) pushbutton_helper_thread;
 829                                         p_slot->task_event.data = (unsigned long) p_slot;
 830
 831                                         dbg("%s: add_timer p_slot = %p\n", __FUNCTION__,(void *) p_slot);
 832                                         add_timer(&p_slot->task_event);
 833                                 } else if (ctrl->event_queue[loop].event_type == INT_POWER_FAULT) {
 834                                         /***********POWER FAULT********************/
 835                                         dbg("%s: power fault\n", __FUNCTION__);
 836                                         /* Wait for exclusive access to hardware */
 837                                         down(&ctrl->crit_sect);
 838
 839                                         p_slot->hpc_ops->set_attention_status(p_slot, 1);
 840
 841                                         p_slot->hpc_ops->green_led_off(p_slot);
 842
 843                                         /* Done with exclusive hardware access */
 844                                         up(&ctrl->crit_sect);
 845                                 } else {
 846                                         /* refresh notification */
 847                                         if (p_slot)
 848                                                 update_slot_info(p_slot);
 849                                 }
 850
 851                                 ctrl->event_queue[loop].event_type = 0;
 852
 853                                 change = 1;
 854                         }
 855                 }               /* End of FOR loop */
 856         }
 857
 858         return;
 859 }
 860
 861
 862 int shpchp_enable_slot (struct slot *p_slot)
 863 {
 864         u8 getstatus = 0;
 865         int rc;
 866
 867         /* Check to see if (latch closed, card present, power off) */
 868         down(&p_slot->ctrl->crit_sect);
 869         rc = p_slot->hpc_ops->get_adapter_status(p_slot, &getstatus);
 870         if (rc || !getstatus) {
 871                 info("%s: no adapter on slot(%x)\n", __FUNCTION__, p_slot->number);
 872                 up(&p_slot->ctrl->crit_sect);
 873                 return -ENODEV;
 874         }
 875         rc = p_slot->hpc_ops->get_latch_status(p_slot, &getstatus);
 876         if (rc || getstatus) {
 877                 info("%s: latch open on slot(%x)\n", __FUNCTION__, p_slot->number);
 878                 up(&p_slot->ctrl->crit_sect);
 879                 return -ENODEV;
 880         }
 881         rc = p_slot->hpc_ops->get_power_status(p_slot, &getstatus);
 882         if (rc || getstatus) {
 883                 info("%s: already enabled on slot(%x)\n", __FUNCTION__, p_slot->number);
 884                 up(&p_slot->ctrl->crit_sect);
 885                 return -ENODEV;
 886         }
 887         up(&p_slot->ctrl->crit_sect);
 888
 889         p_slot->is_a_board = 1;
 890
 891         /* We have to save the presence info for these slots */
 892         p_slot->hpc_ops->get_adapter_status(p_slot, &(p_slot->presence_save));
 893         p_slot->hpc_ops->get_power_status(p_slot, &(p_slot->pwr_save));
 894         dbg("%s: p_slot->pwr_save %x\n", __FUNCTION__, p_slot->pwr_save);
 895         p_slot->hpc_ops->get_latch_status(p_slot, &getstatus);
 896
 897         if(((p_slot->ctrl->pci_dev->vendor == PCI_VENDOR_ID_AMD) ||
 898             (p_slot->ctrl->pci_dev->device == PCI_DEVICE_ID_AMD_POGO_7458))
 899              && p_slot->ctrl->num_slots == 1) {
 900                 /* handle amd pogo errata; this must be done before enable  */
 901                 amd_pogo_errata_save_misc_reg(p_slot);
 902                 rc = board_added(p_slot);
 903                 /* handle amd pogo errata; this must be done after enable  */
 904                 amd_pogo_errata_restore_misc_reg(p_slot);
 905         } else
 906                 rc = board_added(p_slot);
 907
 908         if (rc) {
 909                 p_slot->hpc_ops->get_adapter_status(p_slot,
 910                                 &(p_slot->presence_save));
 911                 p_slot->hpc_ops->get_latch_status(p_slot, &getstatus);
 912         }
 913
 914         update_slot_info(p_slot);
 915         return rc;
 916 }
 917
 918
 919 int shpchp_disable_slot (struct slot *p_slot)
 920 {
 921         u8 getstatus = 0;
 922         int ret = 0;
 923
 924         if (!p_slot->ctrl)
 925                 return -ENODEV;
 926
 927         /* Check to see if (latch closed, card present, power on) */
 928         down(&p_slot->ctrl->crit_sect);
 929
 930         ret = p_slot->hpc_ops->get_adapter_status(p_slot, &getstatus);
 931         if (ret || !getstatus) {
 932                 info("%s: no adapter on slot(%x)\n", __FUNCTION__, p_slot->number);
 933                 up(&p_slot->ctrl->crit_sect);
 934                 return -ENODEV;
 935         }
 936         ret = p_slot->hpc_ops->get_latch_status(p_slot, &getstatus);
 937         if (ret || getstatus) {
 938                 info("%s: latch open on slot(%x)\n", __FUNCTION__, p_slot->number);
 939                 up(&p_slot->ctrl->crit_sect);
 940                 return -ENODEV;
 941         }
 942         ret = p_slot->hpc_ops->get_power_status(p_slot, &getstatus);
 943         if (ret || !getstatus) {
 944                 info("%s: already disabled slot(%x)\n", __FUNCTION__, p_slot->number);
 945                 up(&p_slot->ctrl->crit_sect);
 946                 return -ENODEV;
 947         }
 948         up(&p_slot->ctrl->crit_sect);
 949
 950         ret = remove_board(p_slot);
 951         update_slot_info(p_slot);
 952         return ret;
 953 }
 954