linux/drivers/pci/hotplug/ibmphp_hpc.c
<<
>>
Prefs
   1/*
   2 * IBM Hot Plug Controller Driver
   3 *
   4 * Written By: Jyoti Shah, IBM Corporation
   5 *
   6 * Copyright (C) 2001-2003 IBM Corp.
   7 *
   8 * All rights reserved.
   9 *
  10 * This program is free software; you can redistribute it and/or modify
  11 * it under the terms of the GNU General Public License as published by
  12 * the Free Software Foundation; either version 2 of the License, or (at
  13 * your option) any later version.
  14 *
  15 * This program is distributed in the hope that it will be useful, but
  16 * WITHOUT ANY WARRANTY; without even the implied warranty of
  17 * MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE, GOOD TITLE or
  18 * NON INFRINGEMENT.  See the GNU General Public License for more
  19 * details.
  20 *
  21 * You should have received a copy of the GNU General Public License
  22 * along with this program; if not, write to the Free Software
  23 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  24 *
  25 * Send feedback to <gregkh@us.ibm.com>
  26 *                  <jshah@us.ibm.com>
  27 *
  28 */
  29
  30#include <linux/wait.h>
  31#include <linux/time.h>
  32#include <linux/delay.h>
  33#include <linux/module.h>
  34#include <linux/pci.h>
  35#include <linux/init.h>
  36#include <linux/mutex.h>
  37#include <linux/sched.h>
  38#include <linux/semaphore.h>
  39#include <linux/kthread.h>
  40#include "ibmphp.h"
  41
  42static int to_debug = 0;
  43#define debug_polling(fmt, arg...)      do { if (to_debug) debug (fmt, arg); } while (0)
  44
  45//----------------------------------------------------------------------------
  46// timeout values
  47//----------------------------------------------------------------------------
  48#define CMD_COMPLETE_TOUT_SEC   60      // give HPC 60 sec to finish cmd
  49#define HPC_CTLR_WORKING_TOUT   60      // give HPC 60 sec to finish cmd
  50#define HPC_GETACCESS_TIMEOUT   60      // seconds
  51#define POLL_INTERVAL_SEC       2       // poll HPC every 2 seconds
  52#define POLL_LATCH_CNT          5       // poll latch 5 times, then poll slots
  53
  54//----------------------------------------------------------------------------
  55// Winnipeg Architected Register Offsets
  56//----------------------------------------------------------------------------
  57#define WPG_I2CMBUFL_OFFSET     0x08    // I2C Message Buffer Low
  58#define WPG_I2CMOSUP_OFFSET     0x10    // I2C Master Operation Setup Reg
  59#define WPG_I2CMCNTL_OFFSET     0x20    // I2C Master Control Register
  60#define WPG_I2CPARM_OFFSET      0x40    // I2C Parameter Register
  61#define WPG_I2CSTAT_OFFSET      0x70    // I2C Status Register
  62
  63//----------------------------------------------------------------------------
  64// Winnipeg Store Type commands (Add this commands to the register offset)
  65//----------------------------------------------------------------------------
  66#define WPG_I2C_AND             0x1000  // I2C AND operation
  67#define WPG_I2C_OR              0x2000  // I2C OR operation
  68
  69//----------------------------------------------------------------------------
  70// Command set for I2C Master Operation Setup Register
  71//----------------------------------------------------------------------------
  72#define WPG_READATADDR_MASK     0x00010000      // read,bytes,I2C shifted,index
  73#define WPG_WRITEATADDR_MASK    0x40010000      // write,bytes,I2C shifted,index
  74#define WPG_READDIRECT_MASK     0x10010000
  75#define WPG_WRITEDIRECT_MASK    0x60010000
  76
  77
  78//----------------------------------------------------------------------------
  79// bit masks for I2C Master Control Register
  80//----------------------------------------------------------------------------
  81#define WPG_I2CMCNTL_STARTOP_MASK       0x00000002      // Start the Operation
  82
  83//----------------------------------------------------------------------------
  84//
  85//----------------------------------------------------------------------------
  86#define WPG_I2C_IOREMAP_SIZE    0x2044  // size of linear address interval
  87
  88//----------------------------------------------------------------------------
  89// command index
  90//----------------------------------------------------------------------------
  91#define WPG_1ST_SLOT_INDEX      0x01    // index - 1st slot for ctlr
  92#define WPG_CTLR_INDEX          0x0F    // index - ctlr
  93#define WPG_1ST_EXTSLOT_INDEX   0x10    // index - 1st ext slot for ctlr
  94#define WPG_1ST_BUS_INDEX       0x1F    // index - 1st bus for ctlr
  95
  96//----------------------------------------------------------------------------
  97// macro utilities
  98//----------------------------------------------------------------------------
  99// if bits 20,22,25,26,27,29,30 are OFF return 1
 100#define HPC_I2CSTATUS_CHECK(s)  ((u8)((s & 0x00000A76) ? 0 : 1))
 101
 102//----------------------------------------------------------------------------
 103// global variables
 104//----------------------------------------------------------------------------
 105static struct mutex sem_hpcaccess;      // lock access to HPC
 106static struct semaphore semOperations;  // lock all operations and
 107                                        // access to data structures
 108static struct semaphore sem_exit;       // make sure polling thread goes away
 109static struct task_struct *ibmphp_poll_thread;
 110//----------------------------------------------------------------------------
 111// local function prototypes
 112//----------------------------------------------------------------------------
 113static u8 i2c_ctrl_read (struct controller *, void __iomem *, u8);
 114static u8 i2c_ctrl_write (struct controller *, void __iomem *, u8, u8);
 115static u8 hpc_writecmdtoindex (u8, u8);
 116static u8 hpc_readcmdtoindex (u8, u8);
 117static void get_hpc_access (void);
 118static void free_hpc_access (void);
 119static int poll_hpc(void *data);
 120static int process_changeinstatus (struct slot *, struct slot *);
 121static int process_changeinlatch (u8, u8, struct controller *);
 122static int hpc_wait_ctlr_notworking (int, struct controller *, void __iomem *, u8 *);
 123//----------------------------------------------------------------------------
 124
 125
 126/*----------------------------------------------------------------------
 127* Name:    ibmphp_hpc_initvars
 128*
 129* Action:  initialize semaphores and variables
 130*---------------------------------------------------------------------*/
 131void __init ibmphp_hpc_initvars (void)
 132{
 133        debug ("%s - Entry\n", __func__);
 134
 135        mutex_init(&sem_hpcaccess);
 136        sema_init(&semOperations, 1);
 137        sema_init(&sem_exit, 0);
 138        to_debug = 0;
 139
 140        debug ("%s - Exit\n", __func__);
 141}
 142
 143/*----------------------------------------------------------------------
 144* Name:    i2c_ctrl_read
 145*
 146* Action:  read from HPC over I2C
 147*
 148*---------------------------------------------------------------------*/
 149static u8 i2c_ctrl_read (struct controller *ctlr_ptr, void __iomem *WPGBbar, u8 index)
 150{
 151        u8 status;
 152        int i;
 153        void __iomem *wpg_addr; // base addr + offset
 154        unsigned long wpg_data; // data to/from WPG LOHI format
 155        unsigned long ultemp;
 156        unsigned long data;     // actual data HILO format
 157
 158        debug_polling ("%s - Entry WPGBbar[%p] index[%x] \n", __func__, WPGBbar, index);
 159
 160        //--------------------------------------------------------------------
 161        // READ - step 1
 162        // read at address, byte length, I2C address (shifted), index
 163        // or read direct, byte length, index
 164        if (ctlr_ptr->ctlr_type == 0x02) {
 165                data = WPG_READATADDR_MASK;
 166                // fill in I2C address
 167                ultemp = (unsigned long)ctlr_ptr->u.wpeg_ctlr.i2c_addr;
 168                ultemp = ultemp >> 1;
 169                data |= (ultemp << 8);
 170
 171                // fill in index
 172                data |= (unsigned long)index;
 173        } else if (ctlr_ptr->ctlr_type == 0x04) {
 174                data = WPG_READDIRECT_MASK;
 175
 176                // fill in index
 177                ultemp = (unsigned long)index;
 178                ultemp = ultemp << 8;
 179                data |= ultemp;
 180        } else {
 181                err ("this controller type is not supported \n");
 182                return HPC_ERROR;
 183        }
 184
 185        wpg_data = swab32 (data);       // swap data before writing
 186        wpg_addr = WPGBbar + WPG_I2CMOSUP_OFFSET;
 187        writel (wpg_data, wpg_addr);
 188
 189        //--------------------------------------------------------------------
 190        // READ - step 2 : clear the message buffer
 191        data = 0x00000000;
 192        wpg_data = swab32 (data);
 193        wpg_addr = WPGBbar + WPG_I2CMBUFL_OFFSET;
 194        writel (wpg_data, wpg_addr);
 195
 196        //--------------------------------------------------------------------
 197        // READ - step 3 : issue start operation, I2C master control bit 30:ON
 198        //                 2020 : [20] OR operation at [20] offset 0x20
 199        data = WPG_I2CMCNTL_STARTOP_MASK;
 200        wpg_data = swab32 (data);
 201        wpg_addr = WPGBbar + WPG_I2CMCNTL_OFFSET + WPG_I2C_OR;
 202        writel (wpg_data, wpg_addr);
 203
 204        //--------------------------------------------------------------------
 205        // READ - step 4 : wait until start operation bit clears
 206        i = CMD_COMPLETE_TOUT_SEC;
 207        while (i) {
 208                msleep(10);
 209                wpg_addr = WPGBbar + WPG_I2CMCNTL_OFFSET;
 210                wpg_data = readl (wpg_addr);
 211                data = swab32 (wpg_data);
 212                if (!(data & WPG_I2CMCNTL_STARTOP_MASK))
 213                        break;
 214                i--;
 215        }
 216        if (i == 0) {
 217                debug ("%s - Error : WPG timeout\n", __func__);
 218                return HPC_ERROR;
 219        }
 220        //--------------------------------------------------------------------
 221        // READ - step 5 : read I2C status register
 222        i = CMD_COMPLETE_TOUT_SEC;
 223        while (i) {
 224                msleep(10);
 225                wpg_addr = WPGBbar + WPG_I2CSTAT_OFFSET;
 226                wpg_data = readl (wpg_addr);
 227                data = swab32 (wpg_data);
 228                if (HPC_I2CSTATUS_CHECK (data))
 229                        break;
 230                i--;
 231        }
 232        if (i == 0) {
 233                debug ("ctrl_read - Exit Error:I2C timeout\n");
 234                return HPC_ERROR;
 235        }
 236
 237        //--------------------------------------------------------------------
 238        // READ - step 6 : get DATA
 239        wpg_addr = WPGBbar + WPG_I2CMBUFL_OFFSET;
 240        wpg_data = readl (wpg_addr);
 241        data = swab32 (wpg_data);
 242
 243        status = (u8) data;
 244
 245        debug_polling ("%s - Exit index[%x] status[%x]\n", __func__, index, status);
 246
 247        return (status);
 248}
 249
 250/*----------------------------------------------------------------------
 251* Name:    i2c_ctrl_write
 252*
 253* Action:  write to HPC over I2C
 254*
 255* Return   0 or error codes
 256*---------------------------------------------------------------------*/
 257static u8 i2c_ctrl_write (struct controller *ctlr_ptr, void __iomem *WPGBbar, u8 index, u8 cmd)
 258{
 259        u8 rc;
 260        void __iomem *wpg_addr; // base addr + offset
 261        unsigned long wpg_data; // data to/from WPG LOHI format
 262        unsigned long ultemp;
 263        unsigned long data;     // actual data HILO format
 264        int i;
 265
 266        debug_polling ("%s - Entry WPGBbar[%p] index[%x] cmd[%x]\n", __func__, WPGBbar, index, cmd);
 267
 268        rc = 0;
 269        //--------------------------------------------------------------------
 270        // WRITE - step 1
 271        // write at address, byte length, I2C address (shifted), index
 272        // or write direct, byte length, index
 273        data = 0x00000000;
 274
 275        if (ctlr_ptr->ctlr_type == 0x02) {
 276                data = WPG_WRITEATADDR_MASK;
 277                // fill in I2C address
 278                ultemp = (unsigned long)ctlr_ptr->u.wpeg_ctlr.i2c_addr;
 279                ultemp = ultemp >> 1;
 280                data |= (ultemp << 8);
 281
 282                // fill in index
 283                data |= (unsigned long)index;
 284        } else if (ctlr_ptr->ctlr_type == 0x04) {
 285                data = WPG_WRITEDIRECT_MASK;
 286
 287                // fill in index
 288                ultemp = (unsigned long)index;
 289                ultemp = ultemp << 8;
 290                data |= ultemp;
 291        } else {
 292                err ("this controller type is not supported \n");
 293                return HPC_ERROR;
 294        }
 295
 296        wpg_data = swab32 (data);       // swap data before writing
 297        wpg_addr = WPGBbar + WPG_I2CMOSUP_OFFSET;
 298        writel (wpg_data, wpg_addr);
 299
 300        //--------------------------------------------------------------------
 301        // WRITE - step 2 : clear the message buffer
 302        data = 0x00000000 | (unsigned long)cmd;
 303        wpg_data = swab32 (data);
 304        wpg_addr = WPGBbar + WPG_I2CMBUFL_OFFSET;
 305        writel (wpg_data, wpg_addr);
 306
 307        //--------------------------------------------------------------------
 308        // WRITE - step 3 : issue start operation,I2C master control bit 30:ON
 309        //                 2020 : [20] OR operation at [20] offset 0x20
 310        data = WPG_I2CMCNTL_STARTOP_MASK;
 311        wpg_data = swab32 (data);
 312        wpg_addr = WPGBbar + WPG_I2CMCNTL_OFFSET + WPG_I2C_OR;
 313        writel (wpg_data, wpg_addr);
 314
 315        //--------------------------------------------------------------------
 316        // WRITE - step 4 : wait until start operation bit clears
 317        i = CMD_COMPLETE_TOUT_SEC;
 318        while (i) {
 319                msleep(10);
 320                wpg_addr = WPGBbar + WPG_I2CMCNTL_OFFSET;
 321                wpg_data = readl (wpg_addr);
 322                data = swab32 (wpg_data);
 323                if (!(data & WPG_I2CMCNTL_STARTOP_MASK))
 324                        break;
 325                i--;
 326        }
 327        if (i == 0) {
 328                debug ("%s - Exit Error:WPG timeout\n", __func__);
 329                rc = HPC_ERROR;
 330        }
 331
 332        //--------------------------------------------------------------------
 333        // WRITE - step 5 : read I2C status register
 334        i = CMD_COMPLETE_TOUT_SEC;
 335        while (i) {
 336                msleep(10);
 337                wpg_addr = WPGBbar + WPG_I2CSTAT_OFFSET;
 338                wpg_data = readl (wpg_addr);
 339                data = swab32 (wpg_data);
 340                if (HPC_I2CSTATUS_CHECK (data))
 341                        break;
 342                i--;
 343        }
 344        if (i == 0) {
 345                debug ("ctrl_read - Error : I2C timeout\n");
 346                rc = HPC_ERROR;
 347        }
 348
 349        debug_polling ("%s Exit rc[%x]\n", __func__, rc);
 350        return (rc);
 351}
 352
 353//------------------------------------------------------------
 354//  Read from ISA type HPC
 355//------------------------------------------------------------
 356static u8 isa_ctrl_read (struct controller *ctlr_ptr, u8 offset)
 357{
 358        u16 start_address;
 359        u16 end_address;
 360        u8 data;
 361
 362        start_address = ctlr_ptr->u.isa_ctlr.io_start;
 363        end_address = ctlr_ptr->u.isa_ctlr.io_end;
 364        data = inb (start_address + offset);
 365        return data;
 366}
 367
 368//--------------------------------------------------------------
 369// Write to ISA type HPC
 370//--------------------------------------------------------------
 371static void isa_ctrl_write (struct controller *ctlr_ptr, u8 offset, u8 data)
 372{
 373        u16 start_address;
 374        u16 port_address;
 375
 376        start_address = ctlr_ptr->u.isa_ctlr.io_start;
 377        port_address = start_address + (u16) offset;
 378        outb (data, port_address);
 379}
 380
 381static u8 pci_ctrl_read (struct controller *ctrl, u8 offset)
 382{
 383        u8 data = 0x00;
 384        debug ("inside pci_ctrl_read\n");
 385        if (ctrl->ctrl_dev)
 386                pci_read_config_byte (ctrl->ctrl_dev, HPC_PCI_OFFSET + offset, &data);
 387        return data;
 388}
 389
 390static u8 pci_ctrl_write (struct controller *ctrl, u8 offset, u8 data)
 391{
 392        u8 rc = -ENODEV;
 393        debug ("inside pci_ctrl_write\n");
 394        if (ctrl->ctrl_dev) {
 395                pci_write_config_byte (ctrl->ctrl_dev, HPC_PCI_OFFSET + offset, data);
 396                rc = 0;
 397        }
 398        return rc;
 399}
 400
 401static u8 ctrl_read (struct controller *ctlr, void __iomem *base, u8 offset)
 402{
 403        u8 rc;
 404        switch (ctlr->ctlr_type) {
 405        case 0:
 406                rc = isa_ctrl_read (ctlr, offset);
 407                break;
 408        case 1:
 409                rc = pci_ctrl_read (ctlr, offset);
 410                break;
 411        case 2:
 412        case 4:
 413                rc = i2c_ctrl_read (ctlr, base, offset);
 414                break;
 415        default:
 416                return -ENODEV;
 417        }
 418        return rc;
 419}
 420
 421static u8 ctrl_write (struct controller *ctlr, void __iomem *base, u8 offset, u8 data)
 422{
 423        u8 rc = 0;
 424        switch (ctlr->ctlr_type) {
 425        case 0:
 426                isa_ctrl_write(ctlr, offset, data);
 427                break;
 428        case 1:
 429                rc = pci_ctrl_write (ctlr, offset, data);
 430                break;
 431        case 2:
 432        case 4:
 433                rc = i2c_ctrl_write(ctlr, base, offset, data);
 434                break;
 435        default:
 436                return -ENODEV;
 437        }
 438        return rc;
 439}
 440/*----------------------------------------------------------------------
 441* Name:    hpc_writecmdtoindex()
 442*
 443* Action:  convert a write command to proper index within a controller
 444*
 445* Return   index, HPC_ERROR
 446*---------------------------------------------------------------------*/
 447static u8 hpc_writecmdtoindex (u8 cmd, u8 index)
 448{
 449        u8 rc;
 450
 451        switch (cmd) {
 452        case HPC_CTLR_ENABLEIRQ:        // 0x00.N.15
 453        case HPC_CTLR_CLEARIRQ: // 0x06.N.15
 454        case HPC_CTLR_RESET:    // 0x07.N.15
 455        case HPC_CTLR_IRQSTEER: // 0x08.N.15
 456        case HPC_CTLR_DISABLEIRQ:       // 0x01.N.15
 457        case HPC_ALLSLOT_ON:    // 0x11.N.15
 458        case HPC_ALLSLOT_OFF:   // 0x12.N.15
 459                rc = 0x0F;
 460                break;
 461
 462        case HPC_SLOT_OFF:      // 0x02.Y.0-14
 463        case HPC_SLOT_ON:       // 0x03.Y.0-14
 464        case HPC_SLOT_ATTNOFF:  // 0x04.N.0-14
 465        case HPC_SLOT_ATTNON:   // 0x05.N.0-14
 466        case HPC_SLOT_BLINKLED: // 0x13.N.0-14
 467                rc = index;
 468                break;
 469
 470        case HPC_BUS_33CONVMODE:
 471        case HPC_BUS_66CONVMODE:
 472        case HPC_BUS_66PCIXMODE:
 473        case HPC_BUS_100PCIXMODE:
 474        case HPC_BUS_133PCIXMODE:
 475                rc = index + WPG_1ST_BUS_INDEX - 1;
 476                break;
 477
 478        default:
 479                err ("hpc_writecmdtoindex - Error invalid cmd[%x]\n", cmd);
 480                rc = HPC_ERROR;
 481        }
 482
 483        return rc;
 484}
 485
 486/*----------------------------------------------------------------------
 487* Name:    hpc_readcmdtoindex()
 488*
 489* Action:  convert a read command to proper index within a controller
 490*
 491* Return   index, HPC_ERROR
 492*---------------------------------------------------------------------*/
 493static u8 hpc_readcmdtoindex (u8 cmd, u8 index)
 494{
 495        u8 rc;
 496
 497        switch (cmd) {
 498        case READ_CTLRSTATUS:
 499                rc = 0x0F;
 500                break;
 501        case READ_SLOTSTATUS:
 502        case READ_ALLSTAT:
 503                rc = index;
 504                break;
 505        case READ_EXTSLOTSTATUS:
 506                rc = index + WPG_1ST_EXTSLOT_INDEX;
 507                break;
 508        case READ_BUSSTATUS:
 509                rc = index + WPG_1ST_BUS_INDEX - 1;
 510                break;
 511        case READ_SLOTLATCHLOWREG:
 512                rc = 0x28;
 513                break;
 514        case READ_REVLEVEL:
 515                rc = 0x25;
 516                break;
 517        case READ_HPCOPTIONS:
 518                rc = 0x27;
 519                break;
 520        default:
 521                rc = HPC_ERROR;
 522        }
 523        return rc;
 524}
 525
 526/*----------------------------------------------------------------------
 527* Name:    HPCreadslot()
 528*
 529* Action:  issue a READ command to HPC
 530*
 531* Input:   pslot   - cannot be NULL for READ_ALLSTAT
 532*          pstatus - can be NULL for READ_ALLSTAT
 533*
 534* Return   0 or error codes
 535*---------------------------------------------------------------------*/
 536int ibmphp_hpc_readslot (struct slot *pslot, u8 cmd, u8 *pstatus)
 537{
 538        void __iomem *wpg_bbar = NULL;
 539        struct controller *ctlr_ptr;
 540        struct list_head *pslotlist;
 541        u8 index, status;
 542        int rc = 0;
 543        int busindex;
 544
 545        debug_polling ("%s - Entry pslot[%p] cmd[%x] pstatus[%p]\n", __func__, pslot, cmd, pstatus);
 546
 547        if ((pslot == NULL)
 548            || ((pstatus == NULL) && (cmd != READ_ALLSTAT) && (cmd != READ_BUSSTATUS))) {
 549                rc = -EINVAL;
 550                err ("%s - Error invalid pointer, rc[%d]\n", __func__, rc);
 551                return rc;
 552        }
 553
 554        if (cmd == READ_BUSSTATUS) {
 555                busindex = ibmphp_get_bus_index (pslot->bus);
 556                if (busindex < 0) {
 557                        rc = -EINVAL;
 558                        err ("%s - Exit Error:invalid bus, rc[%d]\n", __func__, rc);
 559                        return rc;
 560                } else
 561                        index = (u8) busindex;
 562        } else
 563                index = pslot->ctlr_index;
 564
 565        index = hpc_readcmdtoindex (cmd, index);
 566
 567        if (index == HPC_ERROR) {
 568                rc = -EINVAL;
 569                err ("%s - Exit Error:invalid index, rc[%d]\n", __func__, rc);
 570                return rc;
 571        }
 572
 573        ctlr_ptr = pslot->ctrl;
 574
 575        get_hpc_access ();
 576
 577        //--------------------------------------------------------------------
 578        // map physical address to logical address
 579        //--------------------------------------------------------------------
 580        if ((ctlr_ptr->ctlr_type == 2) || (ctlr_ptr->ctlr_type == 4))
 581                wpg_bbar = ioremap (ctlr_ptr->u.wpeg_ctlr.wpegbbar, WPG_I2C_IOREMAP_SIZE);
 582
 583        //--------------------------------------------------------------------
 584        // check controller status before reading
 585        //--------------------------------------------------------------------
 586        rc = hpc_wait_ctlr_notworking (HPC_CTLR_WORKING_TOUT, ctlr_ptr, wpg_bbar, &status);
 587        if (!rc) {
 588                switch (cmd) {
 589                case READ_ALLSTAT:
 590                        // update the slot structure
 591                        pslot->ctrl->status = status;
 592                        pslot->status = ctrl_read (ctlr_ptr, wpg_bbar, index);
 593                        rc = hpc_wait_ctlr_notworking (HPC_CTLR_WORKING_TOUT, ctlr_ptr, wpg_bbar,
 594                                                       &status);
 595                        if (!rc)
 596                                pslot->ext_status = ctrl_read (ctlr_ptr, wpg_bbar, index + WPG_1ST_EXTSLOT_INDEX);
 597
 598                        break;
 599
 600                case READ_SLOTSTATUS:
 601                        // DO NOT update the slot structure
 602                        *pstatus = ctrl_read (ctlr_ptr, wpg_bbar, index);
 603                        break;
 604
 605                case READ_EXTSLOTSTATUS:
 606                        // DO NOT update the slot structure
 607                        *pstatus = ctrl_read (ctlr_ptr, wpg_bbar, index);
 608                        break;
 609
 610                case READ_CTLRSTATUS:
 611                        // DO NOT update the slot structure
 612                        *pstatus = status;
 613                        break;
 614
 615                case READ_BUSSTATUS:
 616                        pslot->busstatus = ctrl_read (ctlr_ptr, wpg_bbar, index);
 617                        break;
 618                case READ_REVLEVEL:
 619                        *pstatus = ctrl_read (ctlr_ptr, wpg_bbar, index);
 620                        break;
 621                case READ_HPCOPTIONS:
 622                        *pstatus = ctrl_read (ctlr_ptr, wpg_bbar, index);
 623                        break;
 624                case READ_SLOTLATCHLOWREG:
 625                        // DO NOT update the slot structure
 626                        *pstatus = ctrl_read (ctlr_ptr, wpg_bbar, index);
 627                        break;
 628
 629                        // Not used
 630                case READ_ALLSLOT:
 631                        list_for_each (pslotlist, &ibmphp_slot_head) {
 632                                pslot = list_entry (pslotlist, struct slot, ibm_slot_list);
 633                                index = pslot->ctlr_index;
 634                                rc = hpc_wait_ctlr_notworking (HPC_CTLR_WORKING_TOUT, ctlr_ptr,
 635                                                                wpg_bbar, &status);
 636                                if (!rc) {
 637                                        pslot->status = ctrl_read (ctlr_ptr, wpg_bbar, index);
 638                                        rc = hpc_wait_ctlr_notworking (HPC_CTLR_WORKING_TOUT,
 639                                                                        ctlr_ptr, wpg_bbar, &status);
 640                                        if (!rc)
 641                                                pslot->ext_status =
 642                                                    ctrl_read (ctlr_ptr, wpg_bbar,
 643                                                                index + WPG_1ST_EXTSLOT_INDEX);
 644                                } else {
 645                                        err ("%s - Error ctrl_read failed\n", __func__);
 646                                        rc = -EINVAL;
 647                                        break;
 648                                }
 649                        }
 650                        break;
 651                default:
 652                        rc = -EINVAL;
 653                        break;
 654                }
 655        }
 656        //--------------------------------------------------------------------
 657        // cleanup
 658        //--------------------------------------------------------------------
 659
 660        // remove physical to logical address mapping
 661        if ((ctlr_ptr->ctlr_type == 2) || (ctlr_ptr->ctlr_type == 4))
 662                iounmap (wpg_bbar);
 663
 664        free_hpc_access ();
 665
 666        debug_polling ("%s - Exit rc[%d]\n", __func__, rc);
 667        return rc;
 668}
 669
 670/*----------------------------------------------------------------------
 671* Name:    ibmphp_hpc_writeslot()
 672*
 673* Action: issue a WRITE command to HPC
 674*---------------------------------------------------------------------*/
 675int ibmphp_hpc_writeslot (struct slot *pslot, u8 cmd)
 676{
 677        void __iomem *wpg_bbar = NULL;
 678        struct controller *ctlr_ptr;
 679        u8 index, status;
 680        int busindex;
 681        u8 done;
 682        int rc = 0;
 683        int timeout;
 684
 685        debug_polling ("%s - Entry pslot[%p] cmd[%x]\n", __func__, pslot, cmd);
 686        if (pslot == NULL) {
 687                rc = -EINVAL;
 688                err ("%s - Error Exit rc[%d]\n", __func__, rc);
 689                return rc;
 690        }
 691
 692        if ((cmd == HPC_BUS_33CONVMODE) || (cmd == HPC_BUS_66CONVMODE) ||
 693                (cmd == HPC_BUS_66PCIXMODE) || (cmd == HPC_BUS_100PCIXMODE) ||
 694                (cmd == HPC_BUS_133PCIXMODE)) {
 695                busindex = ibmphp_get_bus_index (pslot->bus);
 696                if (busindex < 0) {
 697                        rc = -EINVAL;
 698                        err ("%s - Exit Error:invalid bus, rc[%d]\n", __func__, rc);
 699                        return rc;
 700                } else
 701                        index = (u8) busindex;
 702        } else
 703                index = pslot->ctlr_index;
 704
 705        index = hpc_writecmdtoindex (cmd, index);
 706
 707        if (index == HPC_ERROR) {
 708                rc = -EINVAL;
 709                err ("%s - Error Exit rc[%d]\n", __func__, rc);
 710                return rc;
 711        }
 712
 713        ctlr_ptr = pslot->ctrl;
 714
 715        get_hpc_access ();
 716
 717        //--------------------------------------------------------------------
 718        // map physical address to logical address
 719        //--------------------------------------------------------------------
 720        if ((ctlr_ptr->ctlr_type == 2) || (ctlr_ptr->ctlr_type == 4)) {
 721                wpg_bbar = ioremap (ctlr_ptr->u.wpeg_ctlr.wpegbbar, WPG_I2C_IOREMAP_SIZE);
 722
 723                debug ("%s - ctlr id[%x] physical[%lx] logical[%lx] i2c[%x]\n", __func__,
 724                ctlr_ptr->ctlr_id, (ulong) (ctlr_ptr->u.wpeg_ctlr.wpegbbar), (ulong) wpg_bbar,
 725                ctlr_ptr->u.wpeg_ctlr.i2c_addr);
 726        }
 727        //--------------------------------------------------------------------
 728        // check controller status before writing
 729        //--------------------------------------------------------------------
 730        rc = hpc_wait_ctlr_notworking (HPC_CTLR_WORKING_TOUT, ctlr_ptr, wpg_bbar, &status);
 731        if (!rc) {
 732
 733                ctrl_write (ctlr_ptr, wpg_bbar, index, cmd);
 734
 735                //--------------------------------------------------------------------
 736                // check controller is still not working on the command
 737                //--------------------------------------------------------------------
 738                timeout = CMD_COMPLETE_TOUT_SEC;
 739                done = 0;
 740                while (!done) {
 741                        rc = hpc_wait_ctlr_notworking (HPC_CTLR_WORKING_TOUT, ctlr_ptr, wpg_bbar,
 742                                                        &status);
 743                        if (!rc) {
 744                                if (NEEDTOCHECK_CMDSTATUS (cmd)) {
 745                                        if (CTLR_FINISHED (status) == HPC_CTLR_FINISHED_YES)
 746                                                done = 1;
 747                                } else
 748                                        done = 1;
 749                        }
 750                        if (!done) {
 751                                msleep(1000);
 752                                if (timeout < 1) {
 753                                        done = 1;
 754                                        err ("%s - Error command complete timeout\n", __func__);
 755                                        rc = -EFAULT;
 756                                } else
 757                                        timeout--;
 758                        }
 759                }
 760                ctlr_ptr->status = status;
 761        }
 762        // cleanup
 763
 764        // remove physical to logical address mapping
 765        if ((ctlr_ptr->ctlr_type == 2) || (ctlr_ptr->ctlr_type == 4))
 766                iounmap (wpg_bbar);
 767        free_hpc_access ();
 768
 769        debug_polling ("%s - Exit rc[%d]\n", __func__, rc);
 770        return rc;
 771}
 772
 773/*----------------------------------------------------------------------
 774* Name:    get_hpc_access()
 775*
 776* Action: make sure only one process can access HPC at one time
 777*---------------------------------------------------------------------*/
 778static void get_hpc_access (void)
 779{
 780        mutex_lock(&sem_hpcaccess);
 781}
 782
 783/*----------------------------------------------------------------------
 784* Name:    free_hpc_access()
 785*---------------------------------------------------------------------*/
 786void free_hpc_access (void)
 787{
 788        mutex_unlock(&sem_hpcaccess);
 789}
 790
 791/*----------------------------------------------------------------------
 792* Name:    ibmphp_lock_operations()
 793*
 794* Action: make sure only one process can change the data structure
 795*---------------------------------------------------------------------*/
 796void ibmphp_lock_operations (void)
 797{
 798        down (&semOperations);
 799        to_debug = 1;
 800}
 801
 802/*----------------------------------------------------------------------
 803* Name:    ibmphp_unlock_operations()
 804*---------------------------------------------------------------------*/
 805void ibmphp_unlock_operations (void)
 806{
 807        debug ("%s - Entry\n", __func__);
 808        up (&semOperations);
 809        to_debug = 0;
 810        debug ("%s - Exit\n", __func__);
 811}
 812
 813/*----------------------------------------------------------------------
 814* Name:    poll_hpc()
 815*---------------------------------------------------------------------*/
 816#define POLL_LATCH_REGISTER     0
 817#define POLL_SLOTS              1
 818#define POLL_SLEEP              2
 819static int poll_hpc(void *data)
 820{
 821        struct slot myslot;
 822        struct slot *pslot = NULL;
 823        struct list_head *pslotlist;
 824        int rc;
 825        int poll_state = POLL_LATCH_REGISTER;
 826        u8 oldlatchlow = 0x00;
 827        u8 curlatchlow = 0x00;
 828        int poll_count = 0;
 829        u8 ctrl_count = 0x00;
 830
 831        debug ("%s - Entry\n", __func__);
 832
 833        while (!kthread_should_stop()) {
 834                /* try to get the lock to do some kind of hardware access */
 835                down (&semOperations);
 836
 837                switch (poll_state) {
 838                case POLL_LATCH_REGISTER:
 839                        oldlatchlow = curlatchlow;
 840                        ctrl_count = 0x00;
 841                        list_for_each (pslotlist, &ibmphp_slot_head) {
 842                                if (ctrl_count >= ibmphp_get_total_controllers())
 843                                        break;
 844                                pslot = list_entry (pslotlist, struct slot, ibm_slot_list);
 845                                if (pslot->ctrl->ctlr_relative_id == ctrl_count) {
 846                                        ctrl_count++;
 847                                        if (READ_SLOT_LATCH (pslot->ctrl)) {
 848                                                rc = ibmphp_hpc_readslot (pslot,
 849                                                                          READ_SLOTLATCHLOWREG,
 850                                                                          &curlatchlow);
 851                                                if (oldlatchlow != curlatchlow)
 852                                                        process_changeinlatch (oldlatchlow,
 853                                                                               curlatchlow,
 854                                                                               pslot->ctrl);
 855                                        }
 856                                }
 857                        }
 858                        ++poll_count;
 859                        poll_state = POLL_SLEEP;
 860                        break;
 861                case POLL_SLOTS:
 862                        list_for_each (pslotlist, &ibmphp_slot_head) {
 863                                pslot = list_entry (pslotlist, struct slot, ibm_slot_list);
 864                                // make a copy of the old status
 865                                memcpy ((void *) &myslot, (void *) pslot,
 866                                        sizeof (struct slot));
 867                                rc = ibmphp_hpc_readslot (pslot, READ_ALLSTAT, NULL);
 868                                if ((myslot.status != pslot->status)
 869                                    || (myslot.ext_status != pslot->ext_status))
 870                                        process_changeinstatus (pslot, &myslot);
 871                        }
 872                        ctrl_count = 0x00;
 873                        list_for_each (pslotlist, &ibmphp_slot_head) {
 874                                if (ctrl_count >= ibmphp_get_total_controllers())
 875                                        break;
 876                                pslot = list_entry (pslotlist, struct slot, ibm_slot_list);
 877                                if (pslot->ctrl->ctlr_relative_id == ctrl_count) {
 878                                        ctrl_count++;
 879                                        if (READ_SLOT_LATCH (pslot->ctrl))
 880                                                rc = ibmphp_hpc_readslot (pslot,
 881                                                                          READ_SLOTLATCHLOWREG,
 882                                                                          &curlatchlow);
 883                                }
 884                        }
 885                        ++poll_count;
 886                        poll_state = POLL_SLEEP;
 887                        break;
 888                case POLL_SLEEP:
 889                        /* don't sleep with a lock on the hardware */
 890                        up (&semOperations);
 891                        msleep(POLL_INTERVAL_SEC * 1000);
 892
 893                        if (kthread_should_stop())
 894                                goto out_sleep;
 895
 896                        down (&semOperations);
 897
 898                        if (poll_count >= POLL_LATCH_CNT) {
 899                                poll_count = 0;
 900                                poll_state = POLL_SLOTS;
 901                        } else
 902                                poll_state = POLL_LATCH_REGISTER;
 903                        break;
 904                }
 905                /* give up the hardware semaphore */
 906                up (&semOperations);
 907                /* sleep for a short time just for good measure */
 908out_sleep:
 909                msleep(100);
 910        }
 911        up (&sem_exit);
 912        debug ("%s - Exit\n", __func__);
 913        return 0;
 914}
 915
 916
 917/*----------------------------------------------------------------------
 918* Name:    process_changeinstatus
 919*
 920* Action:  compare old and new slot status, process the change in status
 921*
 922* Input:   pointer to slot struct, old slot struct
 923*
 924* Return   0 or error codes
 925* Value:
 926*
 927* Side
 928* Effects: None.
 929*
 930* Notes:
 931*---------------------------------------------------------------------*/
 932static int process_changeinstatus (struct slot *pslot, struct slot *poldslot)
 933{
 934        u8 status;
 935        int rc = 0;
 936        u8 disable = 0;
 937        u8 update = 0;
 938
 939        debug ("process_changeinstatus - Entry pslot[%p], poldslot[%p]\n", pslot, poldslot);
 940
 941        // bit 0 - HPC_SLOT_POWER
 942        if ((pslot->status & 0x01) != (poldslot->status & 0x01))
 943                update = 1;
 944
 945        // bit 1 - HPC_SLOT_CONNECT
 946        // ignore
 947
 948        // bit 2 - HPC_SLOT_ATTN
 949        if ((pslot->status & 0x04) != (poldslot->status & 0x04))
 950                update = 1;
 951
 952        // bit 3 - HPC_SLOT_PRSNT2
 953        // bit 4 - HPC_SLOT_PRSNT1
 954        if (((pslot->status & 0x08) != (poldslot->status & 0x08))
 955                || ((pslot->status & 0x10) != (poldslot->status & 0x10)))
 956                update = 1;
 957
 958        // bit 5 - HPC_SLOT_PWRGD
 959        if ((pslot->status & 0x20) != (poldslot->status & 0x20))
 960                // OFF -> ON: ignore, ON -> OFF: disable slot
 961                if ((poldslot->status & 0x20) && (SLOT_CONNECT (poldslot->status) == HPC_SLOT_CONNECTED) && (SLOT_PRESENT (poldslot->status)))
 962                        disable = 1;
 963
 964        // bit 6 - HPC_SLOT_BUS_SPEED
 965        // ignore
 966
 967        // bit 7 - HPC_SLOT_LATCH
 968        if ((pslot->status & 0x80) != (poldslot->status & 0x80)) {
 969                update = 1;
 970                // OPEN -> CLOSE
 971                if (pslot->status & 0x80) {
 972                        if (SLOT_PWRGD (pslot->status)) {
 973                                // power goes on and off after closing latch
 974                                // check again to make sure power is still ON
 975                                msleep(1000);
 976                                rc = ibmphp_hpc_readslot (pslot, READ_SLOTSTATUS, &status);
 977                                if (SLOT_PWRGD (status))
 978                                        update = 1;
 979                                else    // overwrite power in pslot to OFF
 980                                        pslot->status &= ~HPC_SLOT_POWER;
 981                        }
 982                }
 983                // CLOSE -> OPEN
 984                else if ((SLOT_PWRGD (poldslot->status) == HPC_SLOT_PWRGD_GOOD)
 985                        && (SLOT_CONNECT (poldslot->status) == HPC_SLOT_CONNECTED) && (SLOT_PRESENT (poldslot->status))) {
 986                        disable = 1;
 987                }
 988                // else - ignore
 989        }
 990        // bit 4 - HPC_SLOT_BLINK_ATTN
 991        if ((pslot->ext_status & 0x08) != (poldslot->ext_status & 0x08))
 992                update = 1;
 993
 994        if (disable) {
 995                debug ("process_changeinstatus - disable slot\n");
 996                pslot->flag = 0;
 997                rc = ibmphp_do_disable_slot (pslot);
 998        }
 999
1000        if (update || disable)
1001                ibmphp_update_slot_info (pslot);
1002
1003        debug ("%s - Exit rc[%d] disable[%x] update[%x]\n", __func__, rc, disable, update);
1004
1005        return rc;
1006}
1007
1008/*----------------------------------------------------------------------
1009* Name:    process_changeinlatch
1010*
1011* Action:  compare old and new latch reg status, process the change
1012*
1013* Input:   old and current latch register status
1014*
1015* Return   0 or error codes
1016* Value:
1017*---------------------------------------------------------------------*/
1018static int process_changeinlatch (u8 old, u8 new, struct controller *ctrl)
1019{
1020        struct slot myslot, *pslot;
1021        u8 i;
1022        u8 mask;
1023        int rc = 0;
1024
1025        debug ("%s - Entry old[%x], new[%x]\n", __func__, old, new);
1026        // bit 0 reserved, 0 is LSB, check bit 1-6 for 6 slots
1027
1028        for (i = ctrl->starting_slot_num; i <= ctrl->ending_slot_num; i++) {
1029                mask = 0x01 << i;
1030                if ((mask & old) != (mask & new)) {
1031                        pslot = ibmphp_get_slot_from_physical_num (i);
1032                        if (pslot) {
1033                                memcpy ((void *) &myslot, (void *) pslot, sizeof (struct slot));
1034                                rc = ibmphp_hpc_readslot (pslot, READ_ALLSTAT, NULL);
1035                                debug ("%s - call process_changeinstatus for slot[%d]\n", __func__, i);
1036                                process_changeinstatus (pslot, &myslot);
1037                        } else {
1038                                rc = -EINVAL;
1039                                err ("%s - Error bad pointer for slot[%d]\n", __func__, i);
1040                        }
1041                }
1042        }
1043        debug ("%s - Exit rc[%d]\n", __func__, rc);
1044        return rc;
1045}
1046
1047/*----------------------------------------------------------------------
1048* Name:    ibmphp_hpc_start_poll_thread
1049*
1050* Action:  start polling thread
1051*---------------------------------------------------------------------*/
1052int __init ibmphp_hpc_start_poll_thread (void)
1053{
1054        debug ("%s - Entry\n", __func__);
1055
1056        ibmphp_poll_thread = kthread_run(poll_hpc, NULL, "hpc_poll");
1057        if (IS_ERR(ibmphp_poll_thread)) {
1058                err ("%s - Error, thread not started\n", __func__);
1059                return PTR_ERR(ibmphp_poll_thread);
1060        }
1061        return 0;
1062}
1063
1064/*----------------------------------------------------------------------
1065* Name:    ibmphp_hpc_stop_poll_thread
1066*
1067* Action:  stop polling thread and cleanup
1068*---------------------------------------------------------------------*/
1069void __exit ibmphp_hpc_stop_poll_thread (void)
1070{
1071        debug ("%s - Entry\n", __func__);
1072
1073        kthread_stop(ibmphp_poll_thread);
1074        debug ("before locking operations \n");
1075        ibmphp_lock_operations ();
1076        debug ("after locking operations \n");
1077
1078        // wait for poll thread to exit
1079        debug ("before sem_exit down \n");
1080        down (&sem_exit);
1081        debug ("after sem_exit down \n");
1082
1083        // cleanup
1084        debug ("before free_hpc_access \n");
1085        free_hpc_access ();
1086        debug ("after free_hpc_access \n");
1087        ibmphp_unlock_operations ();
1088        debug ("after unlock operations \n");
1089        up (&sem_exit);
1090        debug ("after sem exit up\n");
1091
1092        debug ("%s - Exit\n", __func__);
1093}
1094
1095/*----------------------------------------------------------------------
1096* Name:    hpc_wait_ctlr_notworking
1097*
1098* Action:  wait until the controller is in a not working state
1099*
1100* Return   0, HPC_ERROR
1101* Value:
1102*---------------------------------------------------------------------*/
1103static int hpc_wait_ctlr_notworking (int timeout, struct controller *ctlr_ptr, void __iomem *wpg_bbar,
1104                                    u8 *pstatus)
1105{
1106        int rc = 0;
1107        u8 done = 0;
1108
1109        debug_polling ("hpc_wait_ctlr_notworking - Entry timeout[%d]\n", timeout);
1110
1111        while (!done) {
1112                *pstatus = ctrl_read (ctlr_ptr, wpg_bbar, WPG_CTLR_INDEX);
1113                if (*pstatus == HPC_ERROR) {
1114                        rc = HPC_ERROR;
1115                        done = 1;
1116                }
1117                if (CTLR_WORKING (*pstatus) == HPC_CTLR_WORKING_NO)
1118                        done = 1;
1119                if (!done) {
1120                        msleep(1000);
1121                        if (timeout < 1) {
1122                                done = 1;
1123                                err ("HPCreadslot - Error ctlr timeout\n");
1124                                rc = HPC_ERROR;
1125                        } else
1126                                timeout--;
1127                }
1128        }
1129        debug_polling ("hpc_wait_ctlr_notworking - Exit rc[%x] status[%x]\n", rc, *pstatus);
1130        return rc;
1131}
1132