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
37static efi_char16_t isci_efivar_name[] = {
38	'R', 's', 't', 'S', 'c', 'u', 'O'
39};
40
41struct 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		pci_unmap_biosrom(oprom);
58		dev_warn(&pdev->dev,
59			 "Unable to allocate memory for orom\n");
60		return NULL;
61	}
62
63	for (i = 0; i < len && rom; i += ISCI_OEM_SIG_SIZE) {
64		memcpy_fromio(oem_sig, oprom + i, ISCI_OEM_SIG_SIZE);
65
66		/* we think we found the OEM table */
67		if (memcmp(oem_sig, ISCI_OEM_SIG, ISCI_OEM_SIG_SIZE) == 0) {
68			size_t copy_len;
69
70			memcpy_fromio(&oem_hdr, oprom + i, sizeof(oem_hdr));
71
72			copy_len = min(oem_hdr.len - sizeof(oem_hdr),
73				       sizeof(*rom));
74
75			memcpy_fromio(rom,
76				      oprom + i + sizeof(oem_hdr),
77				      copy_len);
78
79			/* calculate checksum */
80			tmp = (u8 *)&oem_hdr;
81			for (j = 0, sum = 0; j < sizeof(oem_hdr); j++, tmp++)
82				sum += *tmp;
83
84			tmp = (u8 *)rom;
85			for (j = 0; j < sizeof(*rom); j++, tmp++)
86				sum += *tmp;
87
88			if (sum != 0) {
89				dev_warn(&pdev->dev,
90					 "OEM table checksum failed\n");
91				continue;
92			}
93
94			/* keep going if that's not the oem param table */
95			if (memcmp(rom->hdr.signature,
96				   ISCI_ROM_SIG,
97				   ISCI_ROM_SIG_SIZE) != 0)
98				continue;
99
100			dev_info(&pdev->dev,
101				 "OEM parameter table found in OROM\n");
102			break;
103		}
104	}
105
106	if (i >= len) {
107		dev_err(&pdev->dev, "oprom parse error\n");
108		rom = NULL;
109	}
110	pci_unmap_biosrom(oprom);
111
112	return rom;
113}
114
115struct isci_orom *isci_request_firmware(struct pci_dev *pdev, const struct firmware *fw)
116{
117	struct isci_orom *orom = NULL, *data;
118	int i, j;
119
120	if (request_firmware(&fw, ISCI_FW_NAME, &pdev->dev) != 0)
121		return NULL;
122
123	if (fw->size < sizeof(*orom))
124		goto out;
125
126	data = (struct isci_orom *)fw->data;
127
128	if (strncmp(ISCI_ROM_SIG, data->hdr.signature,
129		    strlen(ISCI_ROM_SIG)) != 0)
130		goto out;
131
132	orom = devm_kzalloc(&pdev->dev, fw->size, GFP_KERNEL);
133	if (!orom)
134		goto out;
135
136	memcpy(orom, fw->data, fw->size);
137
138	if (is_c0(pdev) || is_c1(pdev))
139		goto out;
140
141	/*
142	 * deprecated: override default amp_control for pre-preproduction
143	 * silicon revisions
144	 */
145	for (i = 0; i < ARRAY_SIZE(orom->ctrl); i++)
146		for (j = 0; j < ARRAY_SIZE(orom->ctrl[i].phys); j++) {
147			orom->ctrl[i].phys[j].afe_tx_amp_control0 = 0xe7c03;
148			orom->ctrl[i].phys[j].afe_tx_amp_control1 = 0xe7c03;
149			orom->ctrl[i].phys[j].afe_tx_amp_control2 = 0xe7c03;
150			orom->ctrl[i].phys[j].afe_tx_amp_control3 = 0xe7c03;
151		}
152 out:
153	release_firmware(fw);
154
155	return orom;
156}
157
158static struct efi *get_efi(void)
159{
160#ifdef CONFIG_EFI
161	return &efi;
162#else
163	return NULL;
164#endif
165}
166
167struct isci_orom *isci_get_efi_var(struct pci_dev *pdev)
168{
169	efi_status_t status;
170	struct isci_orom *rom;
171	struct isci_oem_hdr *oem_hdr;
172	u8 *tmp, sum;
173	int j;
174	unsigned long data_len;
175	u8 *efi_data;
176	u32 efi_attrib = 0;
177
178	data_len = 1024;
179	efi_data = devm_kzalloc(&pdev->dev, data_len, GFP_KERNEL);
180	if (!efi_data) {
181		dev_warn(&pdev->dev,
182			 "Unable to allocate memory for EFI data\n");
183		return NULL;
184	}
185
186	rom = (struct isci_orom *)(efi_data + sizeof(struct isci_oem_hdr));
187
188	if (get_efi())
189		status = get_efi()->get_variable(isci_efivar_name,
190						 &ISCI_EFI_VENDOR_GUID,
191						 &efi_attrib,
192						 &data_len,
193						 efi_data);
194	else
195		status = EFI_NOT_FOUND;
196
197	if (status != EFI_SUCCESS) {
198		dev_warn(&pdev->dev,
199			 "Unable to obtain EFI var data for OEM parms\n");
200		return NULL;
201	}
202
203	oem_hdr = (struct isci_oem_hdr *)efi_data;
204
205	if (memcmp(oem_hdr->sig, ISCI_OEM_SIG, ISCI_OEM_SIG_SIZE) != 0) {
206		dev_warn(&pdev->dev,
207			 "Invalid OEM header signature\n");
208		return NULL;
209	}
210
211	/* calculate checksum */
212	tmp = (u8 *)efi_data;
213	for (j = 0, sum = 0; j < (sizeof(*oem_hdr) + sizeof(*rom)); j++, tmp++)
214		sum += *tmp;
215
216	if (sum != 0) {
217		dev_warn(&pdev->dev,
218			 "OEM table checksum failed\n");
219		return NULL;
220	}
221
222	if (memcmp(rom->hdr.signature,
223		   ISCI_ROM_SIG,
224		   ISCI_ROM_SIG_SIZE) != 0) {
225		dev_warn(&pdev->dev,
226			 "Invalid OEM table signature\n");
227		return NULL;
228	}
229
230	return rom;
231}
232