drivers/firmware/iscsi_ibft.c

   1 /*
   2  *  Copyright 2007-2010 Red Hat, Inc.
   3  *  by Peter Jones <pjones@redhat.com>
   4  *  Copyright 2008 IBM, Inc.
   5  *  by Konrad Rzeszutek <konradr@linux.vnet.ibm.com>
   6  *  Copyright 2008
   7  *  by Konrad Rzeszutek <ketuzsezr@darnok.org>
   8  *
   9  * This code exposes the iSCSI Boot Format Table to userland via sysfs.
  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 v2.0 as published by
  13  * the Free Software Foundation
  14  *
  15  * This program is distributed in the hope that it will be useful,
  16  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  17  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  18  * GNU General Public License for more details.
  19  *
  20  * Changelog:
  21  *
  22  *  06 Jan 2010 - Peter Jones <pjones@redhat.com>
  23  *    New changelog entries are in the git log from now on.  Not here.
  24  *
  25  *  14 Mar 2008 - Konrad Rzeszutek <ketuzsezr@darnok.org>
  26  *    Updated comments and copyrights. (v0.4.9)
  27  *
  28  *  11 Feb 2008 - Konrad Rzeszutek <konradr@linux.vnet.ibm.com>
  29  *    Converted to using ibft_addr. (v0.4.8)
  30  *
  31  *   8 Feb 2008 - Konrad Rzeszutek <konradr@linux.vnet.ibm.com>
  32  *    Combined two functions in one: reserve_ibft_region. (v0.4.7)
  33  *
  34  *  30 Jan 2008 - Konrad Rzeszutek <konradr@linux.vnet.ibm.com>
  35  *   Added logic to handle IPv6 addresses. (v0.4.6)
  36  *
  37  *  25 Jan 2008 - Konrad Rzeszutek <konradr@linux.vnet.ibm.com>
  38  *   Added logic to handle badly not-to-spec iBFT. (v0.4.5)
  39  *
  40  *   4 Jan 2008 - Konrad Rzeszutek <konradr@linux.vnet.ibm.com>
  41  *   Added __init to function declarations. (v0.4.4)
  42  *
  43  *  21 Dec 2007 - Konrad Rzeszutek <konradr@linux.vnet.ibm.com>
  44  *   Updated kobject registration, combined unregister functions in one
  45  *   and code and style cleanup. (v0.4.3)
  46  *
  47  *   5 Dec 2007 - Konrad Rzeszutek <konradr@linux.vnet.ibm.com>
  48  *   Added end-markers to enums and re-organized kobject registration. (v0.4.2)
  49  *
  50  *   4 Dec 2007 - Konrad Rzeszutek <konradr@linux.vnet.ibm.com>
  51  *   Created 'device' sysfs link to the NIC and style cleanup. (v0.4.1)
  52  *
  53  *  28 Nov 2007 - Konrad Rzeszutek <konradr@linux.vnet.ibm.com>
  54  *   Added sysfs-ibft documentation, moved 'find_ibft' function to
  55  *   in its own file and added text attributes for every struct field.  (v0.4)
  56  *
  57  *  21 Nov 2007 - Konrad Rzeszutek <konradr@linux.vnet.ibm.com>
  58  *   Added text attributes emulating OpenFirmware /proc/device-tree naming.
  59  *   Removed binary /sysfs interface (v0.3)
  60  *
  61  *  29 Aug 2007 - Konrad Rzeszutek <konradr@linux.vnet.ibm.com>
  62  *   Added functionality in setup.c to reserve iBFT region. (v0.2)
  63  *
  64  *  27 Aug 2007 - Konrad Rzeszutek <konradr@linux.vnet.ibm.com>
  65  *   First version exposing iBFT data via a binary /sysfs. (v0.1)
  66  *
  67  */
  68
  69
  70 #include <linux/blkdev.h>
  71 #include <linux/capability.h>
  72 #include <linux/ctype.h>
  73 #include <linux/device.h>
  74 #include <linux/err.h>
  75 #include <linux/init.h>
  76 #include <linux/iscsi_ibft.h>
  77 #include <linux/limits.h>
  78 #include <linux/module.h>
  79 #include <linux/pci.h>
  80 #include <linux/slab.h>
  81 #include <linux/stat.h>
  82 #include <linux/string.h>
  83 #include <linux/types.h>
  84 #include <linux/acpi.h>
  85 #include <linux/iscsi_boot_sysfs.h>
  86
  87 #define IBFT_ISCSI_VERSION "0.5.0"
  88 #define IBFT_ISCSI_DATE "2010-Feb-25"
  89
  90 MODULE_AUTHOR("Peter Jones <pjones@redhat.com> and "
  91               "Konrad Rzeszutek <ketuzsezr@darnok.org>");
  92 MODULE_DESCRIPTION("sysfs interface to BIOS iBFT information");
  93 MODULE_LICENSE("GPL");
  94 MODULE_VERSION(IBFT_ISCSI_VERSION);
  95
  96 struct ibft_hdr {
  97         u8 id;
  98         u8 version;
  99         u16 length;
 100         u8 index;
 101         u8 flags;
 102 } __attribute__((__packed__));
 103
 104 struct ibft_control {
 105         struct ibft_hdr hdr;
 106         u16 extensions;
 107         u16 initiator_off;
 108         u16 nic0_off;
 109         u16 tgt0_off;
 110         u16 nic1_off;
 111         u16 tgt1_off;
 112 } __attribute__((__packed__));
 113
 114 struct ibft_initiator {
 115         struct ibft_hdr hdr;
 116         char isns_server[16];
 117         char slp_server[16];
 118         char pri_radius_server[16];
 119         char sec_radius_server[16];
 120         u16 initiator_name_len;
 121         u16 initiator_name_off;
 122 } __attribute__((__packed__));
 123
 124 struct ibft_nic {
 125         struct ibft_hdr hdr;
 126         char ip_addr[16];
 127         u8 subnet_mask_prefix;
 128         u8 origin;
 129         char gateway[16];
 130         char primary_dns[16];
 131         char secondary_dns[16];
 132         char dhcp[16];
 133         u16 vlan;
 134         char mac[6];
 135         u16 pci_bdf;
 136         u16 hostname_len;
 137         u16 hostname_off;
 138 } __attribute__((__packed__));
 139
 140 struct ibft_tgt {
 141         struct ibft_hdr hdr;
 142         char ip_addr[16];
 143         u16 port;
 144         char lun[8];
 145         u8 chap_type;
 146         u8 nic_assoc;
 147         u16 tgt_name_len;
 148         u16 tgt_name_off;
 149         u16 chap_name_len;
 150         u16 chap_name_off;
 151         u16 chap_secret_len;
 152         u16 chap_secret_off;
 153         u16 rev_chap_name_len;
 154         u16 rev_chap_name_off;
 155         u16 rev_chap_secret_len;
 156         u16 rev_chap_secret_off;
 157 } __attribute__((__packed__));
 158
 159 /*
 160  * The kobject different types and its names.
 161  *
 162 */
 163 enum ibft_id {
 164         id_reserved = 0, /* We don't support. */
 165         id_control = 1, /* Should show up only once and is not exported. */
 166         id_initiator = 2,
 167         id_nic = 3,
 168         id_target = 4,
 169         id_extensions = 5, /* We don't support. */
 170         id_end_marker,
 171 };
 172
 173 /*
 174  * The kobject and attribute structures.
 175  */
 176
 177 struct ibft_kobject {
 178         struct acpi_table_ibft *header;
 179         union {
 180                 struct ibft_initiator *initiator;
 181                 struct ibft_nic *nic;
 182                 struct ibft_tgt *tgt;
 183                 struct ibft_hdr *hdr;
 184         };
 185 };
 186
 187 static struct iscsi_boot_kset *boot_kset;
 188
 189 static const char nulls[16];
 190
 191 /*
 192  * Helper functions to parse data properly.
 193  */
 194 static ssize_t sprintf_ipaddr(char *buf, u8 *ip)
 195 {
 196         char *str = buf;
 197
 198         if (ip[0] == 0 && ip[1] == 0 && ip[2] == 0 && ip[3] == 0 &&
 199             ip[4] == 0 && ip[5] == 0 && ip[6] == 0 && ip[7] == 0 &&
 200             ip[8] == 0 && ip[9] == 0 && ip[10] == 0xff && ip[11] == 0xff) {
 201                 /*
 202                  * IPV4
 203                  */
 204                 str += sprintf(buf, "%pI4", ip + 12);
 205         } else {
 206                 /*
 207                  * IPv6
 208                  */
 209                 str += sprintf(str, "%pI6", ip);
 210         }
 211         str += sprintf(str, "\n");
 212         return str - buf;
 213 }
 214
 215 static ssize_t sprintf_string(char *str, int len, char *buf)
 216 {
 217         return sprintf(str, "%.*s\n", len, buf);
 218 }
 219
 220 /*
 221  * Helper function to verify the IBFT header.
 222  */
 223 static int ibft_verify_hdr(char *t, struct ibft_hdr *hdr, int id, int length)
 224 {
 225         if (hdr->id != id) {
 226                 printk(KERN_ERR "iBFT error: We expected the %s " \
 227                                 "field header.id to have %d but " \
 228                                 "found %d instead!\n", t, id, hdr->id);
 229                 return -ENODEV;
 230         }
 231         if (hdr->length != length) {
 232                 printk(KERN_ERR "iBFT error: We expected the %s " \
 233                                 "field header.length to have %d but " \
 234                                 "found %d instead!\n", t, length, hdr->length);
 235                 return -ENODEV;
 236         }
 237
 238         return 0;
 239 }
 240
 241 /*
 242  *  Routines for parsing the iBFT data to be human readable.
 243  */
 244 static ssize_t ibft_attr_show_initiator(void *data, int type, char *buf)
 245 {
 246         struct ibft_kobject *entry = data;
 247         struct ibft_initiator *initiator = entry->initiator;
 248         void *ibft_loc = entry->header;
 249         char *str = buf;
 250
 251         if (!initiator)
 252                 return 0;
 253
 254         switch (type) {
 255         case ISCSI_BOOT_INI_INDEX:
 256                 str += sprintf(str, "%d\n", initiator->hdr.index);
 257                 break;
 258         case ISCSI_BOOT_INI_FLAGS:
 259                 str += sprintf(str, "%d\n", initiator->hdr.flags);
 260                 break;
 261         case ISCSI_BOOT_INI_ISNS_SERVER:
 262                 str += sprintf_ipaddr(str, initiator->isns_server);
 263                 break;
 264         case ISCSI_BOOT_INI_SLP_SERVER:
 265                 str += sprintf_ipaddr(str, initiator->slp_server);
 266                 break;
 267         case ISCSI_BOOT_INI_PRI_RADIUS_SERVER:
 268                 str += sprintf_ipaddr(str, initiator->pri_radius_server);
 269                 break;
 270         case ISCSI_BOOT_INI_SEC_RADIUS_SERVER:
 271                 str += sprintf_ipaddr(str, initiator->sec_radius_server);
 272                 break;
 273         case ISCSI_BOOT_INI_INITIATOR_NAME:
 274                 str += sprintf_string(str, initiator->initiator_name_len,
 275                                       (char *)ibft_loc +
 276                                       initiator->initiator_name_off);
 277                 break;
 278         default:
 279                 break;
 280         }
 281
 282         return str - buf;
 283 }
 284
 285 static ssize_t ibft_attr_show_nic(void *data, int type, char *buf)
 286 {
 287         struct ibft_kobject *entry = data;
 288         struct ibft_nic *nic = entry->nic;
 289         void *ibft_loc = entry->header;
 290         char *str = buf;
 291         __be32 val;
 292
 293         if (!nic)
 294                 return 0;
 295
 296         switch (type) {
 297         case ISCSI_BOOT_ETH_INDEX:
 298                 str += sprintf(str, "%d\n", nic->hdr.index);
 299                 break;
 300         case ISCSI_BOOT_ETH_FLAGS:
 301                 str += sprintf(str, "%d\n", nic->hdr.flags);
 302                 break;
 303         case ISCSI_BOOT_ETH_IP_ADDR:
 304                 str += sprintf_ipaddr(str, nic->ip_addr);
 305                 break;
 306         case ISCSI_BOOT_ETH_SUBNET_MASK:
 307                 val = cpu_to_be32(~((1 << (32-nic->subnet_mask_prefix))-1));
 308                 str += sprintf(str, "%pI4", &val);
 309                 break;
 310         case ISCSI_BOOT_ETH_ORIGIN:
 311                 str += sprintf(str, "%d\n", nic->origin);
 312                 break;
 313         case ISCSI_BOOT_ETH_GATEWAY:
 314                 str += sprintf_ipaddr(str, nic->gateway);
 315                 break;
 316         case ISCSI_BOOT_ETH_PRIMARY_DNS:
 317                 str += sprintf_ipaddr(str, nic->primary_dns);
 318                 break;
 319         case ISCSI_BOOT_ETH_SECONDARY_DNS:
 320                 str += sprintf_ipaddr(str, nic->secondary_dns);
 321                 break;
 322         case ISCSI_BOOT_ETH_DHCP:
 323                 str += sprintf_ipaddr(str, nic->dhcp);
 324                 break;
 325         case ISCSI_BOOT_ETH_VLAN:
 326                 str += sprintf(str, "%d\n", nic->vlan);
 327                 break;
 328         case ISCSI_BOOT_ETH_MAC:
 329                 str += sprintf(str, "%pM\n", nic->mac);
 330                 break;
 331         case ISCSI_BOOT_ETH_HOSTNAME:
 332                 str += sprintf_string(str, nic->hostname_len,
 333                                       (char *)ibft_loc + nic->hostname_off);
 334                 break;
 335         default:
 336                 break;
 337         }
 338
 339         return str - buf;
 340 };
 341
 342 static ssize_t ibft_attr_show_target(void *data, int type, char *buf)
 343 {
 344         struct ibft_kobject *entry = data;
 345         struct ibft_tgt *tgt = entry->tgt;
 346         void *ibft_loc = entry->header;
 347         char *str = buf;
 348         int i;
 349
 350         if (!tgt)
 351                 return 0;
 352
 353         switch (type) {
 354         case ISCSI_BOOT_TGT_INDEX:
 355                 str += sprintf(str, "%d\n", tgt->hdr.index);
 356                 break;
 357         case ISCSI_BOOT_TGT_FLAGS:
 358                 str += sprintf(str, "%d\n", tgt->hdr.flags);
 359                 break;
 360         case ISCSI_BOOT_TGT_IP_ADDR:
 361                 str += sprintf_ipaddr(str, tgt->ip_addr);
 362                 break;
 363         case ISCSI_BOOT_TGT_PORT:
 364                 str += sprintf(str, "%d\n", tgt->port);
 365                 break;
 366         case ISCSI_BOOT_TGT_LUN:
 367                 for (i = 0; i < 8; i++)
 368                         str += sprintf(str, "%x", (u8)tgt->lun[i]);
 369                 str += sprintf(str, "\n");
 370                 break;
 371         case ISCSI_BOOT_TGT_NIC_ASSOC:
 372                 str += sprintf(str, "%d\n", tgt->nic_assoc);
 373                 break;
 374         case ISCSI_BOOT_TGT_CHAP_TYPE:
 375                 str += sprintf(str, "%d\n", tgt->chap_type);
 376                 break;
 377         case ISCSI_BOOT_TGT_NAME:
 378                 str += sprintf_string(str, tgt->tgt_name_len,
 379                                       (char *)ibft_loc + tgt->tgt_name_off);
 380                 break;
 381         case ISCSI_BOOT_TGT_CHAP_NAME:
 382                 str += sprintf_string(str, tgt->chap_name_len,
 383                                       (char *)ibft_loc + tgt->chap_name_off);
 384                 break;
 385         case ISCSI_BOOT_TGT_CHAP_SECRET:
 386                 str += sprintf_string(str, tgt->chap_secret_len,
 387                                       (char *)ibft_loc + tgt->chap_secret_off);
 388                 break;
 389         case ISCSI_BOOT_TGT_REV_CHAP_NAME:
 390                 str += sprintf_string(str, tgt->rev_chap_name_len,
 391                                       (char *)ibft_loc +
 392                                       tgt->rev_chap_name_off);
 393                 break;
 394         case ISCSI_BOOT_TGT_REV_CHAP_SECRET:
 395                 str += sprintf_string(str, tgt->rev_chap_secret_len,
 396                                       (char *)ibft_loc +
 397                                       tgt->rev_chap_secret_off);
 398                 break;
 399         default:
 400                 break;
 401         }
 402
 403         return str - buf;
 404 }
 405
 406 static int __init ibft_check_device(void)
 407 {
 408         int len;
 409         u8 *pos;
 410         u8 csum = 0;
 411
 412         len = ibft_addr->header.length;
 413
 414         /* Sanity checking of iBFT. */
 415         if (ibft_addr->header.revision != 1) {
 416                 printk(KERN_ERR "iBFT module supports only revision 1, " \
 417                                 "while this is %d.\n",
 418                                 ibft_addr->header.revision);
 419                 return -ENOENT;
 420         }
 421         for (pos = (u8 *)ibft_addr; pos < (u8 *)ibft_addr + len; pos++)
 422                 csum += *pos;
 423
 424         if (csum) {
 425                 printk(KERN_ERR "iBFT has incorrect checksum (0x%x)!\n", csum);
 426                 return -ENOENT;
 427         }
 428
 429         return 0;
 430 }
 431
 432 /*
 433  * Helper routiners to check to determine if the entry is valid
 434  * in the proper iBFT structure.
 435  */
 436 static mode_t ibft_check_nic_for(void *data, int type)
 437 {
 438         struct ibft_kobject *entry = data;
 439         struct ibft_nic *nic = entry->nic;
 440         mode_t rc = 0;
 441
 442         switch (type) {
 443         case ISCSI_BOOT_ETH_INDEX:
 444         case ISCSI_BOOT_ETH_FLAGS:
 445                 rc = S_IRUGO;
 446                 break;
 447         case ISCSI_BOOT_ETH_IP_ADDR:
 448                 if (memcmp(nic->ip_addr, nulls, sizeof(nic->ip_addr)))
 449                         rc = S_IRUGO;
 450                 break;
 451         case ISCSI_BOOT_ETH_SUBNET_MASK:
 452                 if (nic->subnet_mask_prefix)
 453                         rc = S_IRUGO;
 454                 break;
 455         case ISCSI_BOOT_ETH_ORIGIN:
 456                 rc = S_IRUGO;
 457                 break;
 458         case ISCSI_BOOT_ETH_GATEWAY:
 459                 if (memcmp(nic->gateway, nulls, sizeof(nic->gateway)))
 460                         rc = S_IRUGO;
 461                 break;
 462         case ISCSI_BOOT_ETH_PRIMARY_DNS:
 463                 if (memcmp(nic->primary_dns, nulls,
 464                            sizeof(nic->primary_dns)))
 465                         rc = S_IRUGO;
 466                 break;
 467         case ISCSI_BOOT_ETH_SECONDARY_DNS:
 468                 if (memcmp(nic->secondary_dns, nulls,
 469                            sizeof(nic->secondary_dns)))
 470                         rc = S_IRUGO;
 471                 break;
 472         case ISCSI_BOOT_ETH_DHCP:
 473                 if (memcmp(nic->dhcp, nulls, sizeof(nic->dhcp)))
 474                         rc = S_IRUGO;
 475                 break;
 476         case ISCSI_BOOT_ETH_VLAN:
 477         case ISCSI_BOOT_ETH_MAC:
 478                 rc = S_IRUGO;
 479                 break;
 480         case ISCSI_BOOT_ETH_HOSTNAME:
 481                 if (nic->hostname_off)
 482                         rc = S_IRUGO;
 483                 break;
 484         default:
 485                 break;
 486         }
 487
 488         return rc;
 489 }
 490
 491 static mode_t __init ibft_check_tgt_for(void *data, int type)
 492 {
 493         struct ibft_kobject *entry = data;
 494         struct ibft_tgt *tgt = entry->tgt;
 495         mode_t rc = 0;
 496
 497         switch (type) {
 498         case ISCSI_BOOT_TGT_INDEX:
 499         case ISCSI_BOOT_TGT_FLAGS:
 500         case ISCSI_BOOT_TGT_IP_ADDR:
 501         case ISCSI_BOOT_TGT_PORT:
 502         case ISCSI_BOOT_TGT_LUN:
 503         case ISCSI_BOOT_TGT_NIC_ASSOC:
 504         case ISCSI_BOOT_TGT_CHAP_TYPE:
 505                 rc = S_IRUGO;
 506         case ISCSI_BOOT_TGT_NAME:
 507                 if (tgt->tgt_name_len)
 508                         rc = S_IRUGO;
 509                 break;
 510         case ISCSI_BOOT_TGT_CHAP_NAME:
 511         case ISCSI_BOOT_TGT_CHAP_SECRET:
 512                 if (tgt->chap_name_len)
 513                         rc = S_IRUGO;
 514                 break;
 515         case ISCSI_BOOT_TGT_REV_CHAP_NAME:
 516         case ISCSI_BOOT_TGT_REV_CHAP_SECRET:
 517                 if (tgt->rev_chap_name_len)
 518                         rc = S_IRUGO;
 519                 break;
 520         default:
 521                 break;
 522         }
 523
 524         return rc;
 525 }
 526
 527 static mode_t __init ibft_check_initiator_for(void *data, int type)
 528 {
 529         struct ibft_kobject *entry = data;
 530         struct ibft_initiator *init = entry->initiator;
 531         mode_t rc = 0;
 532
 533         switch (type) {
 534         case ISCSI_BOOT_INI_INDEX:
 535         case ISCSI_BOOT_INI_FLAGS:
 536                 rc = S_IRUGO;
 537                 break;
 538         case ISCSI_BOOT_INI_ISNS_SERVER:
 539                 if (memcmp(init->isns_server, nulls,
 540                            sizeof(init->isns_server)))
 541                         rc = S_IRUGO;
 542                 break;
 543         case ISCSI_BOOT_INI_SLP_SERVER:
 544                 if (memcmp(init->slp_server, nulls,
 545                            sizeof(init->slp_server)))
 546                         rc = S_IRUGO;
 547                 break;
 548         case ISCSI_BOOT_INI_PRI_RADIUS_SERVER:
 549                 if (memcmp(init->pri_radius_server, nulls,
 550                            sizeof(init->pri_radius_server)))
 551                         rc = S_IRUGO;
 552                 break;
 553         case ISCSI_BOOT_INI_SEC_RADIUS_SERVER:
 554                 if (memcmp(init->sec_radius_server, nulls,
 555                            sizeof(init->sec_radius_server)))
 556                         rc = S_IRUGO;
 557                 break;
 558         case ISCSI_BOOT_INI_INITIATOR_NAME:
 559                 if (init->initiator_name_len)
 560                         rc = S_IRUGO;
 561                 break;
 562         default:
 563                 break;
 564         }
 565
 566         return rc;
 567 }
 568
 569 static void ibft_kobj_release(void *data)
 570 {
 571         kfree(data);
 572 }
 573
 574 /*
 575  * Helper function for ibft_register_kobjects.
 576  */
 577 static int __init ibft_create_kobject(struct acpi_table_ibft *header,
 578                                       struct ibft_hdr *hdr)
 579 {
 580         struct iscsi_boot_kobj *boot_kobj = NULL;
 581         struct ibft_kobject *ibft_kobj = NULL;
 582         struct ibft_nic *nic = (struct ibft_nic *)hdr;
 583         struct pci_dev *pci_dev;
 584         int rc = 0;
 585
 586         ibft_kobj = kzalloc(sizeof(*ibft_kobj), GFP_KERNEL);
 587         if (!ibft_kobj)
 588                 return -ENOMEM;
 589
 590         ibft_kobj->header = header;
 591         ibft_kobj->hdr = hdr;
 592
 593         switch (hdr->id) {
 594         case id_initiator:
 595                 rc = ibft_verify_hdr("initiator", hdr, id_initiator,
 596                                      sizeof(*ibft_kobj->initiator));
 597                 if (rc)
 598                         break;
 599
 600                 boot_kobj = iscsi_boot_create_initiator(boot_kset, hdr->index,
 601                                                 ibft_kobj,
 602                                                 ibft_attr_show_initiator,
 603                                                 ibft_check_initiator_for,
 604                                                 ibft_kobj_release);
 605                 if (!boot_kobj) {
 606                         rc = -ENOMEM;
 607                         goto free_ibft_obj;
 608                 }
 609                 break;
 610         case id_nic:
 611                 rc = ibft_verify_hdr("ethernet", hdr, id_nic,
 612                                      sizeof(*ibft_kobj->nic));
 613                 if (rc)
 614                         break;
 615
 616                 boot_kobj = iscsi_boot_create_ethernet(boot_kset, hdr->index,
 617                                                        ibft_kobj,
 618                                                        ibft_attr_show_nic,
 619                                                        ibft_check_nic_for,
 620                                                        ibft_kobj_release);
 621                 if (!boot_kobj) {
 622                         rc = -ENOMEM;
 623                         goto free_ibft_obj;
 624                 }
 625                 break;
 626         case id_target:
 627                 rc = ibft_verify_hdr("target", hdr, id_target,
 628                                      sizeof(*ibft_kobj->tgt));
 629                 if (rc)
 630                         break;
 631
 632                 boot_kobj = iscsi_boot_create_target(boot_kset, hdr->index,
 633                                                      ibft_kobj,
 634                                                      ibft_attr_show_target,
 635                                                      ibft_check_tgt_for,
 636                                                      ibft_kobj_release);
 637                 if (!boot_kobj) {
 638                         rc = -ENOMEM;
 639                         goto free_ibft_obj;
 640                 }
 641                 break;
 642         case id_reserved:
 643         case id_control:
 644         case id_extensions:
 645                 /* Fields which we don't support. Ignore them */
 646                 rc = 1;
 647                 break;
 648         default:
 649                 printk(KERN_ERR "iBFT has unknown structure type (%d). " \
 650                                 "Report this bug to %.6s!\n", hdr->id,
 651                                 header->header.oem_id);
 652                 rc = 1;
 653                 break;
 654         }
 655
 656         if (rc) {
 657                 /* Skip adding this kobject, but exit with non-fatal error. */
 658                 rc = 0;
 659                 goto free_ibft_obj;
 660         }
 661
 662         if (hdr->id == id_nic) {
 663                 /*
 664                 * We don't search for the device in other domains than
 665                 * zero. This is because on x86 platforms the BIOS
 666                 * executes only devices which are in domain 0. Furthermore, the
 667                 * iBFT spec doesn't have a domain id field :-(
 668                 */
 669                 pci_dev = pci_get_bus_and_slot((nic->pci_bdf & 0xff00) >> 8,
 670                                                (nic->pci_bdf & 0xff));
 671                 if (pci_dev) {
 672                         rc = sysfs_create_link(&boot_kobj->kobj,
 673                                                &pci_dev->dev.kobj, "device");
 674                         pci_dev_put(pci_dev);
 675                 }
 676         }
 677         return 0;
 678
 679 free_ibft_obj:
 680         kfree(ibft_kobj);
 681         return rc;
 682 }
 683
 684 /*
 685  * Scan the IBFT table structure for the NIC and Target fields. When
 686  * found add them on the passed-in list. We do not support the other
 687  * fields at this point, so they are skipped.
 688  */
 689 static int __init ibft_register_kobjects(struct acpi_table_ibft *header)
 690 {
 691         struct ibft_control *control = NULL;
 692         void *ptr, *end;
 693         int rc = 0;
 694         u16 offset;
 695         u16 eot_offset;
 696
 697         control = (void *)header + sizeof(*header);
 698         end = (void *)control + control->hdr.length;
 699         eot_offset = (void *)header + header->header.length - (void *)control;
 700         rc = ibft_verify_hdr("control", (struct ibft_hdr *)control, id_control,
 701                              sizeof(*control));
 702
 703         /* iBFT table safety checking */
 704         rc |= ((control->hdr.index) ? -ENODEV : 0);
 705         if (rc) {
 706                 printk(KERN_ERR "iBFT error: Control header is invalid!\n");
 707                 return rc;
 708         }
 709         for (ptr = &control->initiator_off; ptr < end; ptr += sizeof(u16)) {
 710                 offset = *(u16 *)ptr;
 711                 if (offset && offset < header->header.length &&
 712                                                 offset < eot_offset) {
 713                         rc = ibft_create_kobject(header,
 714                                                  (void *)header + offset);
 715                         if (rc)
 716                                 break;
 717                 }
 718         }
 719
 720         return rc;
 721 }
 722
 723 static void ibft_unregister(void)
 724 {
 725         struct iscsi_boot_kobj *boot_kobj, *tmp_kobj;
 726         struct ibft_kobject *ibft_kobj;
 727
 728         list_for_each_entry_safe(boot_kobj, tmp_kobj,
 729                                  &boot_kset->kobj_list, list) {
 730                 ibft_kobj = boot_kobj->data;
 731                 if (ibft_kobj->hdr->id == id_nic)
 732                         sysfs_remove_link(&boot_kobj->kobj, "device");
 733         };
 734 }
 735
 736 static void ibft_cleanup(void)
 737 {
 738         if (boot_kset) {
 739                 ibft_unregister();
 740                 iscsi_boot_destroy_kset(boot_kset);
 741         }
 742 }
 743
 744 static void __exit ibft_exit(void)
 745 {
 746         ibft_cleanup();
 747 }
 748
 749 /*
 750  * ibft_init() - creates sysfs tree entries for the iBFT data.
 751  */
 752 static int __init ibft_init(void)
 753 {
 754         int rc = 0;
 755
 756         if (ibft_addr) {
 757                 printk(KERN_INFO "iBFT detected at 0x%llx.\n",
 758                        (u64)isa_virt_to_bus(ibft_addr));
 759
 760                 rc = ibft_check_device();
 761                 if (rc)
 762                         return rc;
 763
 764                 boot_kset = iscsi_boot_create_kset("ibft");
 765                 if (!boot_kset)
 766                         return -ENOMEM;
 767
 768                 /* Scan the IBFT for data and register the kobjects. */
 769                 rc = ibft_register_kobjects(ibft_addr);
 770                 if (rc)
 771                         goto out_free;
 772         } else
 773                 printk(KERN_INFO "No iBFT detected.\n");
 774
 775         return 0;
 776
 777 out_free:
 778         ibft_cleanup();
 779         return rc;
 780 }
 781
 782 module_init(ibft_init);
 783 module_exit(ibft_exit);