Linux Kernel  3.7.1
 All Data Structures Namespaces Files Functions Variables Typedefs Enumerations Enumerator Macros Groups Pages
probe_roms.c
Go to the documentation of this file.
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,
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 {
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,
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 }