main.c 27 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035
  1. /* QLogic qedr NIC Driver
  2. * Copyright (c) 2015-2016 QLogic Corporation
  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. * OpenIB.org 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. #include <linux/module.h>
  33. #include <rdma/ib_verbs.h>
  34. #include <rdma/ib_addr.h>
  35. #include <rdma/ib_user_verbs.h>
  36. #include <rdma/iw_cm.h>
  37. #include <rdma/ib_mad.h>
  38. #include <linux/netdevice.h>
  39. #include <linux/iommu.h>
  40. #include <linux/pci.h>
  41. #include <net/addrconf.h>
  42. #include <linux/idr.h>
  43. #include <linux/qed/qed_chain.h>
  44. #include <linux/qed/qed_if.h>
  45. #include "qedr.h"
  46. #include "verbs.h"
  47. #include <rdma/qedr-abi.h>
  48. #include "qedr_iw_cm.h"
  49. MODULE_DESCRIPTION("QLogic 40G/100G ROCE Driver");
  50. MODULE_AUTHOR("QLogic Corporation");
  51. MODULE_LICENSE("Dual BSD/GPL");
  52. #define QEDR_WQ_MULTIPLIER_DFT (3)
  53. static void qedr_ib_dispatch_event(struct qedr_dev *dev, u8 port_num,
  54. enum ib_event_type type)
  55. {
  56. struct ib_event ibev;
  57. ibev.device = &dev->ibdev;
  58. ibev.element.port_num = port_num;
  59. ibev.event = type;
  60. ib_dispatch_event(&ibev);
  61. }
  62. static enum rdma_link_layer qedr_link_layer(struct ib_device *device,
  63. u8 port_num)
  64. {
  65. return IB_LINK_LAYER_ETHERNET;
  66. }
  67. static void qedr_get_dev_fw_str(struct ib_device *ibdev, char *str)
  68. {
  69. struct qedr_dev *qedr = get_qedr_dev(ibdev);
  70. u32 fw_ver = (u32)qedr->attr.fw_ver;
  71. snprintf(str, IB_FW_VERSION_NAME_MAX, "%d. %d. %d. %d",
  72. (fw_ver >> 24) & 0xFF, (fw_ver >> 16) & 0xFF,
  73. (fw_ver >> 8) & 0xFF, fw_ver & 0xFF);
  74. }
  75. static struct net_device *qedr_get_netdev(struct ib_device *dev, u8 port_num)
  76. {
  77. struct qedr_dev *qdev;
  78. qdev = get_qedr_dev(dev);
  79. dev_hold(qdev->ndev);
  80. /* The HW vendor's device driver must guarantee
  81. * that this function returns NULL before the net device has finished
  82. * NETDEV_UNREGISTER state.
  83. */
  84. return qdev->ndev;
  85. }
  86. static int qedr_roce_port_immutable(struct ib_device *ibdev, u8 port_num,
  87. struct ib_port_immutable *immutable)
  88. {
  89. struct ib_port_attr attr;
  90. int err;
  91. err = qedr_query_port(ibdev, port_num, &attr);
  92. if (err)
  93. return err;
  94. immutable->pkey_tbl_len = attr.pkey_tbl_len;
  95. immutable->gid_tbl_len = attr.gid_tbl_len;
  96. immutable->core_cap_flags = RDMA_CORE_PORT_IBA_ROCE |
  97. RDMA_CORE_PORT_IBA_ROCE_UDP_ENCAP;
  98. immutable->max_mad_size = IB_MGMT_MAD_SIZE;
  99. return 0;
  100. }
  101. static int qedr_iw_port_immutable(struct ib_device *ibdev, u8 port_num,
  102. struct ib_port_immutable *immutable)
  103. {
  104. struct ib_port_attr attr;
  105. int err;
  106. err = qedr_query_port(ibdev, port_num, &attr);
  107. if (err)
  108. return err;
  109. immutable->pkey_tbl_len = 1;
  110. immutable->gid_tbl_len = 1;
  111. immutable->core_cap_flags = RDMA_CORE_PORT_IWARP;
  112. immutable->max_mad_size = 0;
  113. return 0;
  114. }
  115. /* QEDR sysfs interface */
  116. static ssize_t hw_rev_show(struct device *device, struct device_attribute *attr,
  117. char *buf)
  118. {
  119. struct qedr_dev *dev = dev_get_drvdata(device);
  120. return scnprintf(buf, PAGE_SIZE, "0x%x\n", dev->pdev->vendor);
  121. }
  122. static DEVICE_ATTR_RO(hw_rev);
  123. static ssize_t hca_type_show(struct device *device,
  124. struct device_attribute *attr, char *buf)
  125. {
  126. return scnprintf(buf, PAGE_SIZE, "%s\n", "HCA_TYPE_TO_SET");
  127. }
  128. static DEVICE_ATTR_RO(hca_type);
  129. static struct attribute *qedr_attributes[] = {
  130. &dev_attr_hw_rev.attr,
  131. &dev_attr_hca_type.attr,
  132. NULL
  133. };
  134. static const struct attribute_group qedr_attr_group = {
  135. .attrs = qedr_attributes,
  136. };
  137. static int qedr_iw_register_device(struct qedr_dev *dev)
  138. {
  139. dev->ibdev.node_type = RDMA_NODE_RNIC;
  140. dev->ibdev.query_gid = qedr_iw_query_gid;
  141. dev->ibdev.get_port_immutable = qedr_iw_port_immutable;
  142. dev->ibdev.iwcm = kzalloc(sizeof(*dev->ibdev.iwcm), GFP_KERNEL);
  143. if (!dev->ibdev.iwcm)
  144. return -ENOMEM;
  145. dev->ibdev.iwcm->connect = qedr_iw_connect;
  146. dev->ibdev.iwcm->accept = qedr_iw_accept;
  147. dev->ibdev.iwcm->reject = qedr_iw_reject;
  148. dev->ibdev.iwcm->create_listen = qedr_iw_create_listen;
  149. dev->ibdev.iwcm->destroy_listen = qedr_iw_destroy_listen;
  150. dev->ibdev.iwcm->add_ref = qedr_iw_qp_add_ref;
  151. dev->ibdev.iwcm->rem_ref = qedr_iw_qp_rem_ref;
  152. dev->ibdev.iwcm->get_qp = qedr_iw_get_qp;
  153. memcpy(dev->ibdev.iwcm->ifname,
  154. dev->ndev->name, sizeof(dev->ibdev.iwcm->ifname));
  155. return 0;
  156. }
  157. static void qedr_roce_register_device(struct qedr_dev *dev)
  158. {
  159. dev->ibdev.node_type = RDMA_NODE_IB_CA;
  160. dev->ibdev.get_port_immutable = qedr_roce_port_immutable;
  161. }
  162. static int qedr_register_device(struct qedr_dev *dev)
  163. {
  164. int rc;
  165. dev->ibdev.node_guid = dev->attr.node_guid;
  166. memcpy(dev->ibdev.node_desc, QEDR_NODE_DESC, sizeof(QEDR_NODE_DESC));
  167. dev->ibdev.owner = THIS_MODULE;
  168. dev->ibdev.uverbs_abi_ver = QEDR_ABI_VERSION;
  169. dev->ibdev.uverbs_cmd_mask = QEDR_UVERBS(GET_CONTEXT) |
  170. QEDR_UVERBS(QUERY_DEVICE) |
  171. QEDR_UVERBS(QUERY_PORT) |
  172. QEDR_UVERBS(ALLOC_PD) |
  173. QEDR_UVERBS(DEALLOC_PD) |
  174. QEDR_UVERBS(CREATE_COMP_CHANNEL) |
  175. QEDR_UVERBS(CREATE_CQ) |
  176. QEDR_UVERBS(RESIZE_CQ) |
  177. QEDR_UVERBS(DESTROY_CQ) |
  178. QEDR_UVERBS(REQ_NOTIFY_CQ) |
  179. QEDR_UVERBS(CREATE_QP) |
  180. QEDR_UVERBS(MODIFY_QP) |
  181. QEDR_UVERBS(QUERY_QP) |
  182. QEDR_UVERBS(DESTROY_QP) |
  183. QEDR_UVERBS(CREATE_SRQ) |
  184. QEDR_UVERBS(DESTROY_SRQ) |
  185. QEDR_UVERBS(QUERY_SRQ) |
  186. QEDR_UVERBS(MODIFY_SRQ) |
  187. QEDR_UVERBS(POST_SRQ_RECV) |
  188. QEDR_UVERBS(REG_MR) |
  189. QEDR_UVERBS(DEREG_MR) |
  190. QEDR_UVERBS(POLL_CQ) |
  191. QEDR_UVERBS(POST_SEND) |
  192. QEDR_UVERBS(POST_RECV);
  193. if (IS_IWARP(dev)) {
  194. rc = qedr_iw_register_device(dev);
  195. if (rc)
  196. return rc;
  197. } else {
  198. qedr_roce_register_device(dev);
  199. }
  200. dev->ibdev.phys_port_cnt = 1;
  201. dev->ibdev.num_comp_vectors = dev->num_cnq;
  202. dev->ibdev.query_device = qedr_query_device;
  203. dev->ibdev.query_port = qedr_query_port;
  204. dev->ibdev.modify_port = qedr_modify_port;
  205. dev->ibdev.alloc_ucontext = qedr_alloc_ucontext;
  206. dev->ibdev.dealloc_ucontext = qedr_dealloc_ucontext;
  207. dev->ibdev.mmap = qedr_mmap;
  208. dev->ibdev.alloc_pd = qedr_alloc_pd;
  209. dev->ibdev.dealloc_pd = qedr_dealloc_pd;
  210. dev->ibdev.create_cq = qedr_create_cq;
  211. dev->ibdev.destroy_cq = qedr_destroy_cq;
  212. dev->ibdev.resize_cq = qedr_resize_cq;
  213. dev->ibdev.req_notify_cq = qedr_arm_cq;
  214. dev->ibdev.create_qp = qedr_create_qp;
  215. dev->ibdev.modify_qp = qedr_modify_qp;
  216. dev->ibdev.query_qp = qedr_query_qp;
  217. dev->ibdev.destroy_qp = qedr_destroy_qp;
  218. dev->ibdev.create_srq = qedr_create_srq;
  219. dev->ibdev.destroy_srq = qedr_destroy_srq;
  220. dev->ibdev.modify_srq = qedr_modify_srq;
  221. dev->ibdev.query_srq = qedr_query_srq;
  222. dev->ibdev.post_srq_recv = qedr_post_srq_recv;
  223. dev->ibdev.query_pkey = qedr_query_pkey;
  224. dev->ibdev.create_ah = qedr_create_ah;
  225. dev->ibdev.destroy_ah = qedr_destroy_ah;
  226. dev->ibdev.get_dma_mr = qedr_get_dma_mr;
  227. dev->ibdev.dereg_mr = qedr_dereg_mr;
  228. dev->ibdev.reg_user_mr = qedr_reg_user_mr;
  229. dev->ibdev.alloc_mr = qedr_alloc_mr;
  230. dev->ibdev.map_mr_sg = qedr_map_mr_sg;
  231. dev->ibdev.poll_cq = qedr_poll_cq;
  232. dev->ibdev.post_send = qedr_post_send;
  233. dev->ibdev.post_recv = qedr_post_recv;
  234. dev->ibdev.process_mad = qedr_process_mad;
  235. dev->ibdev.get_netdev = qedr_get_netdev;
  236. dev->ibdev.dev.parent = &dev->pdev->dev;
  237. dev->ibdev.get_link_layer = qedr_link_layer;
  238. dev->ibdev.get_dev_fw_str = qedr_get_dev_fw_str;
  239. rdma_set_device_sysfs_group(&dev->ibdev, &qedr_attr_group);
  240. dev->ibdev.driver_id = RDMA_DRIVER_QEDR;
  241. return ib_register_device(&dev->ibdev, "qedr%d", NULL);
  242. }
  243. /* This function allocates fast-path status block memory */
  244. static int qedr_alloc_mem_sb(struct qedr_dev *dev,
  245. struct qed_sb_info *sb_info, u16 sb_id)
  246. {
  247. struct status_block_e4 *sb_virt;
  248. dma_addr_t sb_phys;
  249. int rc;
  250. sb_virt = dma_alloc_coherent(&dev->pdev->dev,
  251. sizeof(*sb_virt), &sb_phys, GFP_KERNEL);
  252. if (!sb_virt)
  253. return -ENOMEM;
  254. rc = dev->ops->common->sb_init(dev->cdev, sb_info,
  255. sb_virt, sb_phys, sb_id,
  256. QED_SB_TYPE_CNQ);
  257. if (rc) {
  258. pr_err("Status block initialization failed\n");
  259. dma_free_coherent(&dev->pdev->dev, sizeof(*sb_virt),
  260. sb_virt, sb_phys);
  261. return rc;
  262. }
  263. return 0;
  264. }
  265. static void qedr_free_mem_sb(struct qedr_dev *dev,
  266. struct qed_sb_info *sb_info, int sb_id)
  267. {
  268. if (sb_info->sb_virt) {
  269. dev->ops->common->sb_release(dev->cdev, sb_info, sb_id);
  270. dma_free_coherent(&dev->pdev->dev, sizeof(*sb_info->sb_virt),
  271. (void *)sb_info->sb_virt, sb_info->sb_phys);
  272. }
  273. }
  274. static void qedr_free_resources(struct qedr_dev *dev)
  275. {
  276. int i;
  277. if (IS_IWARP(dev))
  278. destroy_workqueue(dev->iwarp_wq);
  279. for (i = 0; i < dev->num_cnq; i++) {
  280. qedr_free_mem_sb(dev, &dev->sb_array[i], dev->sb_start + i);
  281. dev->ops->common->chain_free(dev->cdev, &dev->cnq_array[i].pbl);
  282. }
  283. kfree(dev->cnq_array);
  284. kfree(dev->sb_array);
  285. kfree(dev->sgid_tbl);
  286. }
  287. static int qedr_alloc_resources(struct qedr_dev *dev)
  288. {
  289. struct qedr_cnq *cnq;
  290. __le16 *cons_pi;
  291. u16 n_entries;
  292. int i, rc;
  293. dev->sgid_tbl = kcalloc(QEDR_MAX_SGID, sizeof(union ib_gid),
  294. GFP_KERNEL);
  295. if (!dev->sgid_tbl)
  296. return -ENOMEM;
  297. spin_lock_init(&dev->sgid_lock);
  298. if (IS_IWARP(dev)) {
  299. spin_lock_init(&dev->qpidr.idr_lock);
  300. idr_init(&dev->qpidr.idr);
  301. dev->iwarp_wq = create_singlethread_workqueue("qedr_iwarpq");
  302. }
  303. /* Allocate Status blocks for CNQ */
  304. dev->sb_array = kcalloc(dev->num_cnq, sizeof(*dev->sb_array),
  305. GFP_KERNEL);
  306. if (!dev->sb_array) {
  307. rc = -ENOMEM;
  308. goto err1;
  309. }
  310. dev->cnq_array = kcalloc(dev->num_cnq,
  311. sizeof(*dev->cnq_array), GFP_KERNEL);
  312. if (!dev->cnq_array) {
  313. rc = -ENOMEM;
  314. goto err2;
  315. }
  316. dev->sb_start = dev->ops->rdma_get_start_sb(dev->cdev);
  317. /* Allocate CNQ PBLs */
  318. n_entries = min_t(u32, QED_RDMA_MAX_CNQ_SIZE, QEDR_ROCE_MAX_CNQ_SIZE);
  319. for (i = 0; i < dev->num_cnq; i++) {
  320. cnq = &dev->cnq_array[i];
  321. rc = qedr_alloc_mem_sb(dev, &dev->sb_array[i],
  322. dev->sb_start + i);
  323. if (rc)
  324. goto err3;
  325. rc = dev->ops->common->chain_alloc(dev->cdev,
  326. QED_CHAIN_USE_TO_CONSUME,
  327. QED_CHAIN_MODE_PBL,
  328. QED_CHAIN_CNT_TYPE_U16,
  329. n_entries,
  330. sizeof(struct regpair *),
  331. &cnq->pbl, NULL);
  332. if (rc)
  333. goto err4;
  334. cnq->dev = dev;
  335. cnq->sb = &dev->sb_array[i];
  336. cons_pi = dev->sb_array[i].sb_virt->pi_array;
  337. cnq->hw_cons_ptr = &cons_pi[QED_ROCE_PROTOCOL_INDEX];
  338. cnq->index = i;
  339. sprintf(cnq->name, "qedr%d@pci:%s", i, pci_name(dev->pdev));
  340. DP_DEBUG(dev, QEDR_MSG_INIT, "cnq[%d].cons=%d\n",
  341. i, qed_chain_get_cons_idx(&cnq->pbl));
  342. }
  343. return 0;
  344. err4:
  345. qedr_free_mem_sb(dev, &dev->sb_array[i], dev->sb_start + i);
  346. err3:
  347. for (--i; i >= 0; i--) {
  348. dev->ops->common->chain_free(dev->cdev, &dev->cnq_array[i].pbl);
  349. qedr_free_mem_sb(dev, &dev->sb_array[i], dev->sb_start + i);
  350. }
  351. kfree(dev->cnq_array);
  352. err2:
  353. kfree(dev->sb_array);
  354. err1:
  355. kfree(dev->sgid_tbl);
  356. return rc;
  357. }
  358. static void qedr_pci_set_atomic(struct qedr_dev *dev, struct pci_dev *pdev)
  359. {
  360. int rc = pci_enable_atomic_ops_to_root(pdev,
  361. PCI_EXP_DEVCAP2_ATOMIC_COMP64);
  362. if (rc) {
  363. dev->atomic_cap = IB_ATOMIC_NONE;
  364. DP_DEBUG(dev, QEDR_MSG_INIT, "Atomic capability disabled\n");
  365. } else {
  366. dev->atomic_cap = IB_ATOMIC_GLOB;
  367. DP_DEBUG(dev, QEDR_MSG_INIT, "Atomic capability enabled\n");
  368. }
  369. }
  370. static const struct qed_rdma_ops *qed_ops;
  371. #define HILO_U64(hi, lo) ((((u64)(hi)) << 32) + (lo))
  372. static irqreturn_t qedr_irq_handler(int irq, void *handle)
  373. {
  374. u16 hw_comp_cons, sw_comp_cons;
  375. struct qedr_cnq *cnq = handle;
  376. struct regpair *cq_handle;
  377. struct qedr_cq *cq;
  378. qed_sb_ack(cnq->sb, IGU_INT_DISABLE, 0);
  379. qed_sb_update_sb_idx(cnq->sb);
  380. hw_comp_cons = le16_to_cpu(*cnq->hw_cons_ptr);
  381. sw_comp_cons = qed_chain_get_cons_idx(&cnq->pbl);
  382. /* Align protocol-index and chain reads */
  383. rmb();
  384. while (sw_comp_cons != hw_comp_cons) {
  385. cq_handle = (struct regpair *)qed_chain_consume(&cnq->pbl);
  386. cq = (struct qedr_cq *)(uintptr_t)HILO_U64(cq_handle->hi,
  387. cq_handle->lo);
  388. if (cq == NULL) {
  389. DP_ERR(cnq->dev,
  390. "Received NULL CQ cq_handle->hi=%d cq_handle->lo=%d sw_comp_cons=%d hw_comp_cons=%d\n",
  391. cq_handle->hi, cq_handle->lo, sw_comp_cons,
  392. hw_comp_cons);
  393. break;
  394. }
  395. if (cq->sig != QEDR_CQ_MAGIC_NUMBER) {
  396. DP_ERR(cnq->dev,
  397. "Problem with cq signature, cq_handle->hi=%d ch_handle->lo=%d cq=%p\n",
  398. cq_handle->hi, cq_handle->lo, cq);
  399. break;
  400. }
  401. cq->arm_flags = 0;
  402. if (!cq->destroyed && cq->ibcq.comp_handler)
  403. (*cq->ibcq.comp_handler)
  404. (&cq->ibcq, cq->ibcq.cq_context);
  405. /* The CQ's CNQ notification counter is checked before
  406. * destroying the CQ in a busy-wait loop that waits for all of
  407. * the CQ's CNQ interrupts to be processed. It is increased
  408. * here, only after the completion handler, to ensure that the
  409. * the handler is not running when the CQ is destroyed.
  410. */
  411. cq->cnq_notif++;
  412. sw_comp_cons = qed_chain_get_cons_idx(&cnq->pbl);
  413. cnq->n_comp++;
  414. }
  415. qed_ops->rdma_cnq_prod_update(cnq->dev->rdma_ctx, cnq->index,
  416. sw_comp_cons);
  417. qed_sb_ack(cnq->sb, IGU_INT_ENABLE, 1);
  418. return IRQ_HANDLED;
  419. }
  420. static void qedr_sync_free_irqs(struct qedr_dev *dev)
  421. {
  422. u32 vector;
  423. int i;
  424. for (i = 0; i < dev->int_info.used_cnt; i++) {
  425. if (dev->int_info.msix_cnt) {
  426. vector = dev->int_info.msix[i * dev->num_hwfns].vector;
  427. synchronize_irq(vector);
  428. free_irq(vector, &dev->cnq_array[i]);
  429. }
  430. }
  431. dev->int_info.used_cnt = 0;
  432. }
  433. static int qedr_req_msix_irqs(struct qedr_dev *dev)
  434. {
  435. int i, rc = 0;
  436. if (dev->num_cnq > dev->int_info.msix_cnt) {
  437. DP_ERR(dev,
  438. "Interrupt mismatch: %d CNQ queues > %d MSI-x vectors\n",
  439. dev->num_cnq, dev->int_info.msix_cnt);
  440. return -EINVAL;
  441. }
  442. for (i = 0; i < dev->num_cnq; i++) {
  443. rc = request_irq(dev->int_info.msix[i * dev->num_hwfns].vector,
  444. qedr_irq_handler, 0, dev->cnq_array[i].name,
  445. &dev->cnq_array[i]);
  446. if (rc) {
  447. DP_ERR(dev, "Request cnq %d irq failed\n", i);
  448. qedr_sync_free_irqs(dev);
  449. } else {
  450. DP_DEBUG(dev, QEDR_MSG_INIT,
  451. "Requested cnq irq for %s [entry %d]. Cookie is at %p\n",
  452. dev->cnq_array[i].name, i,
  453. &dev->cnq_array[i]);
  454. dev->int_info.used_cnt++;
  455. }
  456. }
  457. return rc;
  458. }
  459. static int qedr_setup_irqs(struct qedr_dev *dev)
  460. {
  461. int rc;
  462. DP_DEBUG(dev, QEDR_MSG_INIT, "qedr_setup_irqs\n");
  463. /* Learn Interrupt configuration */
  464. rc = dev->ops->rdma_set_rdma_int(dev->cdev, dev->num_cnq);
  465. if (rc < 0)
  466. return rc;
  467. rc = dev->ops->rdma_get_rdma_int(dev->cdev, &dev->int_info);
  468. if (rc) {
  469. DP_DEBUG(dev, QEDR_MSG_INIT, "get_rdma_int failed\n");
  470. return rc;
  471. }
  472. if (dev->int_info.msix_cnt) {
  473. DP_DEBUG(dev, QEDR_MSG_INIT, "rdma msix_cnt = %d\n",
  474. dev->int_info.msix_cnt);
  475. rc = qedr_req_msix_irqs(dev);
  476. if (rc)
  477. return rc;
  478. }
  479. DP_DEBUG(dev, QEDR_MSG_INIT, "qedr_setup_irqs succeeded\n");
  480. return 0;
  481. }
  482. static int qedr_set_device_attr(struct qedr_dev *dev)
  483. {
  484. struct qed_rdma_device *qed_attr;
  485. struct qedr_device_attr *attr;
  486. u32 page_size;
  487. /* Part 1 - query core capabilities */
  488. qed_attr = dev->ops->rdma_query_device(dev->rdma_ctx);
  489. /* Part 2 - check capabilities */
  490. page_size = ~dev->attr.page_size_caps + 1;
  491. if (page_size > PAGE_SIZE) {
  492. DP_ERR(dev,
  493. "Kernel PAGE_SIZE is %ld which is smaller than minimum page size (%d) required by qedr\n",
  494. PAGE_SIZE, page_size);
  495. return -ENODEV;
  496. }
  497. /* Part 3 - copy and update capabilities */
  498. attr = &dev->attr;
  499. attr->vendor_id = qed_attr->vendor_id;
  500. attr->vendor_part_id = qed_attr->vendor_part_id;
  501. attr->hw_ver = qed_attr->hw_ver;
  502. attr->fw_ver = qed_attr->fw_ver;
  503. attr->node_guid = qed_attr->node_guid;
  504. attr->sys_image_guid = qed_attr->sys_image_guid;
  505. attr->max_cnq = qed_attr->max_cnq;
  506. attr->max_sge = qed_attr->max_sge;
  507. attr->max_inline = qed_attr->max_inline;
  508. attr->max_sqe = min_t(u32, qed_attr->max_wqe, QEDR_MAX_SQE);
  509. attr->max_rqe = min_t(u32, qed_attr->max_wqe, QEDR_MAX_RQE);
  510. attr->max_qp_resp_rd_atomic_resc = qed_attr->max_qp_resp_rd_atomic_resc;
  511. attr->max_qp_req_rd_atomic_resc = qed_attr->max_qp_req_rd_atomic_resc;
  512. attr->max_dev_resp_rd_atomic_resc =
  513. qed_attr->max_dev_resp_rd_atomic_resc;
  514. attr->max_cq = qed_attr->max_cq;
  515. attr->max_qp = qed_attr->max_qp;
  516. attr->max_mr = qed_attr->max_mr;
  517. attr->max_mr_size = qed_attr->max_mr_size;
  518. attr->max_cqe = min_t(u64, qed_attr->max_cqe, QEDR_MAX_CQES);
  519. attr->max_mw = qed_attr->max_mw;
  520. attr->max_fmr = qed_attr->max_fmr;
  521. attr->max_mr_mw_fmr_pbl = qed_attr->max_mr_mw_fmr_pbl;
  522. attr->max_mr_mw_fmr_size = qed_attr->max_mr_mw_fmr_size;
  523. attr->max_pd = qed_attr->max_pd;
  524. attr->max_ah = qed_attr->max_ah;
  525. attr->max_pkey = qed_attr->max_pkey;
  526. attr->max_srq = qed_attr->max_srq;
  527. attr->max_srq_wr = qed_attr->max_srq_wr;
  528. attr->dev_caps = qed_attr->dev_caps;
  529. attr->page_size_caps = qed_attr->page_size_caps;
  530. attr->dev_ack_delay = qed_attr->dev_ack_delay;
  531. attr->reserved_lkey = qed_attr->reserved_lkey;
  532. attr->bad_pkey_counter = qed_attr->bad_pkey_counter;
  533. attr->max_stats_queues = qed_attr->max_stats_queues;
  534. return 0;
  535. }
  536. static void qedr_unaffiliated_event(void *context, u8 event_code)
  537. {
  538. pr_err("unaffiliated event not implemented yet\n");
  539. }
  540. static void qedr_affiliated_event(void *context, u8 e_code, void *fw_handle)
  541. {
  542. #define EVENT_TYPE_NOT_DEFINED 0
  543. #define EVENT_TYPE_CQ 1
  544. #define EVENT_TYPE_QP 2
  545. #define EVENT_TYPE_SRQ 3
  546. struct qedr_dev *dev = (struct qedr_dev *)context;
  547. struct regpair *async_handle = (struct regpair *)fw_handle;
  548. u64 roce_handle64 = ((u64) async_handle->hi << 32) + async_handle->lo;
  549. u8 event_type = EVENT_TYPE_NOT_DEFINED;
  550. struct ib_event event;
  551. struct ib_srq *ibsrq;
  552. struct qedr_srq *srq;
  553. unsigned long flags;
  554. struct ib_cq *ibcq;
  555. struct ib_qp *ibqp;
  556. struct qedr_cq *cq;
  557. struct qedr_qp *qp;
  558. u16 srq_id;
  559. if (IS_ROCE(dev)) {
  560. switch (e_code) {
  561. case ROCE_ASYNC_EVENT_CQ_OVERFLOW_ERR:
  562. event.event = IB_EVENT_CQ_ERR;
  563. event_type = EVENT_TYPE_CQ;
  564. break;
  565. case ROCE_ASYNC_EVENT_SQ_DRAINED:
  566. event.event = IB_EVENT_SQ_DRAINED;
  567. event_type = EVENT_TYPE_QP;
  568. break;
  569. case ROCE_ASYNC_EVENT_QP_CATASTROPHIC_ERR:
  570. event.event = IB_EVENT_QP_FATAL;
  571. event_type = EVENT_TYPE_QP;
  572. break;
  573. case ROCE_ASYNC_EVENT_LOCAL_INVALID_REQUEST_ERR:
  574. event.event = IB_EVENT_QP_REQ_ERR;
  575. event_type = EVENT_TYPE_QP;
  576. break;
  577. case ROCE_ASYNC_EVENT_LOCAL_ACCESS_ERR:
  578. event.event = IB_EVENT_QP_ACCESS_ERR;
  579. event_type = EVENT_TYPE_QP;
  580. break;
  581. case ROCE_ASYNC_EVENT_SRQ_LIMIT:
  582. event.event = IB_EVENT_SRQ_LIMIT_REACHED;
  583. event_type = EVENT_TYPE_SRQ;
  584. break;
  585. case ROCE_ASYNC_EVENT_SRQ_EMPTY:
  586. event.event = IB_EVENT_SRQ_ERR;
  587. event_type = EVENT_TYPE_SRQ;
  588. break;
  589. default:
  590. DP_ERR(dev, "unsupported event %d on handle=%llx\n",
  591. e_code, roce_handle64);
  592. }
  593. } else {
  594. switch (e_code) {
  595. case QED_IWARP_EVENT_SRQ_LIMIT:
  596. event.event = IB_EVENT_SRQ_LIMIT_REACHED;
  597. event_type = EVENT_TYPE_SRQ;
  598. break;
  599. case QED_IWARP_EVENT_SRQ_EMPTY:
  600. event.event = IB_EVENT_SRQ_ERR;
  601. event_type = EVENT_TYPE_SRQ;
  602. break;
  603. default:
  604. DP_ERR(dev, "unsupported event %d on handle=%llx\n", e_code,
  605. roce_handle64);
  606. }
  607. }
  608. switch (event_type) {
  609. case EVENT_TYPE_CQ:
  610. cq = (struct qedr_cq *)(uintptr_t)roce_handle64;
  611. if (cq) {
  612. ibcq = &cq->ibcq;
  613. if (ibcq->event_handler) {
  614. event.device = ibcq->device;
  615. event.element.cq = ibcq;
  616. ibcq->event_handler(&event, ibcq->cq_context);
  617. }
  618. } else {
  619. WARN(1,
  620. "Error: CQ event with NULL pointer ibcq. Handle=%llx\n",
  621. roce_handle64);
  622. }
  623. DP_ERR(dev, "CQ event %d on handle %p\n", e_code, cq);
  624. break;
  625. case EVENT_TYPE_QP:
  626. qp = (struct qedr_qp *)(uintptr_t)roce_handle64;
  627. if (qp) {
  628. ibqp = &qp->ibqp;
  629. if (ibqp->event_handler) {
  630. event.device = ibqp->device;
  631. event.element.qp = ibqp;
  632. ibqp->event_handler(&event, ibqp->qp_context);
  633. }
  634. } else {
  635. WARN(1,
  636. "Error: QP event with NULL pointer ibqp. Handle=%llx\n",
  637. roce_handle64);
  638. }
  639. DP_ERR(dev, "QP event %d on handle %p\n", e_code, qp);
  640. break;
  641. case EVENT_TYPE_SRQ:
  642. srq_id = (u16)roce_handle64;
  643. spin_lock_irqsave(&dev->srqidr.idr_lock, flags);
  644. srq = idr_find(&dev->srqidr.idr, srq_id);
  645. if (srq) {
  646. ibsrq = &srq->ibsrq;
  647. if (ibsrq->event_handler) {
  648. event.device = ibsrq->device;
  649. event.element.srq = ibsrq;
  650. ibsrq->event_handler(&event,
  651. ibsrq->srq_context);
  652. }
  653. } else {
  654. DP_NOTICE(dev,
  655. "SRQ event with NULL pointer ibsrq. Handle=%llx\n",
  656. roce_handle64);
  657. }
  658. spin_unlock_irqrestore(&dev->srqidr.idr_lock, flags);
  659. DP_NOTICE(dev, "SRQ event %d on handle %p\n", e_code, srq);
  660. default:
  661. break;
  662. }
  663. }
  664. static int qedr_init_hw(struct qedr_dev *dev)
  665. {
  666. struct qed_rdma_add_user_out_params out_params;
  667. struct qed_rdma_start_in_params *in_params;
  668. struct qed_rdma_cnq_params *cur_pbl;
  669. struct qed_rdma_events events;
  670. dma_addr_t p_phys_table;
  671. u32 page_cnt;
  672. int rc = 0;
  673. int i;
  674. in_params = kzalloc(sizeof(*in_params), GFP_KERNEL);
  675. if (!in_params) {
  676. rc = -ENOMEM;
  677. goto out;
  678. }
  679. in_params->desired_cnq = dev->num_cnq;
  680. for (i = 0; i < dev->num_cnq; i++) {
  681. cur_pbl = &in_params->cnq_pbl_list[i];
  682. page_cnt = qed_chain_get_page_cnt(&dev->cnq_array[i].pbl);
  683. cur_pbl->num_pbl_pages = page_cnt;
  684. p_phys_table = qed_chain_get_pbl_phys(&dev->cnq_array[i].pbl);
  685. cur_pbl->pbl_ptr = (u64)p_phys_table;
  686. }
  687. events.affiliated_event = qedr_affiliated_event;
  688. events.unaffiliated_event = qedr_unaffiliated_event;
  689. events.context = dev;
  690. in_params->events = &events;
  691. in_params->cq_mode = QED_RDMA_CQ_MODE_32_BITS;
  692. in_params->max_mtu = dev->ndev->mtu;
  693. dev->iwarp_max_mtu = dev->ndev->mtu;
  694. ether_addr_copy(&in_params->mac_addr[0], dev->ndev->dev_addr);
  695. rc = dev->ops->rdma_init(dev->cdev, in_params);
  696. if (rc)
  697. goto out;
  698. rc = dev->ops->rdma_add_user(dev->rdma_ctx, &out_params);
  699. if (rc)
  700. goto out;
  701. dev->db_addr = (void __iomem *)(uintptr_t)out_params.dpi_addr;
  702. dev->db_phys_addr = out_params.dpi_phys_addr;
  703. dev->db_size = out_params.dpi_size;
  704. dev->dpi = out_params.dpi;
  705. rc = qedr_set_device_attr(dev);
  706. out:
  707. kfree(in_params);
  708. if (rc)
  709. DP_ERR(dev, "Init HW Failed rc = %d\n", rc);
  710. return rc;
  711. }
  712. static void qedr_stop_hw(struct qedr_dev *dev)
  713. {
  714. dev->ops->rdma_remove_user(dev->rdma_ctx, dev->dpi);
  715. dev->ops->rdma_stop(dev->rdma_ctx);
  716. }
  717. static struct qedr_dev *qedr_add(struct qed_dev *cdev, struct pci_dev *pdev,
  718. struct net_device *ndev)
  719. {
  720. struct qed_dev_rdma_info dev_info;
  721. struct qedr_dev *dev;
  722. int rc = 0;
  723. dev = (struct qedr_dev *)ib_alloc_device(sizeof(*dev));
  724. if (!dev) {
  725. pr_err("Unable to allocate ib device\n");
  726. return NULL;
  727. }
  728. DP_DEBUG(dev, QEDR_MSG_INIT, "qedr add device called\n");
  729. dev->pdev = pdev;
  730. dev->ndev = ndev;
  731. dev->cdev = cdev;
  732. qed_ops = qed_get_rdma_ops();
  733. if (!qed_ops) {
  734. DP_ERR(dev, "Failed to get qed roce operations\n");
  735. goto init_err;
  736. }
  737. dev->ops = qed_ops;
  738. rc = qed_ops->fill_dev_info(cdev, &dev_info);
  739. if (rc)
  740. goto init_err;
  741. dev->user_dpm_enabled = dev_info.user_dpm_enabled;
  742. dev->rdma_type = dev_info.rdma_type;
  743. dev->num_hwfns = dev_info.common.num_hwfns;
  744. dev->rdma_ctx = dev->ops->rdma_get_rdma_ctx(cdev);
  745. dev->num_cnq = dev->ops->rdma_get_min_cnq_msix(cdev);
  746. if (!dev->num_cnq) {
  747. DP_ERR(dev, "Failed. At least one CNQ is required.\n");
  748. rc = -ENOMEM;
  749. goto init_err;
  750. }
  751. dev->wq_multiplier = QEDR_WQ_MULTIPLIER_DFT;
  752. qedr_pci_set_atomic(dev, pdev);
  753. rc = qedr_alloc_resources(dev);
  754. if (rc)
  755. goto init_err;
  756. rc = qedr_init_hw(dev);
  757. if (rc)
  758. goto alloc_err;
  759. rc = qedr_setup_irqs(dev);
  760. if (rc)
  761. goto irq_err;
  762. rc = qedr_register_device(dev);
  763. if (rc) {
  764. DP_ERR(dev, "Unable to allocate register device\n");
  765. goto reg_err;
  766. }
  767. if (!test_and_set_bit(QEDR_ENET_STATE_BIT, &dev->enet_state))
  768. qedr_ib_dispatch_event(dev, QEDR_PORT, IB_EVENT_PORT_ACTIVE);
  769. DP_DEBUG(dev, QEDR_MSG_INIT, "qedr driver loaded successfully\n");
  770. return dev;
  771. reg_err:
  772. qedr_sync_free_irqs(dev);
  773. irq_err:
  774. qedr_stop_hw(dev);
  775. alloc_err:
  776. qedr_free_resources(dev);
  777. init_err:
  778. ib_dealloc_device(&dev->ibdev);
  779. DP_ERR(dev, "qedr driver load failed rc=%d\n", rc);
  780. return NULL;
  781. }
  782. static void qedr_remove(struct qedr_dev *dev)
  783. {
  784. /* First unregister with stack to stop all the active traffic
  785. * of the registered clients.
  786. */
  787. ib_unregister_device(&dev->ibdev);
  788. qedr_stop_hw(dev);
  789. qedr_sync_free_irqs(dev);
  790. qedr_free_resources(dev);
  791. ib_dealloc_device(&dev->ibdev);
  792. }
  793. static void qedr_close(struct qedr_dev *dev)
  794. {
  795. if (test_and_clear_bit(QEDR_ENET_STATE_BIT, &dev->enet_state))
  796. qedr_ib_dispatch_event(dev, QEDR_PORT, IB_EVENT_PORT_ERR);
  797. }
  798. static void qedr_shutdown(struct qedr_dev *dev)
  799. {
  800. qedr_close(dev);
  801. qedr_remove(dev);
  802. }
  803. static void qedr_open(struct qedr_dev *dev)
  804. {
  805. if (!test_and_set_bit(QEDR_ENET_STATE_BIT, &dev->enet_state))
  806. qedr_ib_dispatch_event(dev, QEDR_PORT, IB_EVENT_PORT_ACTIVE);
  807. }
  808. static void qedr_mac_address_change(struct qedr_dev *dev)
  809. {
  810. union ib_gid *sgid = &dev->sgid_tbl[0];
  811. u8 guid[8], mac_addr[6];
  812. int rc;
  813. /* Update SGID */
  814. ether_addr_copy(&mac_addr[0], dev->ndev->dev_addr);
  815. guid[0] = mac_addr[0] ^ 2;
  816. guid[1] = mac_addr[1];
  817. guid[2] = mac_addr[2];
  818. guid[3] = 0xff;
  819. guid[4] = 0xfe;
  820. guid[5] = mac_addr[3];
  821. guid[6] = mac_addr[4];
  822. guid[7] = mac_addr[5];
  823. sgid->global.subnet_prefix = cpu_to_be64(0xfe80000000000000LL);
  824. memcpy(&sgid->raw[8], guid, sizeof(guid));
  825. /* Update LL2 */
  826. rc = dev->ops->ll2_set_mac_filter(dev->cdev,
  827. dev->gsi_ll2_mac_address,
  828. dev->ndev->dev_addr);
  829. ether_addr_copy(dev->gsi_ll2_mac_address, dev->ndev->dev_addr);
  830. qedr_ib_dispatch_event(dev, QEDR_PORT, IB_EVENT_GID_CHANGE);
  831. if (rc)
  832. DP_ERR(dev, "Error updating mac filter\n");
  833. }
  834. /* event handling via NIC driver ensures that all the NIC specific
  835. * initialization done before RoCE driver notifies
  836. * event to stack.
  837. */
  838. static void qedr_notify(struct qedr_dev *dev, enum qede_rdma_event event)
  839. {
  840. switch (event) {
  841. case QEDE_UP:
  842. qedr_open(dev);
  843. break;
  844. case QEDE_DOWN:
  845. qedr_close(dev);
  846. break;
  847. case QEDE_CLOSE:
  848. qedr_shutdown(dev);
  849. break;
  850. case QEDE_CHANGE_ADDR:
  851. qedr_mac_address_change(dev);
  852. break;
  853. default:
  854. pr_err("Event not supported\n");
  855. }
  856. }
  857. static struct qedr_driver qedr_drv = {
  858. .name = "qedr_driver",
  859. .add = qedr_add,
  860. .remove = qedr_remove,
  861. .notify = qedr_notify,
  862. };
  863. static int __init qedr_init_module(void)
  864. {
  865. return qede_rdma_register_driver(&qedr_drv);
  866. }
  867. static void __exit qedr_exit_module(void)
  868. {
  869. qede_rdma_unregister_driver(&qedr_drv);
  870. }
  871. module_init(qedr_init_module);
  872. module_exit(qedr_exit_module);