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" |
Dan Williams | d044af1 | 2011-03-08 09:52:49 -0800 | [diff] [blame] | 35 | #include "probe_roms.h" |
| 36 | |
James Bottomley | a5ec7f86 | 2011-07-03 14:14:45 -0500 | [diff] [blame^] | 37 | static efi_char16_t isci_efivar_name[] = { |
| 38 | 'R', 's', 't', 'S', 'c', 'u', 'O' |
| 39 | }; |
Dave Jiang | 8db37aa | 2011-02-23 00:02:24 -0800 | [diff] [blame] | 40 | |
Dan Williams | d044af1 | 2011-03-08 09:52:49 -0800 | [diff] [blame] | 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; |
Dan Williams | 3b67c1f | 2011-03-08 09:53:51 -0800 | [diff] [blame] | 46 | int j; |
| 47 | char oem_sig[4]; |
| 48 | struct isci_oem_hdr oem_hdr; |
| 49 | u8 *tmp, sum; |
Dan Williams | d044af1 | 2011-03-08 09:52:49 -0800 | [diff] [blame] | 50 | |
| 51 | if (!oprom) |
| 52 | return NULL; |
| 53 | |
| 54 | len = pci_biosrom_size(pdev); |
| 55 | rom = devm_kzalloc(&pdev->dev, sizeof(*rom), GFP_KERNEL); |
Dave Jiang | 2e8320f | 2011-03-11 14:04:43 -0800 | [diff] [blame] | 56 | if (!rom) { |
| 57 | dev_warn(&pdev->dev, |
| 58 | "Unable to allocate memory for orom\n"); |
| 59 | return NULL; |
| 60 | } |
Dan Williams | d044af1 | 2011-03-08 09:52:49 -0800 | [diff] [blame] | 61 | |
Dan Williams | 3b67c1f | 2011-03-08 09:53:51 -0800 | [diff] [blame] | 62 | for (i = 0; i < len && rom; i += ISCI_OEM_SIG_SIZE) { |
| 63 | memcpy_fromio(oem_sig, oprom + i, ISCI_OEM_SIG_SIZE); |
Dan Williams | d044af1 | 2011-03-08 09:52:49 -0800 | [diff] [blame] | 64 | |
Dan Williams | 3b67c1f | 2011-03-08 09:53:51 -0800 | [diff] [blame] | 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"); |
Dan Williams | d044af1 | 2011-03-08 09:52:49 -0800 | [diff] [blame] | 101 | break; |
| 102 | } |
| 103 | } |
| 104 | |
| 105 | if (i >= len) { |
| 106 | dev_err(&pdev->dev, "oprom parse error\n"); |
| 107 | devm_kfree(&pdev->dev, rom); |
| 108 | rom = NULL; |
| 109 | } |
| 110 | pci_unmap_biosrom(oprom); |
| 111 | |
| 112 | return rom; |
| 113 | } |
| 114 | |
Dan Williams | 89a7301 | 2011-06-30 19:14:33 -0700 | [diff] [blame] | 115 | enum sci_status isci_parse_oem_parameters(struct sci_oem_params *oem, |
Dan Williams | d044af1 | 2011-03-08 09:52:49 -0800 | [diff] [blame] | 116 | struct isci_orom *orom, int scu_index) |
| 117 | { |
Dan Williams | d044af1 | 2011-03-08 09:52:49 -0800 | [diff] [blame] | 118 | /* check for valid inputs */ |
Maciej Patelczyk | 7cafbf1 | 2011-06-21 22:03:13 +0000 | [diff] [blame] | 119 | if (scu_index < 0 || scu_index >= SCI_MAX_CONTROLLERS || |
Dan Williams | 89a7301 | 2011-06-30 19:14:33 -0700 | [diff] [blame] | 120 | scu_index > orom->hdr.num_elements || !oem) |
Dan Williams | d044af1 | 2011-03-08 09:52:49 -0800 | [diff] [blame] | 121 | return -EINVAL; |
| 122 | |
Dan Williams | 89a7301 | 2011-06-30 19:14:33 -0700 | [diff] [blame] | 123 | *oem = orom->ctrl[scu_index]; |
Dan Williams | d044af1 | 2011-03-08 09:52:49 -0800 | [diff] [blame] | 124 | return 0; |
| 125 | } |
| 126 | |
| 127 | struct isci_orom *isci_request_firmware(struct pci_dev *pdev, const struct firmware *fw) |
| 128 | { |
| 129 | struct isci_orom *orom = NULL, *data; |
Adam Gruchala | dbb0743 | 2011-06-01 22:31:03 +0000 | [diff] [blame] | 130 | int i, j; |
Dan Williams | d044af1 | 2011-03-08 09:52:49 -0800 | [diff] [blame] | 131 | |
| 132 | if (request_firmware(&fw, ISCI_FW_NAME, &pdev->dev) != 0) |
| 133 | return NULL; |
| 134 | |
| 135 | if (fw->size < sizeof(*orom)) |
| 136 | goto out; |
| 137 | |
| 138 | data = (struct isci_orom *)fw->data; |
| 139 | |
| 140 | if (strncmp(ISCI_ROM_SIG, data->hdr.signature, |
| 141 | strlen(ISCI_ROM_SIG)) != 0) |
| 142 | goto out; |
| 143 | |
| 144 | orom = devm_kzalloc(&pdev->dev, fw->size, GFP_KERNEL); |
| 145 | if (!orom) |
| 146 | goto out; |
| 147 | |
| 148 | memcpy(orom, fw->data, fw->size); |
| 149 | |
Dan Williams | dc00c8b | 2011-07-01 11:41:21 -0700 | [diff] [blame] | 150 | if (is_c0(pdev)) |
| 151 | goto out; |
| 152 | |
Adam Gruchala | dbb0743 | 2011-06-01 22:31:03 +0000 | [diff] [blame] | 153 | /* |
| 154 | * deprecated: override default amp_control for pre-preproduction |
| 155 | * silicon revisions |
| 156 | */ |
Adam Gruchala | dbb0743 | 2011-06-01 22:31:03 +0000 | [diff] [blame] | 157 | for (i = 0; i < ARRAY_SIZE(orom->ctrl); i++) |
| 158 | for (j = 0; j < ARRAY_SIZE(orom->ctrl[i].phys); j++) { |
| 159 | orom->ctrl[i].phys[j].afe_tx_amp_control0 = 0xe7c03; |
| 160 | orom->ctrl[i].phys[j].afe_tx_amp_control1 = 0xe7c03; |
| 161 | orom->ctrl[i].phys[j].afe_tx_amp_control2 = 0xe7c03; |
| 162 | orom->ctrl[i].phys[j].afe_tx_amp_control3 = 0xe7c03; |
| 163 | } |
Dan Williams | d044af1 | 2011-03-08 09:52:49 -0800 | [diff] [blame] | 164 | out: |
| 165 | release_firmware(fw); |
| 166 | |
| 167 | return orom; |
| 168 | } |
Dave Jiang | 8db37aa | 2011-02-23 00:02:24 -0800 | [diff] [blame] | 169 | |
| 170 | static struct efi *get_efi(void) |
| 171 | { |
Dave Jiang | bf482c6 | 2011-05-25 05:04:35 +0000 | [diff] [blame] | 172 | #ifdef CONFIG_EFI |
Dave Jiang | 8db37aa | 2011-02-23 00:02:24 -0800 | [diff] [blame] | 173 | return &efi; |
Dave Jiang | bf482c6 | 2011-05-25 05:04:35 +0000 | [diff] [blame] | 174 | #else |
Dave Jiang | 8db37aa | 2011-02-23 00:02:24 -0800 | [diff] [blame] | 175 | return NULL; |
Dave Jiang | bf482c6 | 2011-05-25 05:04:35 +0000 | [diff] [blame] | 176 | #endif |
Dave Jiang | 8db37aa | 2011-02-23 00:02:24 -0800 | [diff] [blame] | 177 | } |
| 178 | |
| 179 | struct isci_orom *isci_get_efi_var(struct pci_dev *pdev) |
| 180 | { |
Dave Jiang | 8db37aa | 2011-02-23 00:02:24 -0800 | [diff] [blame] | 181 | efi_status_t status; |
Dave Jiang | bf482c6 | 2011-05-25 05:04:35 +0000 | [diff] [blame] | 182 | struct isci_orom *rom; |
Dave Jiang | 2e8320f | 2011-03-11 14:04:43 -0800 | [diff] [blame] | 183 | struct isci_oem_hdr *oem_hdr; |
| 184 | u8 *tmp, sum; |
| 185 | int j; |
James Bottomley | a5ec7f86 | 2011-07-03 14:14:45 -0500 | [diff] [blame^] | 186 | unsigned long data_len; |
Dave Jiang | bf482c6 | 2011-05-25 05:04:35 +0000 | [diff] [blame] | 187 | u8 *efi_data; |
| 188 | u32 efi_attrib = 0; |
Dave Jiang | 8db37aa | 2011-02-23 00:02:24 -0800 | [diff] [blame] | 189 | |
Dave Jiang | bf482c6 | 2011-05-25 05:04:35 +0000 | [diff] [blame] | 190 | data_len = 1024; |
| 191 | efi_data = devm_kzalloc(&pdev->dev, data_len, GFP_KERNEL); |
| 192 | if (!efi_data) { |
Dave Jiang | 8db37aa | 2011-02-23 00:02:24 -0800 | [diff] [blame] | 193 | dev_warn(&pdev->dev, |
Dave Jiang | bf482c6 | 2011-05-25 05:04:35 +0000 | [diff] [blame] | 194 | "Unable to allocate memory for EFI data\n"); |
Dave Jiang | 8db37aa | 2011-02-23 00:02:24 -0800 | [diff] [blame] | 195 | return NULL; |
| 196 | } |
| 197 | |
Dave Jiang | bf482c6 | 2011-05-25 05:04:35 +0000 | [diff] [blame] | 198 | rom = (struct isci_orom *)(efi_data + sizeof(struct isci_oem_hdr)); |
Dave Jiang | 8db37aa | 2011-02-23 00:02:24 -0800 | [diff] [blame] | 199 | |
| 200 | if (get_efi()) |
Dave Jiang | bf482c6 | 2011-05-25 05:04:35 +0000 | [diff] [blame] | 201 | status = get_efi()->get_variable(isci_efivar_name, |
| 202 | &ISCI_EFI_VENDOR_GUID, |
| 203 | &efi_attrib, |
| 204 | &data_len, |
| 205 | efi_data); |
Dave Jiang | 8db37aa | 2011-02-23 00:02:24 -0800 | [diff] [blame] | 206 | else |
| 207 | status = EFI_NOT_FOUND; |
| 208 | |
Dave Jiang | 2e8320f | 2011-03-11 14:04:43 -0800 | [diff] [blame] | 209 | if (status != EFI_SUCCESS) { |
Dave Jiang | 8db37aa | 2011-02-23 00:02:24 -0800 | [diff] [blame] | 210 | dev_warn(&pdev->dev, |
Dave Jiang | bf482c6 | 2011-05-25 05:04:35 +0000 | [diff] [blame] | 211 | "Unable to obtain EFI var data for OEM parms\n"); |
Dave Jiang | 2e8320f | 2011-03-11 14:04:43 -0800 | [diff] [blame] | 212 | return NULL; |
| 213 | } |
Dave Jiang | 8db37aa | 2011-02-23 00:02:24 -0800 | [diff] [blame] | 214 | |
Dave Jiang | bf482c6 | 2011-05-25 05:04:35 +0000 | [diff] [blame] | 215 | oem_hdr = (struct isci_oem_hdr *)efi_data; |
Dave Jiang | 2e8320f | 2011-03-11 14:04:43 -0800 | [diff] [blame] | 216 | |
| 217 | 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] | 218 | dev_warn(&pdev->dev, |
Dave Jiang | 2e8320f | 2011-03-11 14:04:43 -0800 | [diff] [blame] | 219 | "Invalid OEM header signature\n"); |
| 220 | return NULL; |
| 221 | } |
Dave Jiang | 8db37aa | 2011-02-23 00:02:24 -0800 | [diff] [blame] | 222 | |
Dave Jiang | 2e8320f | 2011-03-11 14:04:43 -0800 | [diff] [blame] | 223 | /* calculate checksum */ |
Dave Jiang | bf482c6 | 2011-05-25 05:04:35 +0000 | [diff] [blame] | 224 | tmp = (u8 *)efi_data; |
| 225 | for (j = 0, sum = 0; j < (sizeof(*oem_hdr) + sizeof(*rom)); j++, tmp++) |
Dave Jiang | 2e8320f | 2011-03-11 14:04:43 -0800 | [diff] [blame] | 226 | sum += *tmp; |
| 227 | |
| 228 | if (sum != 0) { |
| 229 | dev_warn(&pdev->dev, |
| 230 | "OEM table checksum failed\n"); |
| 231 | return NULL; |
| 232 | } |
| 233 | |
Dave Jiang | 2e8320f | 2011-03-11 14:04:43 -0800 | [diff] [blame] | 234 | if (memcmp(rom->hdr.signature, |
| 235 | ISCI_ROM_SIG, |
| 236 | ISCI_ROM_SIG_SIZE) != 0) { |
| 237 | dev_warn(&pdev->dev, |
| 238 | "Invalid OEM table signature\n"); |
| 239 | return NULL; |
| 240 | } |
| 241 | |
| 242 | return rom; |
Dave Jiang | 8db37aa | 2011-02-23 00:02:24 -0800 | [diff] [blame] | 243 | } |