1 /*
2  *    driver for Microsemi PQI-based storage controllers
3  *    Copyright (c) 2016-2017 Microsemi Corporation
4  *    Copyright (c) 2016 PMC-Sierra, Inc.
5  *
6  *    This program is free software; you can redistribute it and/or modify
7  *    it under the terms of the GNU General Public License as published by
8  *    the Free Software Foundation; version 2 of the License.
9  *
10  *    This program is distributed in the hope that it will be useful,
11  *    but WITHOUT ANY WARRANTY; without even the implied warranty of
12  *    MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE, GOOD TITLE or
13  *    NON INFRINGEMENT.  See the GNU General Public License for more details.
14  *
15  *    Questions/Comments/Bugfixes to esc.storagedev@microsemi.com
16  *
17  */
18 
19 #include <linux/kernel.h>
20 #include <scsi/scsi_host.h>
21 #include <scsi/scsi_cmnd.h>
22 #include <scsi/scsi_transport_sas.h>
23 #include "smartpqi.h"
24 
25 static struct pqi_sas_phy *pqi_alloc_sas_phy(struct pqi_sas_port *pqi_sas_port)
26 {
27 	struct pqi_sas_phy *pqi_sas_phy;
28 	struct sas_phy *phy;
29 
30 	pqi_sas_phy = kzalloc(sizeof(*pqi_sas_phy), GFP_KERNEL);
31 	if (!pqi_sas_phy)
32 		return NULL;
33 
34 	phy = sas_phy_alloc(pqi_sas_port->parent_node->parent_dev,
35 		pqi_sas_port->next_phy_index);
36 	if (!phy) {
37 		kfree(pqi_sas_phy);
38 		return NULL;
39 	}
40 
41 	pqi_sas_port->next_phy_index++;
42 	pqi_sas_phy->phy = phy;
43 	pqi_sas_phy->parent_port = pqi_sas_port;
44 
45 	return pqi_sas_phy;
46 }
47 
48 static void pqi_free_sas_phy(struct pqi_sas_phy *pqi_sas_phy)
49 {
50 	struct sas_phy *phy = pqi_sas_phy->phy;
51 
52 	sas_port_delete_phy(pqi_sas_phy->parent_port->port, phy);
53 	sas_phy_free(phy);
54 	if (pqi_sas_phy->added_to_port)
55 		list_del(&pqi_sas_phy->phy_list_entry);
56 	kfree(pqi_sas_phy);
57 }
58 
59 static int pqi_sas_port_add_phy(struct pqi_sas_phy *pqi_sas_phy)
60 {
61 	int rc;
62 	struct pqi_sas_port *pqi_sas_port;
63 	struct sas_phy *phy;
64 	struct sas_identify *identify;
65 
66 	pqi_sas_port = pqi_sas_phy->parent_port;
67 	phy = pqi_sas_phy->phy;
68 
69 	identify = &phy->identify;
70 	memset(identify, 0, sizeof(*identify));
71 	identify->sas_address = pqi_sas_port->sas_address;
72 	identify->device_type = SAS_END_DEVICE;
73 	identify->initiator_port_protocols = SAS_PROTOCOL_STP;
74 	identify->target_port_protocols = SAS_PROTOCOL_STP;
75 	phy->minimum_linkrate_hw = SAS_LINK_RATE_UNKNOWN;
76 	phy->maximum_linkrate_hw = SAS_LINK_RATE_UNKNOWN;
77 	phy->minimum_linkrate = SAS_LINK_RATE_UNKNOWN;
78 	phy->maximum_linkrate = SAS_LINK_RATE_UNKNOWN;
79 	phy->negotiated_linkrate = SAS_LINK_RATE_UNKNOWN;
80 
81 	rc = sas_phy_add(pqi_sas_phy->phy);
82 	if (rc)
83 		return rc;
84 
85 	sas_port_add_phy(pqi_sas_port->port, pqi_sas_phy->phy);
86 	list_add_tail(&pqi_sas_phy->phy_list_entry,
87 		&pqi_sas_port->phy_list_head);
88 	pqi_sas_phy->added_to_port = true;
89 
90 	return 0;
91 }
92 
93 static int pqi_sas_port_add_rphy(struct pqi_sas_port *pqi_sas_port,
94 	struct sas_rphy *rphy)
95 {
96 	struct sas_identify *identify;
97 
98 	identify = &rphy->identify;
99 	identify->sas_address = pqi_sas_port->sas_address;
100 	identify->initiator_port_protocols = SAS_PROTOCOL_STP;
101 	identify->target_port_protocols = SAS_PROTOCOL_STP;
102 
103 	return sas_rphy_add(rphy);
104 }
105 
106 static struct pqi_sas_port *pqi_alloc_sas_port(
107 	struct pqi_sas_node *pqi_sas_node, u64 sas_address)
108 {
109 	int rc;
110 	struct pqi_sas_port *pqi_sas_port;
111 	struct sas_port *port;
112 
113 	pqi_sas_port = kzalloc(sizeof(*pqi_sas_port), GFP_KERNEL);
114 	if (!pqi_sas_port)
115 		return NULL;
116 
117 	INIT_LIST_HEAD(&pqi_sas_port->phy_list_head);
118 	pqi_sas_port->parent_node = pqi_sas_node;
119 
120 	port = sas_port_alloc_num(pqi_sas_node->parent_dev);
121 	if (!port)
122 		goto free_pqi_port;
123 
124 	rc = sas_port_add(port);
125 	if (rc)
126 		goto free_sas_port;
127 
128 	pqi_sas_port->port = port;
129 	pqi_sas_port->sas_address = sas_address;
130 	list_add_tail(&pqi_sas_port->port_list_entry,
131 		&pqi_sas_node->port_list_head);
132 
133 	return pqi_sas_port;
134 
135 free_sas_port:
136 	sas_port_free(port);
137 free_pqi_port:
138 	kfree(pqi_sas_port);
139 
140 	return NULL;
141 }
142 
143 static void pqi_free_sas_port(struct pqi_sas_port *pqi_sas_port)
144 {
145 	struct pqi_sas_phy *pqi_sas_phy;
146 	struct pqi_sas_phy *next;
147 
148 	list_for_each_entry_safe(pqi_sas_phy, next,
149 			&pqi_sas_port->phy_list_head, phy_list_entry)
150 		pqi_free_sas_phy(pqi_sas_phy);
151 
152 	sas_port_delete(pqi_sas_port->port);
153 	list_del(&pqi_sas_port->port_list_entry);
154 	kfree(pqi_sas_port);
155 }
156 
157 static struct pqi_sas_node *pqi_alloc_sas_node(struct device *parent_dev)
158 {
159 	struct pqi_sas_node *pqi_sas_node;
160 
161 	pqi_sas_node = kzalloc(sizeof(*pqi_sas_node), GFP_KERNEL);
162 	if (pqi_sas_node) {
163 		pqi_sas_node->parent_dev = parent_dev;
164 		INIT_LIST_HEAD(&pqi_sas_node->port_list_head);
165 	}
166 
167 	return pqi_sas_node;
168 }
169 
170 static void pqi_free_sas_node(struct pqi_sas_node *pqi_sas_node)
171 {
172 	struct pqi_sas_port *pqi_sas_port;
173 	struct pqi_sas_port *next;
174 
175 	if (!pqi_sas_node)
176 		return;
177 
178 	list_for_each_entry_safe(pqi_sas_port, next,
179 			&pqi_sas_node->port_list_head, port_list_entry)
180 		pqi_free_sas_port(pqi_sas_port);
181 
182 	kfree(pqi_sas_node);
183 }
184 
185 struct pqi_scsi_dev *pqi_find_device_by_sas_rphy(
186 	struct pqi_ctrl_info *ctrl_info, struct sas_rphy *rphy)
187 {
188 	struct pqi_scsi_dev *device;
189 
190 	list_for_each_entry(device, &ctrl_info->scsi_device_list,
191 		scsi_device_list_entry) {
192 		if (!device->sas_port)
193 			continue;
194 		if (device->sas_port->rphy == rphy)
195 			return device;
196 	}
197 
198 	return NULL;
199 }
200 
201 int pqi_add_sas_host(struct Scsi_Host *shost, struct pqi_ctrl_info *ctrl_info)
202 {
203 	int rc;
204 	struct device *parent_dev;
205 	struct pqi_sas_node *pqi_sas_node;
206 	struct pqi_sas_port *pqi_sas_port;
207 	struct pqi_sas_phy *pqi_sas_phy;
208 
209 	parent_dev = &shost->shost_gendev;
210 
211 	pqi_sas_node = pqi_alloc_sas_node(parent_dev);
212 	if (!pqi_sas_node)
213 		return -ENOMEM;
214 
215 	pqi_sas_port = pqi_alloc_sas_port(pqi_sas_node, ctrl_info->sas_address);
216 	if (!pqi_sas_port) {
217 		rc = -ENODEV;
218 		goto free_sas_node;
219 	}
220 
221 	pqi_sas_phy = pqi_alloc_sas_phy(pqi_sas_port);
222 	if (!pqi_sas_phy) {
223 		rc = -ENODEV;
224 		goto free_sas_port;
225 	}
226 
227 	rc = pqi_sas_port_add_phy(pqi_sas_phy);
228 	if (rc)
229 		goto free_sas_phy;
230 
231 	ctrl_info->sas_host = pqi_sas_node;
232 
233 	return 0;
234 
235 free_sas_phy:
236 	pqi_free_sas_phy(pqi_sas_phy);
237 free_sas_port:
238 	pqi_free_sas_port(pqi_sas_port);
239 free_sas_node:
240 	pqi_free_sas_node(pqi_sas_node);
241 
242 	return rc;
243 }
244 
245 void pqi_delete_sas_host(struct pqi_ctrl_info *ctrl_info)
246 {
247 	pqi_free_sas_node(ctrl_info->sas_host);
248 }
249 
250 int pqi_add_sas_device(struct pqi_sas_node *pqi_sas_node,
251 	struct pqi_scsi_dev *device)
252 {
253 	int rc;
254 	struct pqi_sas_port *pqi_sas_port;
255 	struct sas_rphy *rphy;
256 
257 	pqi_sas_port = pqi_alloc_sas_port(pqi_sas_node, device->sas_address);
258 	if (!pqi_sas_port)
259 		return -ENOMEM;
260 
261 	rphy = sas_end_device_alloc(pqi_sas_port->port);
262 	if (!rphy) {
263 		rc = -ENODEV;
264 		goto free_sas_port;
265 	}
266 
267 	pqi_sas_port->rphy = rphy;
268 	device->sas_port = pqi_sas_port;
269 
270 	rc = pqi_sas_port_add_rphy(pqi_sas_port, rphy);
271 	if (rc)
272 		goto free_sas_port;
273 
274 	return 0;
275 
276 free_sas_port:
277 	pqi_free_sas_port(pqi_sas_port);
278 	device->sas_port = NULL;
279 
280 	return rc;
281 }
282 
283 void pqi_remove_sas_device(struct pqi_scsi_dev *device)
284 {
285 	if (device->sas_port) {
286 		pqi_free_sas_port(device->sas_port);
287 		device->sas_port = NULL;
288 	}
289 }
290 
291 static int pqi_sas_get_linkerrors(struct sas_phy *phy)
292 {
293 	return 0;
294 }
295 
296 static int pqi_sas_get_enclosure_identifier(struct sas_rphy *rphy,
297 	u64 *identifier)
298 {
299 	return 0;
300 }
301 
302 static int pqi_sas_get_bay_identifier(struct sas_rphy *rphy)
303 {
304 	return -ENXIO;
305 }
306 
307 static int pqi_sas_phy_reset(struct sas_phy *phy, int hard_reset)
308 {
309 	return 0;
310 }
311 
312 static int pqi_sas_phy_enable(struct sas_phy *phy, int enable)
313 {
314 	return 0;
315 }
316 
317 static int pqi_sas_phy_setup(struct sas_phy *phy)
318 {
319 	return 0;
320 }
321 
322 static void pqi_sas_phy_release(struct sas_phy *phy)
323 {
324 }
325 
326 static int pqi_sas_phy_speed(struct sas_phy *phy,
327 	struct sas_phy_linkrates *rates)
328 {
329 	return -EINVAL;
330 }
331 
332 struct sas_function_template pqi_sas_transport_functions = {
333 	.get_linkerrors = pqi_sas_get_linkerrors,
334 	.get_enclosure_identifier = pqi_sas_get_enclosure_identifier,
335 	.get_bay_identifier = pqi_sas_get_bay_identifier,
336 	.phy_reset = pqi_sas_phy_reset,
337 	.phy_enable = pqi_sas_phy_enable,
338 	.phy_setup = pqi_sas_phy_setup,
339 	.phy_release = pqi_sas_phy_release,
340 	.set_phy_speed = pqi_sas_phy_speed,
341 };
342