kernel/drivers/scsi/isci/probe_roms.c

   1 /*
   2  * This file is provided under a dual BSD/GPLv2 license.  When using or
   3  * redistributing this file, you may do so under either license.
   4  *
   5  * GPL LICENSE SUMMARY
   6  *
   7  * Copyright(c) 2008 - 2011 Intel Corporation. All rights reserved.
   8  *
   9  * This program is free software; you can redistribute it and/or modify
  10  * it under the terms of version 2 of the GNU General Public License as
  11  * published by the Free Software Foundation.
  12  *
  13  * This program is distributed in the hope that it will be useful, but
  14  * WITHOUT ANY WARRANTY; without even the implied warranty of
  15  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  16  * General Public License for more details.
  17  *
  18  * You should have received a copy of the GNU General Public License
  19  * along with this program; if not, write to the Free Software
  20  * Foundation, Inc., 51 Franklin St - Fifth Floor, Boston, MA 02110-1301 USA.
  21  * The full GNU General Public License is included in this distribution
  22  * in the file called LICENSE.GPL.
  23  */
  24
  25 /* probe_roms - scan for oem parameters */
  26
  27 #include <linux/kernel.h>
  28 #include <linux/firmware.h>
  29 #include <linux/uaccess.h>
  30 #include <linux/efi.h>
  31 #include <asm/probe_roms.h>
  32
  33 #include "isci.h"
  34 #include "task.h"
  35 #include "probe_roms.h"
  36
  37 static efi_char16_t isci_efivar_name[] = {
  38         'R', 's', 't', 'S', 'c', 'u', 'O'
  39 };
  40
  41 struct isci_orom *isci_request_oprom(struct pci_dev *pdev)
  42 {
  43         void __iomem *oprom = pci_map_biosrom(pdev);
  44         struct isci_orom *rom = NULL;
  45         size_t len, i;
  46         int j;
  47         char oem_sig[4];
  48         struct isci_oem_hdr oem_hdr;
  49         u8 *tmp, sum;
  50
  51         if (!oprom)
  52                 return NULL;
  53
  54         len = pci_biosrom_size(pdev);
  55         rom = devm_kzalloc(&pdev->dev, sizeof(*rom), GFP_KERNEL);
  56         if (!rom) {
  57                 dev_warn(&pdev->dev,
  58                          "Unable to allocate memory for orom\n");
  59                 return NULL;
  60         }
  61
  62         for (i = 0; i < len && rom; i += ISCI_OEM_SIG_SIZE) {
  63                 memcpy_fromio(oem_sig, oprom + i, ISCI_OEM_SIG_SIZE);
  64
  65                 /* we think we found the OEM table */
  66                 if (memcmp(oem_sig, ISCI_OEM_SIG, ISCI_OEM_SIG_SIZE) == 0) {
  67                         size_t copy_len;
  68
  69                         memcpy_fromio(&oem_hdr, oprom + i, sizeof(oem_hdr));
  70
  71                         copy_len = min(oem_hdr.len - sizeof(oem_hdr),
  72                                        sizeof(*rom));
  73
  74                         memcpy_fromio(rom,
  75                                       oprom + i + sizeof(oem_hdr),
  76                                       copy_len);
  77
  78                         /* calculate checksum */
  79                         tmp = (u8 *)&oem_hdr;
  80                         for (j = 0, sum = 0; j < sizeof(oem_hdr); j++, tmp++)
  81                                 sum += *tmp;
  82
  83                         tmp = (u8 *)rom;
  84                         for (j = 0; j < sizeof(*rom); j++, tmp++)
  85                                 sum += *tmp;
  86
  87                         if (sum != 0) {
  88                                 dev_warn(&pdev->dev,
  89                                          "OEM table checksum failed\n");
  90                                 continue;
  91                         }
  92
  93                         /* keep going if that's not the oem param table */
  94                         if (memcmp(rom->hdr.signature,
  95                                    ISCI_ROM_SIG,
  96                                    ISCI_ROM_SIG_SIZE) != 0)
  97                                 continue;
  98
  99                         dev_info(&pdev->dev,
 100                                  "OEM parameter table found in OROM\n");
 101                         break;
 102                 }
 103         }
 104
 105         if (i >= len) {
 106                 dev_err(&pdev->dev, "oprom parse error\n");
 107                 rom = NULL;
 108         }
 109         pci_unmap_biosrom(oprom);
 110
 111         return rom;
 112 }
 113
 114 struct isci_orom *isci_request_firmware(struct pci_dev *pdev, const struct firmware *fw)
 115 {
 116         struct isci_orom *orom = NULL, *data;
 117         int i, j;
 118
 119         if (request_firmware(&fw, ISCI_FW_NAME, &pdev->dev) != 0)
 120                 return NULL;
 121
 122         if (fw->size < sizeof(*orom))
 123                 goto out;
 124
 125         data = (struct isci_orom *)fw->data;
 126
 127         if (strncmp(ISCI_ROM_SIG, data->hdr.signature,
 128                     strlen(ISCI_ROM_SIG)) != 0)
 129                 goto out;
 130
 131         orom = devm_kzalloc(&pdev->dev, fw->size, GFP_KERNEL);
 132         if (!orom)
 133                 goto out;
 134
 135         memcpy(orom, fw->data, fw->size);
 136
 137         if (is_c0(pdev) || is_c1(pdev))
 138                 goto out;
 139
 140         /*
 141          * deprecated: override default amp_control for pre-preproduction
 142          * silicon revisions
 143          */
 144         for (i = 0; i < ARRAY_SIZE(orom->ctrl); i++)
 145                 for (j = 0; j < ARRAY_SIZE(orom->ctrl[i].phys); j++) {
 146                         orom->ctrl[i].phys[j].afe_tx_amp_control0 = 0xe7c03;
 147                         orom->ctrl[i].phys[j].afe_tx_amp_control1 = 0xe7c03;
 148                         orom->ctrl[i].phys[j].afe_tx_amp_control2 = 0xe7c03;
 149                         orom->ctrl[i].phys[j].afe_tx_amp_control3 = 0xe7c03;
 150                 }
 151  out:
 152         release_firmware(fw);
 153
 154         return orom;
 155 }
 156
 157 static struct efi *get_efi(void)
 158 {
 159 #ifdef CONFIG_EFI
 160         return &efi;
 161 #else
 162         return NULL;
 163 #endif
 164 }
 165
 166 struct isci_orom *isci_get_efi_var(struct pci_dev *pdev)
 167 {
 168         efi_status_t status;
 169         struct isci_orom *rom;
 170         struct isci_oem_hdr *oem_hdr;
 171         u8 *tmp, sum;
 172         int j;
 173         unsigned long data_len;
 174         u8 *efi_data;
 175         u32 efi_attrib = 0;
 176
 177         data_len = 1024;
 178         efi_data = devm_kzalloc(&pdev->dev, data_len, GFP_KERNEL);
 179         if (!efi_data) {
 180                 dev_warn(&pdev->dev,
 181                          "Unable to allocate memory for EFI data\n");
 182                 return NULL;
 183         }
 184
 185         rom = (struct isci_orom *)(efi_data + sizeof(struct isci_oem_hdr));
 186
 187         if (get_efi())
 188                 status = get_efi()->get_variable(isci_efivar_name,
 189                                                  &ISCI_EFI_VENDOR_GUID,
 190                                                  &efi_attrib,
 191                                                  &data_len,
 192                                                  efi_data);
 193         else
 194                 status = EFI_NOT_FOUND;
 195
 196         if (status != EFI_SUCCESS) {
 197                 dev_warn(&pdev->dev,
 198                          "Unable to obtain EFI var data for OEM parms\n");
 199                 return NULL;
 200         }
 201
 202         oem_hdr = (struct isci_oem_hdr *)efi_data;
 203
 204         if (memcmp(oem_hdr->sig, ISCI_OEM_SIG, ISCI_OEM_SIG_SIZE) != 0) {
 205                 dev_warn(&pdev->dev,
 206                          "Invalid OEM header signature\n");
 207                 return NULL;
 208         }
 209
 210         /* calculate checksum */
 211         tmp = (u8 *)efi_data;
 212         for (j = 0, sum = 0; j < (sizeof(*oem_hdr) + sizeof(*rom)); j++, tmp++)
 213                 sum += *tmp;
 214
 215         if (sum != 0) {
 216                 dev_warn(&pdev->dev,
 217                          "OEM table checksum failed\n");
 218                 return NULL;
 219         }
 220
 221         if (memcmp(rom->hdr.signature,
 222                    ISCI_ROM_SIG,
 223                    ISCI_ROM_SIG_SIZE) != 0) {
 224                 dev_warn(&pdev->dev,
 225                          "Invalid OEM table signature\n");
 226                 return NULL;
 227         }
 228
 229         return rom;
 230 }