1 /*
2  * Copyright (c) 2013, Cisco Systems, Inc. All rights reserved.
3  *
4  * This software is available to you under a choice of one of two
5  * licenses.  You may choose to be licensed under the terms of the GNU
6  * General Public License (GPL) Version 2, available from the file
7  * COPYING in the main directory of this source tree, or the
8  * BSD license below:
9  *
10  *     Redistribution and use in source and binary forms, with or
11  *     without modification, are permitted provided that the following
12  *     conditions are met:
13  *
14  *      - Redistributions of source code must retain the above
15  *        copyright notice, this list of conditions and the following
16  *        disclaimer.
17  *
18  *      - Redistributions in binary form must reproduce the above
19  *        copyright notice, this list of conditions and the following
20  *        disclaimer in the documentation and/or other materials
21  *        provided with the distribution.
22  *
23  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
24  * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
25  * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
26  * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
27  * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
28  * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
29  * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
30  * SOFTWARE.
31  *
32  * Author: Upinder Malhi <umalhi@cisco.com>
33  * Author: Anant Deepak <anadeepa@cisco.com>
34  * Author: Cesare Cantu' <cantuc@cisco.com>
35  * Author: Jeff Squyres <jsquyres@cisco.com>
36  * Author: Kiran Thirumalai <kithirum@cisco.com>
37  * Author: Xuyang Wang <xuywang@cisco.com>
38  * Author: Reese Faucette <rfaucett@cisco.com>
39  *
40  */
41 
42 #include <linux/module.h>
43 #include <linux/inetdevice.h>
44 #include <linux/init.h>
45 #include <linux/slab.h>
46 #include <linux/errno.h>
47 #include <linux/pci.h>
48 #include <linux/netdevice.h>
49 
50 #include <rdma/ib_user_verbs.h>
51 #include <rdma/ib_addr.h>
52 
53 #include "usnic_abi.h"
54 #include "usnic_common_util.h"
55 #include "usnic_ib.h"
56 #include "usnic_ib_qp_grp.h"
57 #include "usnic_log.h"
58 #include "usnic_fwd.h"
59 #include "usnic_debugfs.h"
60 #include "usnic_ib_verbs.h"
61 #include "usnic_transport.h"
62 #include "usnic_uiom.h"
63 #include "usnic_ib_sysfs.h"
64 
65 unsigned int usnic_log_lvl = USNIC_LOG_LVL_ERR;
66 unsigned int usnic_ib_share_vf = 1;
67 
68 static const char usnic_version[] =
69 	DRV_NAME ": Cisco VIC (USNIC) Verbs Driver v"
70 	DRV_VERSION " (" DRV_RELDATE ")\n";
71 
72 static DEFINE_MUTEX(usnic_ib_ibdev_list_lock);
73 static LIST_HEAD(usnic_ib_ibdev_list);
74 
75 /* Callback dump funcs */
76 static int usnic_ib_dump_vf_hdr(void *obj, char *buf, int buf_sz)
77 {
78 	struct usnic_ib_vf *vf = obj;
79 	return scnprintf(buf, buf_sz, "PF: %s ", vf->pf->ib_dev.name);
80 }
81 /* End callback dump funcs */
82 
83 static void usnic_ib_dump_vf(struct usnic_ib_vf *vf, char *buf, int buf_sz)
84 {
85 	usnic_vnic_dump(vf->vnic, buf, buf_sz, vf,
86 			usnic_ib_dump_vf_hdr,
87 			usnic_ib_qp_grp_dump_hdr, usnic_ib_qp_grp_dump_rows);
88 }
89 
90 void usnic_ib_log_vf(struct usnic_ib_vf *vf)
91 {
92 	char buf[1000];
93 	usnic_ib_dump_vf(vf, buf, sizeof(buf));
94 	usnic_dbg("%s\n", buf);
95 }
96 
97 /* Start of netdev section */
98 static inline const char *usnic_ib_netdev_event_to_string(unsigned long event)
99 {
100 	const char *event2str[] = {"NETDEV_NONE", "NETDEV_UP", "NETDEV_DOWN",
101 		"NETDEV_REBOOT", "NETDEV_CHANGE",
102 		"NETDEV_REGISTER", "NETDEV_UNREGISTER", "NETDEV_CHANGEMTU",
103 		"NETDEV_CHANGEADDR", "NETDEV_GOING_DOWN", "NETDEV_FEAT_CHANGE",
104 		"NETDEV_BONDING_FAILOVER", "NETDEV_PRE_UP",
105 		"NETDEV_PRE_TYPE_CHANGE", "NETDEV_POST_TYPE_CHANGE",
106 		"NETDEV_POST_INT", "NETDEV_UNREGISTER_FINAL", "NETDEV_RELEASE",
107 		"NETDEV_NOTIFY_PEERS", "NETDEV_JOIN"
108 	};
109 
110 	if (event >= ARRAY_SIZE(event2str))
111 		return "UNKNOWN_NETDEV_EVENT";
112 	else
113 		return event2str[event];
114 }
115 
116 static void usnic_ib_qp_grp_modify_active_to_err(struct usnic_ib_dev *us_ibdev)
117 {
118 	struct usnic_ib_ucontext *ctx;
119 	struct usnic_ib_qp_grp *qp_grp;
120 	enum ib_qp_state cur_state;
121 	int status;
122 
123 	BUG_ON(!mutex_is_locked(&us_ibdev->usdev_lock));
124 
125 	list_for_each_entry(ctx, &us_ibdev->ctx_list, link) {
126 		list_for_each_entry(qp_grp, &ctx->qp_grp_list, link) {
127 			cur_state = qp_grp->state;
128 			if (cur_state == IB_QPS_INIT ||
129 				cur_state == IB_QPS_RTR ||
130 				cur_state == IB_QPS_RTS) {
131 				status = usnic_ib_qp_grp_modify(qp_grp,
132 								IB_QPS_ERR,
133 								NULL);
134 				if (status) {
135 					usnic_err("Failed to transistion qp grp %u from %s to %s\n",
136 						qp_grp->grp_id,
137 						usnic_ib_qp_grp_state_to_string
138 						(cur_state),
139 						usnic_ib_qp_grp_state_to_string
140 						(IB_QPS_ERR));
141 				}
142 			}
143 		}
144 	}
145 }
146 
147 static void usnic_ib_handle_usdev_event(struct usnic_ib_dev *us_ibdev,
148 					unsigned long event)
149 {
150 	struct net_device *netdev;
151 	struct ib_event ib_event;
152 
153 	memset(&ib_event, 0, sizeof(ib_event));
154 
155 	mutex_lock(&us_ibdev->usdev_lock);
156 	netdev = us_ibdev->netdev;
157 	switch (event) {
158 	case NETDEV_REBOOT:
159 		usnic_info("PF Reset on %s\n", us_ibdev->ib_dev.name);
160 		usnic_ib_qp_grp_modify_active_to_err(us_ibdev);
161 		ib_event.event = IB_EVENT_PORT_ERR;
162 		ib_event.device = &us_ibdev->ib_dev;
163 		ib_event.element.port_num = 1;
164 		ib_dispatch_event(&ib_event);
165 		break;
166 	case NETDEV_UP:
167 	case NETDEV_DOWN:
168 	case NETDEV_CHANGE:
169 		if (!us_ibdev->ufdev->link_up &&
170 				netif_carrier_ok(netdev)) {
171 			usnic_fwd_carrier_up(us_ibdev->ufdev);
172 			usnic_info("Link UP on %s\n", us_ibdev->ib_dev.name);
173 			ib_event.event = IB_EVENT_PORT_ACTIVE;
174 			ib_event.device = &us_ibdev->ib_dev;
175 			ib_event.element.port_num = 1;
176 			ib_dispatch_event(&ib_event);
177 		} else if (us_ibdev->ufdev->link_up &&
178 				!netif_carrier_ok(netdev)) {
179 			usnic_fwd_carrier_down(us_ibdev->ufdev);
180 			usnic_info("Link DOWN on %s\n", us_ibdev->ib_dev.name);
181 			usnic_ib_qp_grp_modify_active_to_err(us_ibdev);
182 			ib_event.event = IB_EVENT_PORT_ERR;
183 			ib_event.device = &us_ibdev->ib_dev;
184 			ib_event.element.port_num = 1;
185 			ib_dispatch_event(&ib_event);
186 		} else {
187 			usnic_dbg("Ignoring %s on %s\n",
188 					usnic_ib_netdev_event_to_string(event),
189 					us_ibdev->ib_dev.name);
190 		}
191 		break;
192 	case NETDEV_CHANGEADDR:
193 		if (!memcmp(us_ibdev->ufdev->mac, netdev->dev_addr,
194 				sizeof(us_ibdev->ufdev->mac))) {
195 			usnic_dbg("Ignoring addr change on %s\n",
196 					us_ibdev->ib_dev.name);
197 		} else {
198 			usnic_info(" %s old mac: %pM new mac: %pM\n",
199 					us_ibdev->ib_dev.name,
200 					us_ibdev->ufdev->mac,
201 					netdev->dev_addr);
202 			usnic_fwd_set_mac(us_ibdev->ufdev, netdev->dev_addr);
203 			usnic_ib_qp_grp_modify_active_to_err(us_ibdev);
204 			ib_event.event = IB_EVENT_GID_CHANGE;
205 			ib_event.device = &us_ibdev->ib_dev;
206 			ib_event.element.port_num = 1;
207 			ib_dispatch_event(&ib_event);
208 		}
209 
210 		break;
211 	case NETDEV_CHANGEMTU:
212 		if (us_ibdev->ufdev->mtu != netdev->mtu) {
213 			usnic_info("MTU Change on %s old: %u new: %u\n",
214 					us_ibdev->ib_dev.name,
215 					us_ibdev->ufdev->mtu, netdev->mtu);
216 			usnic_fwd_set_mtu(us_ibdev->ufdev, netdev->mtu);
217 			usnic_ib_qp_grp_modify_active_to_err(us_ibdev);
218 		} else {
219 			usnic_dbg("Ignoring MTU change on %s\n",
220 					us_ibdev->ib_dev.name);
221 		}
222 		break;
223 	default:
224 		usnic_dbg("Ignoring event %s on %s",
225 				usnic_ib_netdev_event_to_string(event),
226 				us_ibdev->ib_dev.name);
227 	}
228 	mutex_unlock(&us_ibdev->usdev_lock);
229 }
230 
231 static int usnic_ib_netdevice_event(struct notifier_block *notifier,
232 					unsigned long event, void *ptr)
233 {
234 	struct usnic_ib_dev *us_ibdev;
235 
236 	struct net_device *netdev = netdev_notifier_info_to_dev(ptr);
237 
238 	mutex_lock(&usnic_ib_ibdev_list_lock);
239 	list_for_each_entry(us_ibdev, &usnic_ib_ibdev_list, ib_dev_link) {
240 		if (us_ibdev->netdev == netdev) {
241 			usnic_ib_handle_usdev_event(us_ibdev, event);
242 			break;
243 		}
244 	}
245 	mutex_unlock(&usnic_ib_ibdev_list_lock);
246 
247 	return NOTIFY_DONE;
248 }
249 
250 static struct notifier_block usnic_ib_netdevice_notifier = {
251 	.notifier_call = usnic_ib_netdevice_event
252 };
253 /* End of netdev section */
254 
255 /* Start of inet section */
256 static int usnic_ib_handle_inet_event(struct usnic_ib_dev *us_ibdev,
257 					unsigned long event, void *ptr)
258 {
259 	struct in_ifaddr *ifa = ptr;
260 	struct ib_event ib_event;
261 
262 	mutex_lock(&us_ibdev->usdev_lock);
263 
264 	switch (event) {
265 	case NETDEV_DOWN:
266 		usnic_info("%s via ip notifiers",
267 				usnic_ib_netdev_event_to_string(event));
268 		usnic_fwd_del_ipaddr(us_ibdev->ufdev);
269 		usnic_ib_qp_grp_modify_active_to_err(us_ibdev);
270 		ib_event.event = IB_EVENT_GID_CHANGE;
271 		ib_event.device = &us_ibdev->ib_dev;
272 		ib_event.element.port_num = 1;
273 		ib_dispatch_event(&ib_event);
274 		break;
275 	case NETDEV_UP:
276 		usnic_fwd_add_ipaddr(us_ibdev->ufdev, ifa->ifa_address);
277 		usnic_info("%s via ip notifiers: ip %pI4",
278 				usnic_ib_netdev_event_to_string(event),
279 				&us_ibdev->ufdev->inaddr);
280 		ib_event.event = IB_EVENT_GID_CHANGE;
281 		ib_event.device = &us_ibdev->ib_dev;
282 		ib_event.element.port_num = 1;
283 		ib_dispatch_event(&ib_event);
284 		break;
285 	default:
286 		usnic_info("Ignoring event %s on %s",
287 				usnic_ib_netdev_event_to_string(event),
288 				us_ibdev->ib_dev.name);
289 	}
290 	mutex_unlock(&us_ibdev->usdev_lock);
291 
292 	return NOTIFY_DONE;
293 }
294 
295 static int usnic_ib_inetaddr_event(struct notifier_block *notifier,
296 					unsigned long event, void *ptr)
297 {
298 	struct usnic_ib_dev *us_ibdev;
299 	struct in_ifaddr *ifa = ptr;
300 	struct net_device *netdev = ifa->ifa_dev->dev;
301 
302 	mutex_lock(&usnic_ib_ibdev_list_lock);
303 	list_for_each_entry(us_ibdev, &usnic_ib_ibdev_list, ib_dev_link) {
304 		if (us_ibdev->netdev == netdev) {
305 			usnic_ib_handle_inet_event(us_ibdev, event, ptr);
306 			break;
307 		}
308 	}
309 	mutex_unlock(&usnic_ib_ibdev_list_lock);
310 
311 	return NOTIFY_DONE;
312 }
313 static struct notifier_block usnic_ib_inetaddr_notifier = {
314 	.notifier_call = usnic_ib_inetaddr_event
315 };
316 /* End of inet section*/
317 
318 static int usnic_port_immutable(struct ib_device *ibdev, u8 port_num,
319 			        struct ib_port_immutable *immutable)
320 {
321 	struct ib_port_attr attr;
322 	int err;
323 
324 	immutable->core_cap_flags = RDMA_CORE_PORT_USNIC;
325 
326 	err = ib_query_port(ibdev, port_num, &attr);
327 	if (err)
328 		return err;
329 
330 	immutable->pkey_tbl_len = attr.pkey_tbl_len;
331 	immutable->gid_tbl_len = attr.gid_tbl_len;
332 
333 	return 0;
334 }
335 
336 static void usnic_get_dev_fw_str(struct ib_device *device,
337 				 char *str,
338 				 size_t str_len)
339 {
340 	struct usnic_ib_dev *us_ibdev =
341 		container_of(device, struct usnic_ib_dev, ib_dev);
342 	struct ethtool_drvinfo info;
343 
344 	mutex_lock(&us_ibdev->usdev_lock);
345 	us_ibdev->netdev->ethtool_ops->get_drvinfo(us_ibdev->netdev, &info);
346 	mutex_unlock(&us_ibdev->usdev_lock);
347 
348 	snprintf(str, str_len, "%s", info.fw_version);
349 }
350 
351 /* Start of PF discovery section */
352 static void *usnic_ib_device_add(struct pci_dev *dev)
353 {
354 	struct usnic_ib_dev *us_ibdev;
355 	union ib_gid gid;
356 	struct in_ifaddr *in;
357 	struct net_device *netdev;
358 
359 	usnic_dbg("\n");
360 	netdev = pci_get_drvdata(dev);
361 
362 	us_ibdev = (struct usnic_ib_dev *)ib_alloc_device(sizeof(*us_ibdev));
363 	if (!us_ibdev) {
364 		usnic_err("Device %s context alloc failed\n",
365 				netdev_name(pci_get_drvdata(dev)));
366 		return ERR_PTR(-EFAULT);
367 	}
368 
369 	us_ibdev->ufdev = usnic_fwd_dev_alloc(dev);
370 	if (!us_ibdev->ufdev) {
371 		usnic_err("Failed to alloc ufdev for %s\n", pci_name(dev));
372 		goto err_dealloc;
373 	}
374 
375 	mutex_init(&us_ibdev->usdev_lock);
376 	INIT_LIST_HEAD(&us_ibdev->vf_dev_list);
377 	INIT_LIST_HEAD(&us_ibdev->ctx_list);
378 
379 	us_ibdev->pdev = dev;
380 	us_ibdev->netdev = pci_get_drvdata(dev);
381 	us_ibdev->ib_dev.owner = THIS_MODULE;
382 	us_ibdev->ib_dev.node_type = RDMA_NODE_USNIC_UDP;
383 	us_ibdev->ib_dev.phys_port_cnt = USNIC_IB_PORT_CNT;
384 	us_ibdev->ib_dev.num_comp_vectors = USNIC_IB_NUM_COMP_VECTORS;
385 	us_ibdev->ib_dev.dev.parent = &dev->dev;
386 	us_ibdev->ib_dev.uverbs_abi_ver = USNIC_UVERBS_ABI_VERSION;
387 	strlcpy(us_ibdev->ib_dev.name, "usnic_%d", IB_DEVICE_NAME_MAX);
388 
389 	us_ibdev->ib_dev.uverbs_cmd_mask =
390 		(1ull << IB_USER_VERBS_CMD_GET_CONTEXT) |
391 		(1ull << IB_USER_VERBS_CMD_QUERY_DEVICE) |
392 		(1ull << IB_USER_VERBS_CMD_QUERY_PORT) |
393 		(1ull << IB_USER_VERBS_CMD_ALLOC_PD) |
394 		(1ull << IB_USER_VERBS_CMD_DEALLOC_PD) |
395 		(1ull << IB_USER_VERBS_CMD_REG_MR) |
396 		(1ull << IB_USER_VERBS_CMD_DEREG_MR) |
397 		(1ull << IB_USER_VERBS_CMD_CREATE_COMP_CHANNEL) |
398 		(1ull << IB_USER_VERBS_CMD_CREATE_CQ) |
399 		(1ull << IB_USER_VERBS_CMD_DESTROY_CQ) |
400 		(1ull << IB_USER_VERBS_CMD_CREATE_QP) |
401 		(1ull << IB_USER_VERBS_CMD_MODIFY_QP) |
402 		(1ull << IB_USER_VERBS_CMD_QUERY_QP) |
403 		(1ull << IB_USER_VERBS_CMD_DESTROY_QP) |
404 		(1ull << IB_USER_VERBS_CMD_ATTACH_MCAST) |
405 		(1ull << IB_USER_VERBS_CMD_DETACH_MCAST) |
406 		(1ull << IB_USER_VERBS_CMD_OPEN_QP);
407 
408 	us_ibdev->ib_dev.query_device = usnic_ib_query_device;
409 	us_ibdev->ib_dev.query_port = usnic_ib_query_port;
410 	us_ibdev->ib_dev.query_pkey = usnic_ib_query_pkey;
411 	us_ibdev->ib_dev.query_gid = usnic_ib_query_gid;
412 	us_ibdev->ib_dev.get_link_layer = usnic_ib_port_link_layer;
413 	us_ibdev->ib_dev.alloc_pd = usnic_ib_alloc_pd;
414 	us_ibdev->ib_dev.dealloc_pd = usnic_ib_dealloc_pd;
415 	us_ibdev->ib_dev.create_qp = usnic_ib_create_qp;
416 	us_ibdev->ib_dev.modify_qp = usnic_ib_modify_qp;
417 	us_ibdev->ib_dev.query_qp = usnic_ib_query_qp;
418 	us_ibdev->ib_dev.destroy_qp = usnic_ib_destroy_qp;
419 	us_ibdev->ib_dev.create_cq = usnic_ib_create_cq;
420 	us_ibdev->ib_dev.destroy_cq = usnic_ib_destroy_cq;
421 	us_ibdev->ib_dev.reg_user_mr = usnic_ib_reg_mr;
422 	us_ibdev->ib_dev.dereg_mr = usnic_ib_dereg_mr;
423 	us_ibdev->ib_dev.alloc_ucontext = usnic_ib_alloc_ucontext;
424 	us_ibdev->ib_dev.dealloc_ucontext = usnic_ib_dealloc_ucontext;
425 	us_ibdev->ib_dev.mmap = usnic_ib_mmap;
426 	us_ibdev->ib_dev.create_ah = usnic_ib_create_ah;
427 	us_ibdev->ib_dev.destroy_ah = usnic_ib_destroy_ah;
428 	us_ibdev->ib_dev.post_send = usnic_ib_post_send;
429 	us_ibdev->ib_dev.post_recv = usnic_ib_post_recv;
430 	us_ibdev->ib_dev.poll_cq = usnic_ib_poll_cq;
431 	us_ibdev->ib_dev.req_notify_cq = usnic_ib_req_notify_cq;
432 	us_ibdev->ib_dev.get_dma_mr = usnic_ib_get_dma_mr;
433 	us_ibdev->ib_dev.get_port_immutable = usnic_port_immutable;
434 	us_ibdev->ib_dev.get_dev_fw_str     = usnic_get_dev_fw_str;
435 
436 
437 	if (ib_register_device(&us_ibdev->ib_dev, NULL))
438 		goto err_fwd_dealloc;
439 
440 	usnic_fwd_set_mtu(us_ibdev->ufdev, us_ibdev->netdev->mtu);
441 	usnic_fwd_set_mac(us_ibdev->ufdev, us_ibdev->netdev->dev_addr);
442 	if (netif_carrier_ok(us_ibdev->netdev))
443 		usnic_fwd_carrier_up(us_ibdev->ufdev);
444 
445 	in = ((struct in_device *)(netdev->ip_ptr))->ifa_list;
446 	if (in != NULL)
447 		usnic_fwd_add_ipaddr(us_ibdev->ufdev, in->ifa_address);
448 
449 	usnic_mac_ip_to_gid(us_ibdev->netdev->perm_addr,
450 				us_ibdev->ufdev->inaddr, &gid.raw[0]);
451 	memcpy(&us_ibdev->ib_dev.node_guid, &gid.global.interface_id,
452 		sizeof(gid.global.interface_id));
453 	kref_init(&us_ibdev->vf_cnt);
454 
455 	usnic_info("Added ibdev: %s netdev: %s with mac %pM Link: %u MTU: %u\n",
456 			us_ibdev->ib_dev.name, netdev_name(us_ibdev->netdev),
457 			us_ibdev->ufdev->mac, us_ibdev->ufdev->link_up,
458 			us_ibdev->ufdev->mtu);
459 	return us_ibdev;
460 
461 err_fwd_dealloc:
462 	usnic_fwd_dev_free(us_ibdev->ufdev);
463 err_dealloc:
464 	usnic_err("failed -- deallocing device\n");
465 	ib_dealloc_device(&us_ibdev->ib_dev);
466 	return NULL;
467 }
468 
469 static void usnic_ib_device_remove(struct usnic_ib_dev *us_ibdev)
470 {
471 	usnic_info("Unregistering %s\n", us_ibdev->ib_dev.name);
472 	usnic_ib_sysfs_unregister_usdev(us_ibdev);
473 	usnic_fwd_dev_free(us_ibdev->ufdev);
474 	ib_unregister_device(&us_ibdev->ib_dev);
475 	ib_dealloc_device(&us_ibdev->ib_dev);
476 }
477 
478 static void usnic_ib_undiscover_pf(struct kref *kref)
479 {
480 	struct usnic_ib_dev *us_ibdev, *tmp;
481 	struct pci_dev *dev;
482 	bool found = false;
483 
484 	dev = container_of(kref, struct usnic_ib_dev, vf_cnt)->pdev;
485 	mutex_lock(&usnic_ib_ibdev_list_lock);
486 	list_for_each_entry_safe(us_ibdev, tmp,
487 				&usnic_ib_ibdev_list, ib_dev_link) {
488 		if (us_ibdev->pdev == dev) {
489 			list_del(&us_ibdev->ib_dev_link);
490 			usnic_ib_device_remove(us_ibdev);
491 			found = true;
492 			break;
493 		}
494 	}
495 
496 	WARN(!found, "Failed to remove PF %s\n", pci_name(dev));
497 
498 	mutex_unlock(&usnic_ib_ibdev_list_lock);
499 }
500 
501 static struct usnic_ib_dev *usnic_ib_discover_pf(struct usnic_vnic *vnic)
502 {
503 	struct usnic_ib_dev *us_ibdev;
504 	struct pci_dev *parent_pci, *vf_pci;
505 	int err;
506 
507 	vf_pci = usnic_vnic_get_pdev(vnic);
508 	parent_pci = pci_physfn(vf_pci);
509 
510 	BUG_ON(!parent_pci);
511 
512 	mutex_lock(&usnic_ib_ibdev_list_lock);
513 	list_for_each_entry(us_ibdev, &usnic_ib_ibdev_list, ib_dev_link) {
514 		if (us_ibdev->pdev == parent_pci) {
515 			kref_get(&us_ibdev->vf_cnt);
516 			goto out;
517 		}
518 	}
519 
520 	us_ibdev = usnic_ib_device_add(parent_pci);
521 	if (IS_ERR_OR_NULL(us_ibdev)) {
522 		us_ibdev = us_ibdev ? us_ibdev : ERR_PTR(-EFAULT);
523 		goto out;
524 	}
525 
526 	err = usnic_ib_sysfs_register_usdev(us_ibdev);
527 	if (err) {
528 		usnic_ib_device_remove(us_ibdev);
529 		us_ibdev = ERR_PTR(err);
530 		goto out;
531 	}
532 
533 	list_add(&us_ibdev->ib_dev_link, &usnic_ib_ibdev_list);
534 out:
535 	mutex_unlock(&usnic_ib_ibdev_list_lock);
536 	return us_ibdev;
537 }
538 /* End of PF discovery section */
539 
540 /* Start of PCI section */
541 
542 static const struct pci_device_id usnic_ib_pci_ids[] = {
543 	{PCI_DEVICE(PCI_VENDOR_ID_CISCO, PCI_DEVICE_ID_CISCO_VIC_USPACE_NIC)},
544 	{0,}
545 };
546 
547 static int usnic_ib_pci_probe(struct pci_dev *pdev,
548 				const struct pci_device_id *id)
549 {
550 	int err;
551 	struct usnic_ib_dev *pf;
552 	struct usnic_ib_vf *vf;
553 	enum usnic_vnic_res_type res_type;
554 
555 	vf = kzalloc(sizeof(*vf), GFP_KERNEL);
556 	if (!vf)
557 		return -ENOMEM;
558 
559 	err = pci_enable_device(pdev);
560 	if (err) {
561 		usnic_err("Failed to enable %s with err %d\n",
562 				pci_name(pdev), err);
563 		goto out_clean_vf;
564 	}
565 
566 	err = pci_request_regions(pdev, DRV_NAME);
567 	if (err) {
568 		usnic_err("Failed to request region for %s with err %d\n",
569 				pci_name(pdev), err);
570 		goto out_disable_device;
571 	}
572 
573 	pci_set_master(pdev);
574 	pci_set_drvdata(pdev, vf);
575 
576 	vf->vnic = usnic_vnic_alloc(pdev);
577 	if (IS_ERR_OR_NULL(vf->vnic)) {
578 		err = vf->vnic ? PTR_ERR(vf->vnic) : -ENOMEM;
579 		usnic_err("Failed to alloc vnic for %s with err %d\n",
580 				pci_name(pdev), err);
581 		goto out_release_regions;
582 	}
583 
584 	pf = usnic_ib_discover_pf(vf->vnic);
585 	if (IS_ERR_OR_NULL(pf)) {
586 		usnic_err("Failed to discover pf of vnic %s with err%ld\n",
587 				pci_name(pdev), PTR_ERR(pf));
588 		err = pf ? PTR_ERR(pf) : -EFAULT;
589 		goto out_clean_vnic;
590 	}
591 
592 	vf->pf = pf;
593 	spin_lock_init(&vf->lock);
594 	mutex_lock(&pf->usdev_lock);
595 	list_add_tail(&vf->link, &pf->vf_dev_list);
596 	/*
597 	 * Save max settings (will be same for each VF, easier to re-write than
598 	 * to say "if (!set) { set_values(); set=1; }
599 	 */
600 	for (res_type = USNIC_VNIC_RES_TYPE_EOL+1;
601 			res_type < USNIC_VNIC_RES_TYPE_MAX;
602 			res_type++) {
603 		pf->vf_res_cnt[res_type] = usnic_vnic_res_cnt(vf->vnic,
604 								res_type);
605 	}
606 
607 	mutex_unlock(&pf->usdev_lock);
608 
609 	usnic_info("Registering usnic VF %s into PF %s\n", pci_name(pdev),
610 			pf->ib_dev.name);
611 	usnic_ib_log_vf(vf);
612 	return 0;
613 
614 out_clean_vnic:
615 	usnic_vnic_free(vf->vnic);
616 out_release_regions:
617 	pci_set_drvdata(pdev, NULL);
618 	pci_clear_master(pdev);
619 	pci_release_regions(pdev);
620 out_disable_device:
621 	pci_disable_device(pdev);
622 out_clean_vf:
623 	kfree(vf);
624 	return err;
625 }
626 
627 static void usnic_ib_pci_remove(struct pci_dev *pdev)
628 {
629 	struct usnic_ib_vf *vf = pci_get_drvdata(pdev);
630 	struct usnic_ib_dev *pf = vf->pf;
631 
632 	mutex_lock(&pf->usdev_lock);
633 	list_del(&vf->link);
634 	mutex_unlock(&pf->usdev_lock);
635 
636 	kref_put(&pf->vf_cnt, usnic_ib_undiscover_pf);
637 	usnic_vnic_free(vf->vnic);
638 	pci_set_drvdata(pdev, NULL);
639 	pci_clear_master(pdev);
640 	pci_release_regions(pdev);
641 	pci_disable_device(pdev);
642 	kfree(vf);
643 
644 	usnic_info("Removed VF %s\n", pci_name(pdev));
645 }
646 
647 /* PCI driver entry points */
648 static struct pci_driver usnic_ib_pci_driver = {
649 	.name = DRV_NAME,
650 	.id_table = usnic_ib_pci_ids,
651 	.probe = usnic_ib_pci_probe,
652 	.remove = usnic_ib_pci_remove,
653 };
654 /* End of PCI section */
655 
656 /* Start of module section */
657 static int __init usnic_ib_init(void)
658 {
659 	int err;
660 
661 	printk_once(KERN_INFO "%s", usnic_version);
662 
663 	err = usnic_uiom_init(DRV_NAME);
664 	if (err) {
665 		usnic_err("Unable to initalize umem with err %d\n", err);
666 		return err;
667 	}
668 
669 	err = pci_register_driver(&usnic_ib_pci_driver);
670 	if (err) {
671 		usnic_err("Unable to register with PCI\n");
672 		goto out_umem_fini;
673 	}
674 
675 	err = register_netdevice_notifier(&usnic_ib_netdevice_notifier);
676 	if (err) {
677 		usnic_err("Failed to register netdev notifier\n");
678 		goto out_pci_unreg;
679 	}
680 
681 	err = register_inetaddr_notifier(&usnic_ib_inetaddr_notifier);
682 	if (err) {
683 		usnic_err("Failed to register inet addr notifier\n");
684 		goto out_unreg_netdev_notifier;
685 	}
686 
687 	err = usnic_transport_init();
688 	if (err) {
689 		usnic_err("Failed to initialize transport\n");
690 		goto out_unreg_inetaddr_notifier;
691 	}
692 
693 	usnic_debugfs_init();
694 
695 	return 0;
696 
697 out_unreg_inetaddr_notifier:
698 	unregister_inetaddr_notifier(&usnic_ib_inetaddr_notifier);
699 out_unreg_netdev_notifier:
700 	unregister_netdevice_notifier(&usnic_ib_netdevice_notifier);
701 out_pci_unreg:
702 	pci_unregister_driver(&usnic_ib_pci_driver);
703 out_umem_fini:
704 	usnic_uiom_fini();
705 
706 	return err;
707 }
708 
709 static void __exit usnic_ib_destroy(void)
710 {
711 	usnic_dbg("\n");
712 	usnic_debugfs_exit();
713 	usnic_transport_fini();
714 	unregister_inetaddr_notifier(&usnic_ib_inetaddr_notifier);
715 	unregister_netdevice_notifier(&usnic_ib_netdevice_notifier);
716 	pci_unregister_driver(&usnic_ib_pci_driver);
717 	usnic_uiom_fini();
718 }
719 
720 MODULE_DESCRIPTION("Cisco VIC (usNIC) Verbs Driver");
721 MODULE_AUTHOR("Upinder Malhi <umalhi@cisco.com>");
722 MODULE_LICENSE("Dual BSD/GPL");
723 MODULE_VERSION(DRV_VERSION);
724 module_param(usnic_log_lvl, uint, S_IRUGO | S_IWUSR);
725 module_param(usnic_ib_share_vf, uint, S_IRUGO | S_IWUSR);
726 MODULE_PARM_DESC(usnic_log_lvl, " Off=0, Err=1, Info=2, Debug=3");
727 MODULE_PARM_DESC(usnic_ib_share_vf, "Off=0, On=1 VF sharing amongst QPs");
728 MODULE_DEVICE_TABLE(pci, usnic_ib_pci_ids);
729 
730 module_init(usnic_ib_init);
731 module_exit(usnic_ib_destroy);
732 /* End of module section */
733