ocrdma_main.c 18 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682
  1. /*******************************************************************
  2. * This file is part of the Emulex RoCE Device Driver for *
  3. * RoCE (RDMA over Converged Ethernet) adapters. *
  4. * Copyright (C) 2008-2012 Emulex. All rights reserved. *
  5. * EMULEX and SLI are trademarks of Emulex. *
  6. * www.emulex.com *
  7. * *
  8. * This program is free software; you can redistribute it and/or *
  9. * modify it under the terms of version 2 of the GNU General *
  10. * Public License as published by the Free Software Foundation. *
  11. * This program is distributed in the hope that it will be useful. *
  12. * ALL EXPRESS OR IMPLIED CONDITIONS, REPRESENTATIONS AND *
  13. * WARRANTIES, INCLUDING ANY IMPLIED WARRANTY OF MERCHANTABILITY, *
  14. * FITNESS FOR A PARTICULAR PURPOSE, OR NON-INFRINGEMENT, ARE *
  15. * DISCLAIMED, EXCEPT TO THE EXTENT THAT SUCH DISCLAIMERS ARE HELD *
  16. * TO BE LEGALLY INVALID. See the GNU General Public License for *
  17. * more details, a copy of which can be found in the file COPYING *
  18. * included with this package. *
  19. *
  20. * Contact Information:
  21. * linux-drivers@emulex.com
  22. *
  23. * Emulex
  24. * 3333 Susan Street
  25. * Costa Mesa, CA 92626
  26. *******************************************************************/
  27. #include <linux/module.h>
  28. #include <linux/idr.h>
  29. #include <rdma/ib_verbs.h>
  30. #include <rdma/ib_user_verbs.h>
  31. #include <rdma/ib_addr.h>
  32. #include <linux/netdevice.h>
  33. #include <net/addrconf.h>
  34. #include "ocrdma.h"
  35. #include "ocrdma_verbs.h"
  36. #include "ocrdma_ah.h"
  37. #include "be_roce.h"
  38. #include "ocrdma_hw.h"
  39. #include "ocrdma_stats.h"
  40. #include "ocrdma_abi.h"
  41. MODULE_VERSION(OCRDMA_ROCE_DRV_VERSION);
  42. MODULE_DESCRIPTION(OCRDMA_ROCE_DRV_DESC " " OCRDMA_ROCE_DRV_VERSION);
  43. MODULE_AUTHOR("Emulex Corporation");
  44. MODULE_LICENSE("GPL");
  45. static LIST_HEAD(ocrdma_dev_list);
  46. static DEFINE_SPINLOCK(ocrdma_devlist_lock);
  47. static DEFINE_IDR(ocrdma_dev_id);
  48. static union ib_gid ocrdma_zero_sgid;
  49. void ocrdma_get_guid(struct ocrdma_dev *dev, u8 *guid)
  50. {
  51. u8 mac_addr[6];
  52. memcpy(&mac_addr[0], &dev->nic_info.mac_addr[0], ETH_ALEN);
  53. guid[0] = mac_addr[0] ^ 2;
  54. guid[1] = mac_addr[1];
  55. guid[2] = mac_addr[2];
  56. guid[3] = 0xff;
  57. guid[4] = 0xfe;
  58. guid[5] = mac_addr[3];
  59. guid[6] = mac_addr[4];
  60. guid[7] = mac_addr[5];
  61. }
  62. static bool ocrdma_add_sgid(struct ocrdma_dev *dev, union ib_gid *new_sgid)
  63. {
  64. int i;
  65. unsigned long flags;
  66. memset(&ocrdma_zero_sgid, 0, sizeof(union ib_gid));
  67. spin_lock_irqsave(&dev->sgid_lock, flags);
  68. for (i = 0; i < OCRDMA_MAX_SGID; i++) {
  69. if (!memcmp(&dev->sgid_tbl[i], &ocrdma_zero_sgid,
  70. sizeof(union ib_gid))) {
  71. /* found free entry */
  72. memcpy(&dev->sgid_tbl[i], new_sgid,
  73. sizeof(union ib_gid));
  74. spin_unlock_irqrestore(&dev->sgid_lock, flags);
  75. return true;
  76. } else if (!memcmp(&dev->sgid_tbl[i], new_sgid,
  77. sizeof(union ib_gid))) {
  78. /* entry already present, no addition is required. */
  79. spin_unlock_irqrestore(&dev->sgid_lock, flags);
  80. return false;
  81. }
  82. }
  83. spin_unlock_irqrestore(&dev->sgid_lock, flags);
  84. return false;
  85. }
  86. static bool ocrdma_del_sgid(struct ocrdma_dev *dev, union ib_gid *sgid)
  87. {
  88. int found = false;
  89. int i;
  90. unsigned long flags;
  91. spin_lock_irqsave(&dev->sgid_lock, flags);
  92. /* first is default sgid, which cannot be deleted. */
  93. for (i = 1; i < OCRDMA_MAX_SGID; i++) {
  94. if (!memcmp(&dev->sgid_tbl[i], sgid, sizeof(union ib_gid))) {
  95. /* found matching entry */
  96. memset(&dev->sgid_tbl[i], 0, sizeof(union ib_gid));
  97. found = true;
  98. break;
  99. }
  100. }
  101. spin_unlock_irqrestore(&dev->sgid_lock, flags);
  102. return found;
  103. }
  104. static int ocrdma_addr_event(unsigned long event, struct net_device *netdev,
  105. union ib_gid *gid)
  106. {
  107. struct ib_event gid_event;
  108. struct ocrdma_dev *dev;
  109. bool found = false;
  110. bool updated = false;
  111. bool is_vlan = false;
  112. is_vlan = netdev->priv_flags & IFF_802_1Q_VLAN;
  113. if (is_vlan)
  114. netdev = rdma_vlan_dev_real_dev(netdev);
  115. rcu_read_lock();
  116. list_for_each_entry_rcu(dev, &ocrdma_dev_list, entry) {
  117. if (dev->nic_info.netdev == netdev) {
  118. found = true;
  119. break;
  120. }
  121. }
  122. rcu_read_unlock();
  123. if (!found)
  124. return NOTIFY_DONE;
  125. mutex_lock(&dev->dev_lock);
  126. switch (event) {
  127. case NETDEV_UP:
  128. updated = ocrdma_add_sgid(dev, gid);
  129. break;
  130. case NETDEV_DOWN:
  131. updated = ocrdma_del_sgid(dev, gid);
  132. break;
  133. default:
  134. break;
  135. }
  136. if (updated) {
  137. /* GID table updated, notify the consumers about it */
  138. gid_event.device = &dev->ibdev;
  139. gid_event.element.port_num = 1;
  140. gid_event.event = IB_EVENT_GID_CHANGE;
  141. ib_dispatch_event(&gid_event);
  142. }
  143. mutex_unlock(&dev->dev_lock);
  144. return NOTIFY_OK;
  145. }
  146. static int ocrdma_inetaddr_event(struct notifier_block *notifier,
  147. unsigned long event, void *ptr)
  148. {
  149. struct in_ifaddr *ifa = ptr;
  150. union ib_gid gid;
  151. struct net_device *netdev = ifa->ifa_dev->dev;
  152. ipv6_addr_set_v4mapped(ifa->ifa_address, (struct in6_addr *)&gid);
  153. return ocrdma_addr_event(event, netdev, &gid);
  154. }
  155. static struct notifier_block ocrdma_inetaddr_notifier = {
  156. .notifier_call = ocrdma_inetaddr_event
  157. };
  158. #if IS_ENABLED(CONFIG_IPV6)
  159. static int ocrdma_inet6addr_event(struct notifier_block *notifier,
  160. unsigned long event, void *ptr)
  161. {
  162. struct inet6_ifaddr *ifa = (struct inet6_ifaddr *)ptr;
  163. union ib_gid *gid = (union ib_gid *)&ifa->addr;
  164. struct net_device *netdev = ifa->idev->dev;
  165. return ocrdma_addr_event(event, netdev, gid);
  166. }
  167. static struct notifier_block ocrdma_inet6addr_notifier = {
  168. .notifier_call = ocrdma_inet6addr_event
  169. };
  170. #endif /* IPV6 and VLAN */
  171. static enum rdma_link_layer ocrdma_link_layer(struct ib_device *device,
  172. u8 port_num)
  173. {
  174. return IB_LINK_LAYER_ETHERNET;
  175. }
  176. static int ocrdma_register_device(struct ocrdma_dev *dev)
  177. {
  178. strlcpy(dev->ibdev.name, "ocrdma%d", IB_DEVICE_NAME_MAX);
  179. ocrdma_get_guid(dev, (u8 *)&dev->ibdev.node_guid);
  180. memcpy(dev->ibdev.node_desc, OCRDMA_NODE_DESC,
  181. sizeof(OCRDMA_NODE_DESC));
  182. dev->ibdev.owner = THIS_MODULE;
  183. dev->ibdev.uverbs_abi_ver = OCRDMA_ABI_VERSION;
  184. dev->ibdev.uverbs_cmd_mask =
  185. OCRDMA_UVERBS(GET_CONTEXT) |
  186. OCRDMA_UVERBS(QUERY_DEVICE) |
  187. OCRDMA_UVERBS(QUERY_PORT) |
  188. OCRDMA_UVERBS(ALLOC_PD) |
  189. OCRDMA_UVERBS(DEALLOC_PD) |
  190. OCRDMA_UVERBS(REG_MR) |
  191. OCRDMA_UVERBS(DEREG_MR) |
  192. OCRDMA_UVERBS(CREATE_COMP_CHANNEL) |
  193. OCRDMA_UVERBS(CREATE_CQ) |
  194. OCRDMA_UVERBS(RESIZE_CQ) |
  195. OCRDMA_UVERBS(DESTROY_CQ) |
  196. OCRDMA_UVERBS(REQ_NOTIFY_CQ) |
  197. OCRDMA_UVERBS(CREATE_QP) |
  198. OCRDMA_UVERBS(MODIFY_QP) |
  199. OCRDMA_UVERBS(QUERY_QP) |
  200. OCRDMA_UVERBS(DESTROY_QP) |
  201. OCRDMA_UVERBS(POLL_CQ) |
  202. OCRDMA_UVERBS(POST_SEND) |
  203. OCRDMA_UVERBS(POST_RECV);
  204. dev->ibdev.uverbs_cmd_mask |=
  205. OCRDMA_UVERBS(CREATE_AH) |
  206. OCRDMA_UVERBS(MODIFY_AH) |
  207. OCRDMA_UVERBS(QUERY_AH) |
  208. OCRDMA_UVERBS(DESTROY_AH);
  209. dev->ibdev.node_type = RDMA_NODE_IB_CA;
  210. dev->ibdev.phys_port_cnt = 1;
  211. dev->ibdev.num_comp_vectors = dev->eq_cnt;
  212. /* mandatory verbs. */
  213. dev->ibdev.query_device = ocrdma_query_device;
  214. dev->ibdev.query_port = ocrdma_query_port;
  215. dev->ibdev.modify_port = ocrdma_modify_port;
  216. dev->ibdev.query_gid = ocrdma_query_gid;
  217. dev->ibdev.get_link_layer = ocrdma_link_layer;
  218. dev->ibdev.alloc_pd = ocrdma_alloc_pd;
  219. dev->ibdev.dealloc_pd = ocrdma_dealloc_pd;
  220. dev->ibdev.create_cq = ocrdma_create_cq;
  221. dev->ibdev.destroy_cq = ocrdma_destroy_cq;
  222. dev->ibdev.resize_cq = ocrdma_resize_cq;
  223. dev->ibdev.create_qp = ocrdma_create_qp;
  224. dev->ibdev.modify_qp = ocrdma_modify_qp;
  225. dev->ibdev.query_qp = ocrdma_query_qp;
  226. dev->ibdev.destroy_qp = ocrdma_destroy_qp;
  227. dev->ibdev.query_pkey = ocrdma_query_pkey;
  228. dev->ibdev.create_ah = ocrdma_create_ah;
  229. dev->ibdev.destroy_ah = ocrdma_destroy_ah;
  230. dev->ibdev.query_ah = ocrdma_query_ah;
  231. dev->ibdev.modify_ah = ocrdma_modify_ah;
  232. dev->ibdev.poll_cq = ocrdma_poll_cq;
  233. dev->ibdev.post_send = ocrdma_post_send;
  234. dev->ibdev.post_recv = ocrdma_post_recv;
  235. dev->ibdev.req_notify_cq = ocrdma_arm_cq;
  236. dev->ibdev.get_dma_mr = ocrdma_get_dma_mr;
  237. dev->ibdev.reg_phys_mr = ocrdma_reg_kernel_mr;
  238. dev->ibdev.dereg_mr = ocrdma_dereg_mr;
  239. dev->ibdev.reg_user_mr = ocrdma_reg_user_mr;
  240. dev->ibdev.alloc_fast_reg_mr = ocrdma_alloc_frmr;
  241. dev->ibdev.alloc_fast_reg_page_list = ocrdma_alloc_frmr_page_list;
  242. dev->ibdev.free_fast_reg_page_list = ocrdma_free_frmr_page_list;
  243. /* mandatory to support user space verbs consumer. */
  244. dev->ibdev.alloc_ucontext = ocrdma_alloc_ucontext;
  245. dev->ibdev.dealloc_ucontext = ocrdma_dealloc_ucontext;
  246. dev->ibdev.mmap = ocrdma_mmap;
  247. dev->ibdev.dma_device = &dev->nic_info.pdev->dev;
  248. dev->ibdev.process_mad = ocrdma_process_mad;
  249. if (ocrdma_get_asic_type(dev) == OCRDMA_ASIC_GEN_SKH_R) {
  250. dev->ibdev.uverbs_cmd_mask |=
  251. OCRDMA_UVERBS(CREATE_SRQ) |
  252. OCRDMA_UVERBS(MODIFY_SRQ) |
  253. OCRDMA_UVERBS(QUERY_SRQ) |
  254. OCRDMA_UVERBS(DESTROY_SRQ) |
  255. OCRDMA_UVERBS(POST_SRQ_RECV);
  256. dev->ibdev.create_srq = ocrdma_create_srq;
  257. dev->ibdev.modify_srq = ocrdma_modify_srq;
  258. dev->ibdev.query_srq = ocrdma_query_srq;
  259. dev->ibdev.destroy_srq = ocrdma_destroy_srq;
  260. dev->ibdev.post_srq_recv = ocrdma_post_srq_recv;
  261. }
  262. return ib_register_device(&dev->ibdev, NULL);
  263. }
  264. static int ocrdma_alloc_resources(struct ocrdma_dev *dev)
  265. {
  266. mutex_init(&dev->dev_lock);
  267. dev->sgid_tbl = kzalloc(sizeof(union ib_gid) *
  268. OCRDMA_MAX_SGID, GFP_KERNEL);
  269. if (!dev->sgid_tbl)
  270. goto alloc_err;
  271. spin_lock_init(&dev->sgid_lock);
  272. dev->cq_tbl = kzalloc(sizeof(struct ocrdma_cq *) *
  273. OCRDMA_MAX_CQ, GFP_KERNEL);
  274. if (!dev->cq_tbl)
  275. goto alloc_err;
  276. if (dev->attr.max_qp) {
  277. dev->qp_tbl = kzalloc(sizeof(struct ocrdma_qp *) *
  278. OCRDMA_MAX_QP, GFP_KERNEL);
  279. if (!dev->qp_tbl)
  280. goto alloc_err;
  281. }
  282. dev->stag_arr = kzalloc(sizeof(u64) * OCRDMA_MAX_STAG, GFP_KERNEL);
  283. if (dev->stag_arr == NULL)
  284. goto alloc_err;
  285. ocrdma_alloc_pd_pool(dev);
  286. spin_lock_init(&dev->av_tbl.lock);
  287. spin_lock_init(&dev->flush_q_lock);
  288. return 0;
  289. alloc_err:
  290. pr_err("%s(%d) error.\n", __func__, dev->id);
  291. return -ENOMEM;
  292. }
  293. static void ocrdma_free_resources(struct ocrdma_dev *dev)
  294. {
  295. kfree(dev->stag_arr);
  296. kfree(dev->qp_tbl);
  297. kfree(dev->cq_tbl);
  298. kfree(dev->sgid_tbl);
  299. }
  300. /* OCRDMA sysfs interface */
  301. static ssize_t show_rev(struct device *device, struct device_attribute *attr,
  302. char *buf)
  303. {
  304. struct ocrdma_dev *dev = dev_get_drvdata(device);
  305. return scnprintf(buf, PAGE_SIZE, "0x%x\n", dev->nic_info.pdev->vendor);
  306. }
  307. static ssize_t show_fw_ver(struct device *device, struct device_attribute *attr,
  308. char *buf)
  309. {
  310. struct ocrdma_dev *dev = dev_get_drvdata(device);
  311. return scnprintf(buf, PAGE_SIZE, "%s\n", &dev->attr.fw_ver[0]);
  312. }
  313. static ssize_t show_hca_type(struct device *device,
  314. struct device_attribute *attr, char *buf)
  315. {
  316. struct ocrdma_dev *dev = dev_get_drvdata(device);
  317. return scnprintf(buf, PAGE_SIZE, "%s\n", &dev->model_number[0]);
  318. }
  319. static DEVICE_ATTR(hw_rev, S_IRUGO, show_rev, NULL);
  320. static DEVICE_ATTR(fw_ver, S_IRUGO, show_fw_ver, NULL);
  321. static DEVICE_ATTR(hca_type, S_IRUGO, show_hca_type, NULL);
  322. static struct device_attribute *ocrdma_attributes[] = {
  323. &dev_attr_hw_rev,
  324. &dev_attr_fw_ver,
  325. &dev_attr_hca_type
  326. };
  327. static void ocrdma_remove_sysfiles(struct ocrdma_dev *dev)
  328. {
  329. int i;
  330. for (i = 0; i < ARRAY_SIZE(ocrdma_attributes); i++)
  331. device_remove_file(&dev->ibdev.dev, ocrdma_attributes[i]);
  332. }
  333. static void ocrdma_add_default_sgid(struct ocrdma_dev *dev)
  334. {
  335. /* GID Index 0 - Invariant manufacturer-assigned EUI-64 */
  336. union ib_gid *sgid = &dev->sgid_tbl[0];
  337. sgid->global.subnet_prefix = cpu_to_be64(0xfe80000000000000LL);
  338. ocrdma_get_guid(dev, &sgid->raw[8]);
  339. }
  340. static void ocrdma_init_ipv4_gids(struct ocrdma_dev *dev,
  341. struct net_device *net)
  342. {
  343. struct in_device *in_dev;
  344. union ib_gid gid;
  345. in_dev = in_dev_get(net);
  346. if (in_dev) {
  347. for_ifa(in_dev) {
  348. ipv6_addr_set_v4mapped(ifa->ifa_address,
  349. (struct in6_addr *)&gid);
  350. ocrdma_add_sgid(dev, &gid);
  351. }
  352. endfor_ifa(in_dev);
  353. in_dev_put(in_dev);
  354. }
  355. }
  356. static void ocrdma_init_ipv6_gids(struct ocrdma_dev *dev,
  357. struct net_device *net)
  358. {
  359. #if IS_ENABLED(CONFIG_IPV6)
  360. struct inet6_dev *in6_dev;
  361. union ib_gid *pgid;
  362. struct inet6_ifaddr *ifp;
  363. in6_dev = in6_dev_get(net);
  364. if (in6_dev) {
  365. read_lock_bh(&in6_dev->lock);
  366. list_for_each_entry(ifp, &in6_dev->addr_list, if_list) {
  367. pgid = (union ib_gid *)&ifp->addr;
  368. ocrdma_add_sgid(dev, pgid);
  369. }
  370. read_unlock_bh(&in6_dev->lock);
  371. in6_dev_put(in6_dev);
  372. }
  373. #endif
  374. }
  375. static void ocrdma_init_gid_table(struct ocrdma_dev *dev)
  376. {
  377. struct net_device *net_dev;
  378. for_each_netdev(&init_net, net_dev) {
  379. struct net_device *real_dev = rdma_vlan_dev_real_dev(net_dev) ?
  380. rdma_vlan_dev_real_dev(net_dev) : net_dev;
  381. if (real_dev == dev->nic_info.netdev) {
  382. ocrdma_add_default_sgid(dev);
  383. ocrdma_init_ipv4_gids(dev, net_dev);
  384. ocrdma_init_ipv6_gids(dev, net_dev);
  385. }
  386. }
  387. }
  388. static struct ocrdma_dev *ocrdma_add(struct be_dev_info *dev_info)
  389. {
  390. int status = 0, i;
  391. struct ocrdma_dev *dev;
  392. dev = (struct ocrdma_dev *)ib_alloc_device(sizeof(struct ocrdma_dev));
  393. if (!dev) {
  394. pr_err("Unable to allocate ib device\n");
  395. return NULL;
  396. }
  397. dev->mbx_cmd = kzalloc(sizeof(struct ocrdma_mqe_emb_cmd), GFP_KERNEL);
  398. if (!dev->mbx_cmd)
  399. goto idr_err;
  400. memcpy(&dev->nic_info, dev_info, sizeof(*dev_info));
  401. dev->id = idr_alloc(&ocrdma_dev_id, NULL, 0, 0, GFP_KERNEL);
  402. if (dev->id < 0)
  403. goto idr_err;
  404. status = ocrdma_init_hw(dev);
  405. if (status)
  406. goto init_err;
  407. status = ocrdma_alloc_resources(dev);
  408. if (status)
  409. goto alloc_err;
  410. ocrdma_init_service_level(dev);
  411. ocrdma_init_gid_table(dev);
  412. status = ocrdma_register_device(dev);
  413. if (status)
  414. goto alloc_err;
  415. for (i = 0; i < ARRAY_SIZE(ocrdma_attributes); i++)
  416. if (device_create_file(&dev->ibdev.dev, ocrdma_attributes[i]))
  417. goto sysfs_err;
  418. spin_lock(&ocrdma_devlist_lock);
  419. list_add_tail_rcu(&dev->entry, &ocrdma_dev_list);
  420. spin_unlock(&ocrdma_devlist_lock);
  421. /* Init stats */
  422. ocrdma_add_port_stats(dev);
  423. /* Interrupt Moderation */
  424. INIT_DELAYED_WORK(&dev->eqd_work, ocrdma_eqd_set_task);
  425. schedule_delayed_work(&dev->eqd_work, msecs_to_jiffies(1000));
  426. pr_info("%s %s: %s \"%s\" port %d\n",
  427. dev_name(&dev->nic_info.pdev->dev), hca_name(dev),
  428. port_speed_string(dev), dev->model_number,
  429. dev->hba_port_num);
  430. pr_info("%s ocrdma%d driver loaded successfully\n",
  431. dev_name(&dev->nic_info.pdev->dev), dev->id);
  432. return dev;
  433. sysfs_err:
  434. ocrdma_remove_sysfiles(dev);
  435. alloc_err:
  436. ocrdma_free_resources(dev);
  437. ocrdma_cleanup_hw(dev);
  438. init_err:
  439. idr_remove(&ocrdma_dev_id, dev->id);
  440. idr_err:
  441. kfree(dev->mbx_cmd);
  442. ib_dealloc_device(&dev->ibdev);
  443. pr_err("%s() leaving. ret=%d\n", __func__, status);
  444. return NULL;
  445. }
  446. static void ocrdma_remove_free(struct rcu_head *rcu)
  447. {
  448. struct ocrdma_dev *dev = container_of(rcu, struct ocrdma_dev, rcu);
  449. idr_remove(&ocrdma_dev_id, dev->id);
  450. kfree(dev->mbx_cmd);
  451. ib_dealloc_device(&dev->ibdev);
  452. }
  453. static void ocrdma_remove(struct ocrdma_dev *dev)
  454. {
  455. /* first unregister with stack to stop all the active traffic
  456. * of the registered clients.
  457. */
  458. cancel_delayed_work_sync(&dev->eqd_work);
  459. ocrdma_remove_sysfiles(dev);
  460. ib_unregister_device(&dev->ibdev);
  461. ocrdma_rem_port_stats(dev);
  462. spin_lock(&ocrdma_devlist_lock);
  463. list_del_rcu(&dev->entry);
  464. spin_unlock(&ocrdma_devlist_lock);
  465. ocrdma_free_resources(dev);
  466. ocrdma_cleanup_hw(dev);
  467. call_rcu(&dev->rcu, ocrdma_remove_free);
  468. }
  469. static int ocrdma_open(struct ocrdma_dev *dev)
  470. {
  471. struct ib_event port_event;
  472. port_event.event = IB_EVENT_PORT_ACTIVE;
  473. port_event.element.port_num = 1;
  474. port_event.device = &dev->ibdev;
  475. ib_dispatch_event(&port_event);
  476. return 0;
  477. }
  478. static int ocrdma_close(struct ocrdma_dev *dev)
  479. {
  480. int i;
  481. struct ocrdma_qp *qp, **cur_qp;
  482. struct ib_event err_event;
  483. struct ib_qp_attr attrs;
  484. int attr_mask = IB_QP_STATE;
  485. attrs.qp_state = IB_QPS_ERR;
  486. mutex_lock(&dev->dev_lock);
  487. if (dev->qp_tbl) {
  488. cur_qp = dev->qp_tbl;
  489. for (i = 0; i < OCRDMA_MAX_QP; i++) {
  490. qp = cur_qp[i];
  491. if (qp && qp->ibqp.qp_type != IB_QPT_GSI) {
  492. /* change the QP state to ERROR */
  493. _ocrdma_modify_qp(&qp->ibqp, &attrs, attr_mask);
  494. err_event.event = IB_EVENT_QP_FATAL;
  495. err_event.element.qp = &qp->ibqp;
  496. err_event.device = &dev->ibdev;
  497. ib_dispatch_event(&err_event);
  498. }
  499. }
  500. }
  501. mutex_unlock(&dev->dev_lock);
  502. err_event.event = IB_EVENT_PORT_ERR;
  503. err_event.element.port_num = 1;
  504. err_event.device = &dev->ibdev;
  505. ib_dispatch_event(&err_event);
  506. return 0;
  507. }
  508. static void ocrdma_shutdown(struct ocrdma_dev *dev)
  509. {
  510. ocrdma_close(dev);
  511. ocrdma_remove(dev);
  512. }
  513. /* event handling via NIC driver ensures that all the NIC specific
  514. * initialization done before RoCE driver notifies
  515. * event to stack.
  516. */
  517. static void ocrdma_event_handler(struct ocrdma_dev *dev, u32 event)
  518. {
  519. switch (event) {
  520. case BE_DEV_UP:
  521. ocrdma_open(dev);
  522. break;
  523. case BE_DEV_DOWN:
  524. ocrdma_close(dev);
  525. break;
  526. case BE_DEV_SHUTDOWN:
  527. ocrdma_shutdown(dev);
  528. break;
  529. }
  530. }
  531. static struct ocrdma_driver ocrdma_drv = {
  532. .name = "ocrdma_driver",
  533. .add = ocrdma_add,
  534. .remove = ocrdma_remove,
  535. .state_change_handler = ocrdma_event_handler,
  536. .be_abi_version = OCRDMA_BE_ROCE_ABI_VERSION,
  537. };
  538. static void ocrdma_unregister_inet6addr_notifier(void)
  539. {
  540. #if IS_ENABLED(CONFIG_IPV6)
  541. unregister_inet6addr_notifier(&ocrdma_inet6addr_notifier);
  542. #endif
  543. }
  544. static void ocrdma_unregister_inetaddr_notifier(void)
  545. {
  546. unregister_inetaddr_notifier(&ocrdma_inetaddr_notifier);
  547. }
  548. static int __init ocrdma_init_module(void)
  549. {
  550. int status;
  551. ocrdma_init_debugfs();
  552. status = register_inetaddr_notifier(&ocrdma_inetaddr_notifier);
  553. if (status)
  554. return status;
  555. #if IS_ENABLED(CONFIG_IPV6)
  556. status = register_inet6addr_notifier(&ocrdma_inet6addr_notifier);
  557. if (status)
  558. goto err_notifier6;
  559. #endif
  560. status = be_roce_register_driver(&ocrdma_drv);
  561. if (status)
  562. goto err_be_reg;
  563. return 0;
  564. err_be_reg:
  565. #if IS_ENABLED(CONFIG_IPV6)
  566. ocrdma_unregister_inet6addr_notifier();
  567. err_notifier6:
  568. #endif
  569. ocrdma_unregister_inetaddr_notifier();
  570. return status;
  571. }
  572. static void __exit ocrdma_exit_module(void)
  573. {
  574. be_roce_unregister_driver(&ocrdma_drv);
  575. ocrdma_unregister_inet6addr_notifier();
  576. ocrdma_unregister_inetaddr_notifier();
  577. ocrdma_rem_debugfs();
  578. }
  579. module_init(ocrdma_init_module);
  580. module_exit(ocrdma_exit_module);