drivers/pci/hotplug/pciehprm_nonacpi.c

   1 /*
   2  * PCIEHPRM NONACPI: PHP Resource Manager for Non-ACPI/Legacy platform
   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>, <dely.l.sy@intel.com>
  27  *
  28  */
  29
  30 #include <linux/config.h>
  31 #include <linux/module.h>
  32 #include <linux/kernel.h>
  33 #include <linux/types.h>
  34 #include <linux/pci.h>
  35 #include <linux/init.h>
  36 #include <asm/uaccess.h>
  37 #ifdef CONFIG_IA64
  38 #include <asm/iosapic.h>
  39 #endif
  40 #include "pciehp.h"
  41 #include "pciehprm.h"
  42 #include "pciehprm_nonacpi.h"
  43
  44
  45 void pciehprm_cleanup(void)
  46 {
  47         return;
  48 }
  49
  50 int pciehprm_print_pirt(void)
  51 {
  52         return 0;
  53 }
  54
  55 int pciehprm_get_physical_slot_number(struct controller *ctrl, u32 *sun, u8 busnum, u8 devnum)
  56 {
  57
  58         *sun = (u8) (ctrl->first_slot);
  59         return 0;
  60 }
  61
  62
  63 static void print_pci_resource ( struct pci_resource    *aprh)
  64 {
  65         struct pci_resource     *res;
  66
  67         for (res = aprh; res; res = res->next)
  68                 dbg("        base= 0x%x length= 0x%x\n", res->base, res->length);
  69 }
  70
  71
  72 static void phprm_dump_func_res( struct pci_func *fun)
  73 {
  74         struct pci_func *func = fun;
  75
  76         if (func->bus_head) {
  77                 dbg(":    BUS Resources:\n");
  78                 print_pci_resource (func->bus_head);
  79         }
  80         if (func->io_head) {
  81                 dbg(":    IO Resources:\n");
  82                 print_pci_resource (func->io_head);
  83         }
  84         if (func->mem_head) {
  85                 dbg(":    MEM Resources:\n");
  86                 print_pci_resource (func->mem_head);
  87         }
  88         if (func->p_mem_head) {
  89                 dbg(":    PMEM Resources:\n");
  90                 print_pci_resource (func->p_mem_head);
  91         }
  92 }
  93
  94 static int phprm_get_used_resources (
  95         struct controller *ctrl,
  96         struct pci_func *func
  97         )
  98 {
  99         return pciehp_save_used_resources (ctrl, func, !DISABLE_CARD);
 100 }
 101
 102 static int phprm_delete_resource(
 103         struct pci_resource **aprh,
 104         ulong base,
 105         ulong size)
 106 {
 107         struct pci_resource *res;
 108         struct pci_resource *prevnode;
 109         struct pci_resource *split_node;
 110         ulong tbase;
 111
 112         pciehp_resource_sort_and_combine(aprh);
 113
 114         for (res = *aprh; res; res = res->next) {
 115                 if (res->base > base)
 116                         continue;
 117
 118                 if ((res->base + res->length) < (base + size))
 119                         continue;
 120
 121                 if (res->base < base) {
 122                         tbase = base;
 123
 124                         if ((res->length - (tbase - res->base)) < size)
 125                                 continue;
 126
 127                         split_node = (struct pci_resource *) kmalloc(sizeof(struct pci_resource), GFP_KERNEL);
 128                         if (!split_node)
 129                                 return -ENOMEM;
 130
 131                         split_node->base = res->base;
 132                         split_node->length = tbase - res->base;
 133                         res->base = tbase;
 134                         res->length -= split_node->length;
 135
 136                         split_node->next = res->next;
 137                         res->next = split_node;
 138                 }
 139
 140                 if (res->length >= size) {
 141                         split_node = (struct pci_resource*) kmalloc(sizeof(struct pci_resource), GFP_KERNEL);
 142                         if (!split_node)
 143                                 return -ENOMEM;
 144
 145                         split_node->base = res->base + size;
 146                         split_node->length = res->length - size;
 147                         res->length = size;
 148
 149                         split_node->next = res->next;
 150                         res->next = split_node;
 151                 }
 152
 153                 if (*aprh == res) {
 154                         *aprh = res->next;
 155                 } else {
 156                         prevnode = *aprh;
 157                         while (prevnode->next != res)
 158                                 prevnode = prevnode->next;
 159
 160                         prevnode->next = res->next;
 161                 }
 162                 res->next = NULL;
 163                 kfree(res);
 164                 break;
 165         }
 166
 167         return 0;
 168 }
 169
 170
 171 static int phprm_delete_resources(
 172         struct pci_resource **aprh,
 173         struct pci_resource *this
 174         )
 175 {
 176         struct pci_resource *res;
 177
 178         for (res = this; res; res = res->next)
 179                 phprm_delete_resource(aprh, res->base, res->length);
 180
 181         return 0;
 182 }
 183
 184
 185 static int configure_existing_function(
 186         struct controller *ctrl,
 187         struct pci_func *func
 188         )
 189 {
 190         int rc;
 191
 192         /* see how much resources the func has used. */
 193         rc = phprm_get_used_resources (ctrl, func);
 194
 195         if (!rc) {
 196                 /* subtract the resources used by the func from ctrl resources */
 197                 rc  = phprm_delete_resources (&ctrl->bus_head, func->bus_head);
 198                 rc |= phprm_delete_resources (&ctrl->io_head, func->io_head);
 199                 rc |= phprm_delete_resources (&ctrl->mem_head, func->mem_head);
 200                 rc |= phprm_delete_resources (&ctrl->p_mem_head, func->p_mem_head);
 201                 if (rc)
 202                         warn("aCEF: cannot del used resources\n");
 203         } else
 204                 err("aCEF: cannot get used resources\n");
 205
 206         return rc;
 207 }
 208
 209 static int pciehprm_delete_resource(
 210         struct pci_resource **aprh,
 211         ulong base,
 212         ulong size)
 213 {
 214         struct pci_resource *res;
 215         struct pci_resource *prevnode;
 216         struct pci_resource *split_node;
 217         ulong tbase;
 218
 219         pciehp_resource_sort_and_combine(aprh);
 220
 221         for (res = *aprh; res; res = res->next) {
 222                 if (res->base > base)
 223                         continue;
 224
 225                 if ((res->base + res->length) < (base + size))
 226                         continue;
 227
 228                 if (res->base < base) {
 229                         tbase = base;
 230
 231                         if ((res->length - (tbase - res->base)) < size)
 232                                 continue;
 233
 234                         split_node = (struct pci_resource *) kmalloc(sizeof(struct pci_resource), GFP_KERNEL);
 235                         if (!split_node)
 236                                 return -ENOMEM;
 237
 238                         split_node->base = res->base;
 239                         split_node->length = tbase - res->base;
 240                         res->base = tbase;
 241                         res->length -= split_node->length;
 242
 243                         split_node->next = res->next;
 244                         res->next = split_node;
 245                 }
 246
 247                 if (res->length >= size) {
 248                         split_node = (struct pci_resource*) kmalloc(sizeof(struct pci_resource), GFP_KERNEL);
 249                         if (!split_node)
 250                                 return -ENOMEM;
 251
 252                         split_node->base = res->base + size;
 253                         split_node->length = res->length - size;
 254                         res->length = size;
 255
 256                         split_node->next = res->next;
 257                         res->next = split_node;
 258                 }
 259
 260                 if (*aprh == res) {
 261                         *aprh = res->next;
 262                 } else {
 263                         prevnode = *aprh;
 264                         while (prevnode->next != res)
 265                                 prevnode = prevnode->next;
 266
 267                         prevnode->next = res->next;
 268                 }
 269                 res->next = NULL;
 270                 kfree(res);
 271                 break;
 272         }
 273
 274         return 0;
 275 }
 276
 277 static int bind_pci_resources_to_slots ( struct controller *ctrl)
 278 {
 279         struct pci_func *func;
 280         int busn = ctrl->slot_bus;
 281         int devn, funn;
 282         u32     vid;
 283
 284         for (devn = 0; devn < 32; devn++) {
 285                 for (funn = 0; funn < 8; funn++) {
 286                         /*
 287                         if (devn == ctrl->device && funn == ctrl->function)
 288                                 continue;
 289                         */
 290                         /* find out if this entry is for an occupied slot */
 291                         vid = 0xFFFFFFFF;
 292
 293                         pci_bus_read_config_dword(ctrl->pci_dev->subordinate, PCI_DEVFN(devn, funn), PCI_VENDOR_ID, &vid);
 294
 295                         if (vid != 0xFFFFFFFF) {
 296                                 dbg("%s: vid = %x bus %x dev %x fun %x\n", __FUNCTION__,
 297                                 vid, busn, devn, funn);
 298                                 func = pciehp_slot_find(busn, devn, funn);
 299                                 dbg("%s: func = %p\n", __FUNCTION__,func);
 300                                 if (!func)
 301                                         continue;
 302                                 configure_existing_function(ctrl, func);
 303                                 dbg("aCCF:existing PCI 0x%x Func ResourceDump\n", ctrl->bus);
 304                                 phprm_dump_func_res(func);
 305                         }
 306                 }
 307         }
 308
 309         return 0;
 310 }
 311
 312 static void phprm_dump_ctrl_res( struct controller *ctlr)
 313 {
 314         struct controller *ctrl = ctlr;
 315
 316         if (ctrl->bus_head) {
 317                 dbg(":    BUS Resources:\n");
 318                 print_pci_resource (ctrl->bus_head);
 319         }
 320         if (ctrl->io_head) {
 321                 dbg(":    IO Resources:\n");
 322                 print_pci_resource (ctrl->io_head);
 323         }
 324         if (ctrl->mem_head) {
 325                 dbg(":    MEM Resources:\n");
 326                 print_pci_resource (ctrl->mem_head);
 327         }
 328         if (ctrl->p_mem_head) {
 329                 dbg(":    PMEM Resources:\n");
 330                 print_pci_resource (ctrl->p_mem_head);
 331         }
 332 }
 333
 334 /*
 335  * phprm_find_available_resources
 336  *
 337  *  Finds available memory, IO, and IRQ resources for programming
 338  *  devices which may be added to the system
 339  *  this function is for hot plug ADD!
 340  *
 341  * returns 0 if success
 342  */
 343 int pciehprm_find_available_resources(struct controller *ctrl)
 344 {
 345         struct pci_func func;
 346         u32 rc;
 347
 348         memset(&func, 0, sizeof(struct pci_func));
 349
 350         func.bus = ctrl->bus;
 351         func.device = ctrl->device;
 352         func.function = ctrl->function;
 353         func.is_a_board = 1;
 354
 355         /* Get resources for this PCI bridge */
 356         rc = pciehp_save_used_resources (ctrl, &func, !DISABLE_CARD);
 357         dbg("%s: pciehp_save_used_resources rc = %d\n", __FUNCTION__, rc);
 358
 359         if (func.mem_head)
 360                 func.mem_head->next = ctrl->mem_head;
 361         ctrl->mem_head = func.mem_head;
 362
 363         if (func.p_mem_head)
 364                 func.p_mem_head->next = ctrl->p_mem_head;
 365         ctrl->p_mem_head = func.p_mem_head;
 366
 367         if (func.io_head)
 368                 func.io_head->next = ctrl->io_head;
 369         ctrl->io_head = func.io_head;
 370
 371         if(func.bus_head)
 372                 func.bus_head->next = ctrl->bus_head;
 373         ctrl->bus_head = func.bus_head;
 374
 375         if (ctrl->bus_head)
 376                 pciehprm_delete_resource(&ctrl->bus_head, ctrl->pci_dev->subordinate->number, 1);
 377
 378         dbg("%s:pre-Bind PCI 0x%x Ctrl Resource Dump\n", __FUNCTION__, ctrl->bus);
 379         phprm_dump_ctrl_res(ctrl);
 380
 381         dbg("%s: before bind_pci_resources_to slots\n", __FUNCTION__);
 382
 383         bind_pci_resources_to_slots (ctrl);
 384
 385         dbg("%s:post-Bind PCI 0x%x Ctrl Resource Dump\n", __FUNCTION__, ctrl->bus);
 386         phprm_dump_ctrl_res(ctrl);
 387
 388         return (rc);
 389 }
 390
 391 int pciehprm_set_hpp(
 392         struct controller *ctrl,
 393         struct pci_func *func,
 394         u8      card_type)
 395 {
 396         u32 rc;
 397         u8 temp_byte;
 398         struct pci_bus lpci_bus, *pci_bus;
 399         unsigned int    devfn;
 400         memcpy(&lpci_bus, ctrl->pci_bus, sizeof(lpci_bus));
 401         pci_bus = &lpci_bus;
 402         pci_bus->number = func->bus;
 403         devfn = PCI_DEVFN(func->device, func->function);
 404
 405         temp_byte = 0x40;       /* hard coded value for LT */
 406         if (card_type == PCI_HEADER_TYPE_BRIDGE) {
 407                 /* set subordinate Latency Timer */
 408                 rc = pci_bus_write_config_byte(pci_bus, devfn, PCI_SEC_LATENCY_TIMER, temp_byte);
 409
 410                 if (rc) {
 411                         dbg("%s: set secondary LT error. b:d:f(%02x:%02x:%02x)\n", __FUNCTION__,
 412                                 func->bus, func->device, func->function);
 413                         return rc;
 414                 }
 415         }
 416
 417         /* set base Latency Timer */
 418         rc = pci_bus_write_config_byte(pci_bus, devfn, PCI_LATENCY_TIMER, temp_byte);
 419
 420         if (rc) {
 421                 dbg("%s: set LT error. b:d:f(%02x:%02x:%02x)\n", __FUNCTION__, func->bus, func->device, func->function);
 422                 return rc;
 423         }
 424
 425         /* set Cache Line size */
 426         temp_byte = 0x08;       /* hard coded value for CLS */
 427
 428         rc = pci_bus_write_config_byte(pci_bus, devfn, PCI_CACHE_LINE_SIZE, temp_byte);
 429
 430         if (rc) {
 431                 dbg("%s: set CLS error. b:d:f(%02x:%02x:%02x)\n", __FUNCTION__, func->bus, func->device, func->function);
 432         }
 433
 434         /* set enable_perr */
 435         /* set enable_serr */
 436
 437         return rc;
 438 }
 439
 440 void pciehprm_enable_card(
 441         struct controller *ctrl,
 442         struct pci_func *func,
 443         u8 card_type)
 444 {
 445         u16 command, bcommand;
 446         struct pci_bus lpci_bus, *pci_bus;
 447         unsigned int devfn;
 448         int rc;
 449
 450         memcpy(&lpci_bus, ctrl->pci_bus, sizeof(lpci_bus));
 451         pci_bus = &lpci_bus;
 452         pci_bus->number = func->bus;
 453         devfn = PCI_DEVFN(func->device, func->function);
 454
 455         rc = pci_bus_read_config_word(pci_bus, devfn, PCI_COMMAND, &command);
 456
 457         command |= PCI_COMMAND_PARITY | PCI_COMMAND_SERR
 458                 | PCI_COMMAND_MASTER | PCI_COMMAND_INVALIDATE
 459                 | PCI_COMMAND_IO | PCI_COMMAND_MEMORY;
 460
 461         rc = pci_bus_write_config_word(pci_bus, devfn, PCI_COMMAND, command);
 462
 463         if (card_type == PCI_HEADER_TYPE_BRIDGE) {
 464
 465                 rc = pci_bus_read_config_word(pci_bus, devfn, PCI_BRIDGE_CONTROL, &bcommand);
 466
 467                 bcommand |= PCI_BRIDGE_CTL_PARITY | PCI_BRIDGE_CTL_SERR
 468                         | PCI_BRIDGE_CTL_NO_ISA;
 469
 470                 rc = pci_bus_write_config_word(pci_bus, devfn, PCI_BRIDGE_CONTROL, bcommand);
 471         }
 472 }
 473
 474 static int legacy_pciehprm_init_pci(void)
 475 {
 476         return 0;
 477 }
 478
 479 int pciehprm_init(enum php_ctlr_type ctrl_type)
 480 {
 481         int retval;
 482
 483         switch (ctrl_type) {
 484         case PCI:
 485                 retval = legacy_pciehprm_init_pci();
 486                 break;
 487         default:
 488                 retval = -ENODEV;
 489                 break;
 490         }
 491
 492         return retval;
 493 }