Dan Williams | d044af1 | 2011-03-08 09:52:49 -0800 | [diff] [blame] | 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> |
Dave Jiang | 8db37aa | 2011-02-23 00:02:24 -0800 | [diff] [blame] | 30 | #include <linux/efi.h> |
Dan Williams | d044af1 | 2011-03-08 09:52:49 -0800 | [diff] [blame] | 31 | #include <asm/probe_roms.h> |
| 32 | |
| 33 | #include "isci.h" |
| 34 | #include "task.h" |
| 35 | #include "sci_controller_constants.h" |
| 36 | #include "scic_remote_device.h" |
| 37 | #include "sci_environment.h" |
| 38 | #include "probe_roms.h" |
| 39 | |
Dave Jiang | 8db37aa | 2011-02-23 00:02:24 -0800 | [diff] [blame] | 40 | struct efi_variable { |
| 41 | efi_char16_t VariableName[1024/sizeof(efi_char16_t)]; |
| 42 | efi_guid_t VendorGuid; |
| 43 | unsigned long DataSize; |
| 44 | __u8 Data[1024]; |
| 45 | efi_status_t Status; |
| 46 | __u32 Attributes; |
| 47 | } __attribute__((packed)); |
| 48 | |
Dan Williams | d044af1 | 2011-03-08 09:52:49 -0800 | [diff] [blame] | 49 | struct isci_orom *isci_request_oprom(struct pci_dev *pdev) |
| 50 | { |
| 51 | void __iomem *oprom = pci_map_biosrom(pdev); |
| 52 | struct isci_orom *rom = NULL; |
| 53 | size_t len, i; |
Dan Williams | 3b67c1f | 2011-03-08 09:53:51 -0800 | [diff] [blame] | 54 | int j; |
| 55 | char oem_sig[4]; |
| 56 | struct isci_oem_hdr oem_hdr; |
| 57 | u8 *tmp, sum; |
Dan Williams | d044af1 | 2011-03-08 09:52:49 -0800 | [diff] [blame] | 58 | |
| 59 | if (!oprom) |
| 60 | return NULL; |
| 61 | |
| 62 | len = pci_biosrom_size(pdev); |
| 63 | rom = devm_kzalloc(&pdev->dev, sizeof(*rom), GFP_KERNEL); |
Dave Jiang | 2e8320f | 2011-03-11 14:04:43 -0800 | [diff] [blame^] | 64 | if (!rom) { |
| 65 | dev_warn(&pdev->dev, |
| 66 | "Unable to allocate memory for orom\n"); |
| 67 | return NULL; |
| 68 | } |
Dan Williams | d044af1 | 2011-03-08 09:52:49 -0800 | [diff] [blame] | 69 | |
Dan Williams | 3b67c1f | 2011-03-08 09:53:51 -0800 | [diff] [blame] | 70 | for (i = 0; i < len && rom; i += ISCI_OEM_SIG_SIZE) { |
| 71 | memcpy_fromio(oem_sig, oprom + i, ISCI_OEM_SIG_SIZE); |
Dan Williams | d044af1 | 2011-03-08 09:52:49 -0800 | [diff] [blame] | 72 | |
Dan Williams | 3b67c1f | 2011-03-08 09:53:51 -0800 | [diff] [blame] | 73 | /* we think we found the OEM table */ |
| 74 | if (memcmp(oem_sig, ISCI_OEM_SIG, ISCI_OEM_SIG_SIZE) == 0) { |
| 75 | size_t copy_len; |
| 76 | |
| 77 | memcpy_fromio(&oem_hdr, oprom + i, sizeof(oem_hdr)); |
| 78 | |
| 79 | copy_len = min(oem_hdr.len - sizeof(oem_hdr), |
| 80 | sizeof(*rom)); |
| 81 | |
| 82 | memcpy_fromio(rom, |
| 83 | oprom + i + sizeof(oem_hdr), |
| 84 | copy_len); |
| 85 | |
| 86 | /* calculate checksum */ |
| 87 | tmp = (u8 *)&oem_hdr; |
| 88 | for (j = 0, sum = 0; j < sizeof(oem_hdr); j++, tmp++) |
| 89 | sum += *tmp; |
| 90 | |
| 91 | tmp = (u8 *)rom; |
| 92 | for (j = 0; j < sizeof(*rom); j++, tmp++) |
| 93 | sum += *tmp; |
| 94 | |
| 95 | if (sum != 0) { |
| 96 | dev_warn(&pdev->dev, |
| 97 | "OEM table checksum failed\n"); |
| 98 | continue; |
| 99 | } |
| 100 | |
| 101 | /* keep going if that's not the oem param table */ |
| 102 | if (memcmp(rom->hdr.signature, |
| 103 | ISCI_ROM_SIG, |
| 104 | ISCI_ROM_SIG_SIZE) != 0) |
| 105 | continue; |
| 106 | |
| 107 | dev_info(&pdev->dev, |
| 108 | "OEM parameter table found in OROM\n"); |
Dan Williams | d044af1 | 2011-03-08 09:52:49 -0800 | [diff] [blame] | 109 | break; |
| 110 | } |
| 111 | } |
| 112 | |
| 113 | if (i >= len) { |
| 114 | dev_err(&pdev->dev, "oprom parse error\n"); |
| 115 | devm_kfree(&pdev->dev, rom); |
| 116 | rom = NULL; |
| 117 | } |
| 118 | pci_unmap_biosrom(oprom); |
| 119 | |
| 120 | return rom; |
| 121 | } |
| 122 | |
| 123 | /** |
| 124 | * isci_parse_oem_parameters() - This method will take OEM parameters |
| 125 | * from the module init parameters and copy them to oem_params. This will |
| 126 | * only copy values that are not set to the module parameter default values |
| 127 | * @oem_parameters: This parameter specifies the controller default OEM |
| 128 | * parameters. It is expected that this has been initialized to the default |
| 129 | * parameters for the controller |
| 130 | * |
| 131 | * |
| 132 | */ |
| 133 | enum sci_status isci_parse_oem_parameters(union scic_oem_parameters *oem_params, |
| 134 | struct isci_orom *orom, int scu_index) |
| 135 | { |
Dan Williams | d044af1 | 2011-03-08 09:52:49 -0800 | [diff] [blame] | 136 | /* check for valid inputs */ |
Dave Jiang | 02839a8b5 | 2011-02-24 17:45:57 -0800 | [diff] [blame] | 137 | if (scu_index < 0 || scu_index > SCI_MAX_CONTROLLERS || |
| 138 | scu_index > orom->hdr.num_elements || !oem_params) |
Dan Williams | d044af1 | 2011-03-08 09:52:49 -0800 | [diff] [blame] | 139 | return -EINVAL; |
| 140 | |
Dave Jiang | 02839a8b5 | 2011-02-24 17:45:57 -0800 | [diff] [blame] | 141 | memcpy(oem_params, |
| 142 | &orom->ctrl[scu_index], |
| 143 | sizeof(struct scic_sds_oem_params)); |
Dan Williams | d044af1 | 2011-03-08 09:52:49 -0800 | [diff] [blame] | 144 | |
| 145 | return 0; |
| 146 | } |
| 147 | |
| 148 | struct isci_orom *isci_request_firmware(struct pci_dev *pdev, const struct firmware *fw) |
| 149 | { |
| 150 | struct isci_orom *orom = NULL, *data; |
| 151 | |
| 152 | if (request_firmware(&fw, ISCI_FW_NAME, &pdev->dev) != 0) |
| 153 | return NULL; |
| 154 | |
| 155 | if (fw->size < sizeof(*orom)) |
| 156 | goto out; |
| 157 | |
| 158 | data = (struct isci_orom *)fw->data; |
| 159 | |
| 160 | if (strncmp(ISCI_ROM_SIG, data->hdr.signature, |
| 161 | strlen(ISCI_ROM_SIG)) != 0) |
| 162 | goto out; |
| 163 | |
| 164 | orom = devm_kzalloc(&pdev->dev, fw->size, GFP_KERNEL); |
| 165 | if (!orom) |
| 166 | goto out; |
| 167 | |
| 168 | memcpy(orom, fw->data, fw->size); |
| 169 | |
| 170 | out: |
| 171 | release_firmware(fw); |
| 172 | |
| 173 | return orom; |
| 174 | } |
Dave Jiang | 8db37aa | 2011-02-23 00:02:24 -0800 | [diff] [blame] | 175 | |
| 176 | static struct efi *get_efi(void) |
| 177 | { |
| 178 | #ifdef CONFIG_EFI |
| 179 | return &efi; |
| 180 | #else |
| 181 | return NULL; |
| 182 | #endif |
| 183 | } |
| 184 | |
| 185 | struct isci_orom *isci_get_efi_var(struct pci_dev *pdev) |
| 186 | { |
| 187 | struct efi_variable *evar; |
| 188 | efi_status_t status; |
Dave Jiang | 2e8320f | 2011-03-11 14:04:43 -0800 | [diff] [blame^] | 189 | struct isci_orom *rom = NULL; |
| 190 | struct isci_oem_hdr *oem_hdr; |
| 191 | u8 *tmp, sum; |
| 192 | int j; |
| 193 | size_t copy_len; |
Dave Jiang | 8db37aa | 2011-02-23 00:02:24 -0800 | [diff] [blame] | 194 | |
| 195 | evar = devm_kzalloc(&pdev->dev, |
| 196 | sizeof(struct efi_variable), |
| 197 | GFP_KERNEL); |
| 198 | if (!evar) { |
| 199 | dev_warn(&pdev->dev, |
| 200 | "Unable to allocate memory for EFI var\n"); |
| 201 | return NULL; |
| 202 | } |
| 203 | |
Dave Jiang | 2e8320f | 2011-03-11 14:04:43 -0800 | [diff] [blame^] | 204 | rom = devm_kzalloc(&pdev->dev, sizeof(*rom), GFP_KERNEL); |
| 205 | if (!rom) { |
| 206 | dev_warn(&pdev->dev, |
| 207 | "Unable to allocate memory for orom\n"); |
| 208 | return NULL; |
| 209 | } |
| 210 | |
| 211 | for (j = 0; j < strlen(ISCI_EFI_VAR_NAME) + 1; j++) |
| 212 | evar->VariableName[j] = ISCI_EFI_VAR_NAME[j]; |
| 213 | |
Dave Jiang | 8db37aa | 2011-02-23 00:02:24 -0800 | [diff] [blame] | 214 | evar->DataSize = 1024; |
| 215 | evar->VendorGuid = ISCI_EFI_VENDOR_GUID; |
| 216 | evar->Attributes = ISCI_EFI_ATTRIBUTES; |
| 217 | |
| 218 | if (get_efi()) |
| 219 | status = get_efi()->get_variable(evar->VariableName, |
| 220 | &evar->VendorGuid, |
| 221 | &evar->Attributes, |
| 222 | &evar->DataSize, |
| 223 | evar->Data); |
| 224 | else |
| 225 | status = EFI_NOT_FOUND; |
| 226 | |
Dave Jiang | 2e8320f | 2011-03-11 14:04:43 -0800 | [diff] [blame^] | 227 | if (status != EFI_SUCCESS) { |
Dave Jiang | 8db37aa | 2011-02-23 00:02:24 -0800 | [diff] [blame] | 228 | dev_warn(&pdev->dev, |
| 229 | "Unable to obtain EFI variable for OEM parms\n"); |
Dave Jiang | 2e8320f | 2011-03-11 14:04:43 -0800 | [diff] [blame^] | 230 | return NULL; |
| 231 | } |
Dave Jiang | 8db37aa | 2011-02-23 00:02:24 -0800 | [diff] [blame] | 232 | |
Dave Jiang | 2e8320f | 2011-03-11 14:04:43 -0800 | [diff] [blame^] | 233 | oem_hdr = (struct isci_oem_hdr *)evar->Data; |
| 234 | |
| 235 | if (memcmp(oem_hdr->sig, ISCI_OEM_SIG, ISCI_OEM_SIG_SIZE) != 0) { |
Dave Jiang | 8db37aa | 2011-02-23 00:02:24 -0800 | [diff] [blame] | 236 | dev_warn(&pdev->dev, |
Dave Jiang | 2e8320f | 2011-03-11 14:04:43 -0800 | [diff] [blame^] | 237 | "Invalid OEM header signature\n"); |
| 238 | return NULL; |
| 239 | } |
Dave Jiang | 8db37aa | 2011-02-23 00:02:24 -0800 | [diff] [blame] | 240 | |
Dave Jiang | 2e8320f | 2011-03-11 14:04:43 -0800 | [diff] [blame^] | 241 | /* calculate checksum */ |
| 242 | tmp = (u8 *)oem_hdr; |
| 243 | for (j = 0, sum = 0; j < sizeof(oem_hdr); j++, tmp++) |
| 244 | sum += *tmp; |
Dave Jiang | 8db37aa | 2011-02-23 00:02:24 -0800 | [diff] [blame] | 245 | |
Dave Jiang | 2e8320f | 2011-03-11 14:04:43 -0800 | [diff] [blame^] | 246 | tmp = (u8 *)rom; |
| 247 | for (j = 0; j < sizeof(*rom); j++, tmp++) |
| 248 | sum += *tmp; |
| 249 | |
| 250 | if (sum != 0) { |
| 251 | dev_warn(&pdev->dev, |
| 252 | "OEM table checksum failed\n"); |
| 253 | return NULL; |
| 254 | } |
| 255 | |
| 256 | copy_len = min(evar->DataSize, |
| 257 | min(oem_hdr->len - sizeof(*oem_hdr), |
| 258 | sizeof(*rom))); |
| 259 | |
| 260 | memcpy(rom, (char *)evar->Data + sizeof(*oem_hdr), copy_len); |
| 261 | |
| 262 | if (memcmp(rom->hdr.signature, |
| 263 | ISCI_ROM_SIG, |
| 264 | ISCI_ROM_SIG_SIZE) != 0) { |
| 265 | dev_warn(&pdev->dev, |
| 266 | "Invalid OEM table signature\n"); |
| 267 | return NULL; |
| 268 | } |
| 269 | |
| 270 | return rom; |
Dave Jiang | 8db37aa | 2011-02-23 00:02:24 -0800 | [diff] [blame] | 271 | } |