cq.c 34 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391
  1. /*
  2. * Copyright (c) 2013-2015, Mellanox Technologies. 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. * 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/kref.h>
  33. #include <rdma/ib_umem.h>
  34. #include <rdma/ib_user_verbs.h>
  35. #include <rdma/ib_cache.h>
  36. #include "mlx5_ib.h"
  37. #include "user.h"
  38. static void mlx5_ib_cq_comp(struct mlx5_core_cq *cq)
  39. {
  40. struct ib_cq *ibcq = &to_mibcq(cq)->ibcq;
  41. ibcq->comp_handler(ibcq, ibcq->cq_context);
  42. }
  43. static void mlx5_ib_cq_event(struct mlx5_core_cq *mcq, enum mlx5_event type)
  44. {
  45. struct mlx5_ib_cq *cq = container_of(mcq, struct mlx5_ib_cq, mcq);
  46. struct mlx5_ib_dev *dev = to_mdev(cq->ibcq.device);
  47. struct ib_cq *ibcq = &cq->ibcq;
  48. struct ib_event event;
  49. if (type != MLX5_EVENT_TYPE_CQ_ERROR) {
  50. mlx5_ib_warn(dev, "Unexpected event type %d on CQ %06x\n",
  51. type, mcq->cqn);
  52. return;
  53. }
  54. if (ibcq->event_handler) {
  55. event.device = &dev->ib_dev;
  56. event.event = IB_EVENT_CQ_ERR;
  57. event.element.cq = ibcq;
  58. ibcq->event_handler(&event, ibcq->cq_context);
  59. }
  60. }
  61. static void *get_cqe_from_buf(struct mlx5_ib_cq_buf *buf, int n, int size)
  62. {
  63. return mlx5_buf_offset(&buf->buf, n * size);
  64. }
  65. static void *get_cqe(struct mlx5_ib_cq *cq, int n)
  66. {
  67. return get_cqe_from_buf(&cq->buf, n, cq->mcq.cqe_sz);
  68. }
  69. static u8 sw_ownership_bit(int n, int nent)
  70. {
  71. return (n & nent) ? 1 : 0;
  72. }
  73. static void *get_sw_cqe(struct mlx5_ib_cq *cq, int n)
  74. {
  75. void *cqe = get_cqe(cq, n & cq->ibcq.cqe);
  76. struct mlx5_cqe64 *cqe64;
  77. cqe64 = (cq->mcq.cqe_sz == 64) ? cqe : cqe + 64;
  78. if (likely((cqe64->op_own) >> 4 != MLX5_CQE_INVALID) &&
  79. !((cqe64->op_own & MLX5_CQE_OWNER_MASK) ^ !!(n & (cq->ibcq.cqe + 1)))) {
  80. return cqe;
  81. } else {
  82. return NULL;
  83. }
  84. }
  85. static void *next_cqe_sw(struct mlx5_ib_cq *cq)
  86. {
  87. return get_sw_cqe(cq, cq->mcq.cons_index);
  88. }
  89. static enum ib_wc_opcode get_umr_comp(struct mlx5_ib_wq *wq, int idx)
  90. {
  91. switch (wq->wr_data[idx]) {
  92. case MLX5_IB_WR_UMR:
  93. return 0;
  94. case IB_WR_LOCAL_INV:
  95. return IB_WC_LOCAL_INV;
  96. case IB_WR_REG_MR:
  97. return IB_WC_REG_MR;
  98. default:
  99. pr_warn("unknown completion status\n");
  100. return 0;
  101. }
  102. }
  103. static void handle_good_req(struct ib_wc *wc, struct mlx5_cqe64 *cqe,
  104. struct mlx5_ib_wq *wq, int idx)
  105. {
  106. wc->wc_flags = 0;
  107. switch (be32_to_cpu(cqe->sop_drop_qpn) >> 24) {
  108. case MLX5_OPCODE_RDMA_WRITE_IMM:
  109. wc->wc_flags |= IB_WC_WITH_IMM;
  110. case MLX5_OPCODE_RDMA_WRITE:
  111. wc->opcode = IB_WC_RDMA_WRITE;
  112. break;
  113. case MLX5_OPCODE_SEND_IMM:
  114. wc->wc_flags |= IB_WC_WITH_IMM;
  115. case MLX5_OPCODE_SEND:
  116. case MLX5_OPCODE_SEND_INVAL:
  117. wc->opcode = IB_WC_SEND;
  118. break;
  119. case MLX5_OPCODE_RDMA_READ:
  120. wc->opcode = IB_WC_RDMA_READ;
  121. wc->byte_len = be32_to_cpu(cqe->byte_cnt);
  122. break;
  123. case MLX5_OPCODE_ATOMIC_CS:
  124. wc->opcode = IB_WC_COMP_SWAP;
  125. wc->byte_len = 8;
  126. break;
  127. case MLX5_OPCODE_ATOMIC_FA:
  128. wc->opcode = IB_WC_FETCH_ADD;
  129. wc->byte_len = 8;
  130. break;
  131. case MLX5_OPCODE_ATOMIC_MASKED_CS:
  132. wc->opcode = IB_WC_MASKED_COMP_SWAP;
  133. wc->byte_len = 8;
  134. break;
  135. case MLX5_OPCODE_ATOMIC_MASKED_FA:
  136. wc->opcode = IB_WC_MASKED_FETCH_ADD;
  137. wc->byte_len = 8;
  138. break;
  139. case MLX5_OPCODE_UMR:
  140. wc->opcode = get_umr_comp(wq, idx);
  141. break;
  142. }
  143. }
  144. enum {
  145. MLX5_GRH_IN_BUFFER = 1,
  146. MLX5_GRH_IN_CQE = 2,
  147. };
  148. static void handle_responder(struct ib_wc *wc, struct mlx5_cqe64 *cqe,
  149. struct mlx5_ib_qp *qp)
  150. {
  151. enum rdma_link_layer ll = rdma_port_get_link_layer(qp->ibqp.device, 1);
  152. struct mlx5_ib_dev *dev = to_mdev(qp->ibqp.device);
  153. struct mlx5_ib_srq *srq;
  154. struct mlx5_ib_wq *wq;
  155. u16 wqe_ctr;
  156. u8 g;
  157. if (qp->ibqp.srq || qp->ibqp.xrcd) {
  158. struct mlx5_core_srq *msrq = NULL;
  159. if (qp->ibqp.xrcd) {
  160. msrq = mlx5_core_get_srq(dev->mdev,
  161. be32_to_cpu(cqe->srqn));
  162. srq = to_mibsrq(msrq);
  163. } else {
  164. srq = to_msrq(qp->ibqp.srq);
  165. }
  166. if (srq) {
  167. wqe_ctr = be16_to_cpu(cqe->wqe_counter);
  168. wc->wr_id = srq->wrid[wqe_ctr];
  169. mlx5_ib_free_srq_wqe(srq, wqe_ctr);
  170. if (msrq && atomic_dec_and_test(&msrq->refcount))
  171. complete(&msrq->free);
  172. }
  173. } else {
  174. wq = &qp->rq;
  175. wc->wr_id = wq->wrid[wq->tail & (wq->wqe_cnt - 1)];
  176. ++wq->tail;
  177. }
  178. wc->byte_len = be32_to_cpu(cqe->byte_cnt);
  179. switch (cqe->op_own >> 4) {
  180. case MLX5_CQE_RESP_WR_IMM:
  181. wc->opcode = IB_WC_RECV_RDMA_WITH_IMM;
  182. wc->wc_flags = IB_WC_WITH_IMM;
  183. wc->ex.imm_data = cqe->imm_inval_pkey;
  184. break;
  185. case MLX5_CQE_RESP_SEND:
  186. wc->opcode = IB_WC_RECV;
  187. wc->wc_flags = IB_WC_IP_CSUM_OK;
  188. if (unlikely(!((cqe->hds_ip_ext & CQE_L3_OK) &&
  189. (cqe->hds_ip_ext & CQE_L4_OK))))
  190. wc->wc_flags = 0;
  191. break;
  192. case MLX5_CQE_RESP_SEND_IMM:
  193. wc->opcode = IB_WC_RECV;
  194. wc->wc_flags = IB_WC_WITH_IMM;
  195. wc->ex.imm_data = cqe->imm_inval_pkey;
  196. break;
  197. case MLX5_CQE_RESP_SEND_INV:
  198. wc->opcode = IB_WC_RECV;
  199. wc->wc_flags = IB_WC_WITH_INVALIDATE;
  200. wc->ex.invalidate_rkey = be32_to_cpu(cqe->imm_inval_pkey);
  201. break;
  202. }
  203. wc->slid = be16_to_cpu(cqe->slid);
  204. wc->sl = (be32_to_cpu(cqe->flags_rqpn) >> 24) & 0xf;
  205. wc->src_qp = be32_to_cpu(cqe->flags_rqpn) & 0xffffff;
  206. wc->dlid_path_bits = cqe->ml_path;
  207. g = (be32_to_cpu(cqe->flags_rqpn) >> 28) & 3;
  208. wc->wc_flags |= g ? IB_WC_GRH : 0;
  209. if (unlikely(is_qp1(qp->ibqp.qp_type))) {
  210. u16 pkey = be32_to_cpu(cqe->imm_inval_pkey) & 0xffff;
  211. ib_find_cached_pkey(&dev->ib_dev, qp->port, pkey,
  212. &wc->pkey_index);
  213. } else {
  214. wc->pkey_index = 0;
  215. }
  216. if (ll != IB_LINK_LAYER_ETHERNET)
  217. return;
  218. switch (wc->sl & 0x3) {
  219. case MLX5_CQE_ROCE_L3_HEADER_TYPE_GRH:
  220. wc->network_hdr_type = RDMA_NETWORK_IB;
  221. break;
  222. case MLX5_CQE_ROCE_L3_HEADER_TYPE_IPV6:
  223. wc->network_hdr_type = RDMA_NETWORK_IPV6;
  224. break;
  225. case MLX5_CQE_ROCE_L3_HEADER_TYPE_IPV4:
  226. wc->network_hdr_type = RDMA_NETWORK_IPV4;
  227. break;
  228. }
  229. wc->wc_flags |= IB_WC_WITH_NETWORK_HDR_TYPE;
  230. }
  231. static void dump_cqe(struct mlx5_ib_dev *dev, struct mlx5_err_cqe *cqe)
  232. {
  233. __be32 *p = (__be32 *)cqe;
  234. int i;
  235. mlx5_ib_warn(dev, "dump error cqe\n");
  236. for (i = 0; i < sizeof(*cqe) / 16; i++, p += 4)
  237. pr_info("%08x %08x %08x %08x\n", be32_to_cpu(p[0]),
  238. be32_to_cpu(p[1]), be32_to_cpu(p[2]),
  239. be32_to_cpu(p[3]));
  240. }
  241. static void mlx5_handle_error_cqe(struct mlx5_ib_dev *dev,
  242. struct mlx5_err_cqe *cqe,
  243. struct ib_wc *wc)
  244. {
  245. int dump = 1;
  246. switch (cqe->syndrome) {
  247. case MLX5_CQE_SYNDROME_LOCAL_LENGTH_ERR:
  248. wc->status = IB_WC_LOC_LEN_ERR;
  249. break;
  250. case MLX5_CQE_SYNDROME_LOCAL_QP_OP_ERR:
  251. wc->status = IB_WC_LOC_QP_OP_ERR;
  252. break;
  253. case MLX5_CQE_SYNDROME_LOCAL_PROT_ERR:
  254. wc->status = IB_WC_LOC_PROT_ERR;
  255. break;
  256. case MLX5_CQE_SYNDROME_WR_FLUSH_ERR:
  257. dump = 0;
  258. wc->status = IB_WC_WR_FLUSH_ERR;
  259. break;
  260. case MLX5_CQE_SYNDROME_MW_BIND_ERR:
  261. wc->status = IB_WC_MW_BIND_ERR;
  262. break;
  263. case MLX5_CQE_SYNDROME_BAD_RESP_ERR:
  264. wc->status = IB_WC_BAD_RESP_ERR;
  265. break;
  266. case MLX5_CQE_SYNDROME_LOCAL_ACCESS_ERR:
  267. wc->status = IB_WC_LOC_ACCESS_ERR;
  268. break;
  269. case MLX5_CQE_SYNDROME_REMOTE_INVAL_REQ_ERR:
  270. wc->status = IB_WC_REM_INV_REQ_ERR;
  271. break;
  272. case MLX5_CQE_SYNDROME_REMOTE_ACCESS_ERR:
  273. wc->status = IB_WC_REM_ACCESS_ERR;
  274. break;
  275. case MLX5_CQE_SYNDROME_REMOTE_OP_ERR:
  276. wc->status = IB_WC_REM_OP_ERR;
  277. break;
  278. case MLX5_CQE_SYNDROME_TRANSPORT_RETRY_EXC_ERR:
  279. wc->status = IB_WC_RETRY_EXC_ERR;
  280. dump = 0;
  281. break;
  282. case MLX5_CQE_SYNDROME_RNR_RETRY_EXC_ERR:
  283. wc->status = IB_WC_RNR_RETRY_EXC_ERR;
  284. dump = 0;
  285. break;
  286. case MLX5_CQE_SYNDROME_REMOTE_ABORTED_ERR:
  287. wc->status = IB_WC_REM_ABORT_ERR;
  288. break;
  289. default:
  290. wc->status = IB_WC_GENERAL_ERR;
  291. break;
  292. }
  293. wc->vendor_err = cqe->vendor_err_synd;
  294. if (dump)
  295. dump_cqe(dev, cqe);
  296. }
  297. static int is_atomic_response(struct mlx5_ib_qp *qp, uint16_t idx)
  298. {
  299. /* TBD: waiting decision
  300. */
  301. return 0;
  302. }
  303. static void *mlx5_get_atomic_laddr(struct mlx5_ib_qp *qp, uint16_t idx)
  304. {
  305. struct mlx5_wqe_data_seg *dpseg;
  306. void *addr;
  307. dpseg = mlx5_get_send_wqe(qp, idx) + sizeof(struct mlx5_wqe_ctrl_seg) +
  308. sizeof(struct mlx5_wqe_raddr_seg) +
  309. sizeof(struct mlx5_wqe_atomic_seg);
  310. addr = (void *)(unsigned long)be64_to_cpu(dpseg->addr);
  311. return addr;
  312. }
  313. static void handle_atomic(struct mlx5_ib_qp *qp, struct mlx5_cqe64 *cqe64,
  314. uint16_t idx)
  315. {
  316. void *addr;
  317. int byte_count;
  318. int i;
  319. if (!is_atomic_response(qp, idx))
  320. return;
  321. byte_count = be32_to_cpu(cqe64->byte_cnt);
  322. addr = mlx5_get_atomic_laddr(qp, idx);
  323. if (byte_count == 4) {
  324. *(uint32_t *)addr = be32_to_cpu(*((__be32 *)addr));
  325. } else {
  326. for (i = 0; i < byte_count; i += 8) {
  327. *(uint64_t *)addr = be64_to_cpu(*((__be64 *)addr));
  328. addr += 8;
  329. }
  330. }
  331. return;
  332. }
  333. static void handle_atomics(struct mlx5_ib_qp *qp, struct mlx5_cqe64 *cqe64,
  334. u16 tail, u16 head)
  335. {
  336. u16 idx;
  337. do {
  338. idx = tail & (qp->sq.wqe_cnt - 1);
  339. handle_atomic(qp, cqe64, idx);
  340. if (idx == head)
  341. break;
  342. tail = qp->sq.w_list[idx].next;
  343. } while (1);
  344. tail = qp->sq.w_list[idx].next;
  345. qp->sq.last_poll = tail;
  346. }
  347. static void free_cq_buf(struct mlx5_ib_dev *dev, struct mlx5_ib_cq_buf *buf)
  348. {
  349. mlx5_buf_free(dev->mdev, &buf->buf);
  350. }
  351. static void get_sig_err_item(struct mlx5_sig_err_cqe *cqe,
  352. struct ib_sig_err *item)
  353. {
  354. u16 syndrome = be16_to_cpu(cqe->syndrome);
  355. #define GUARD_ERR (1 << 13)
  356. #define APPTAG_ERR (1 << 12)
  357. #define REFTAG_ERR (1 << 11)
  358. if (syndrome & GUARD_ERR) {
  359. item->err_type = IB_SIG_BAD_GUARD;
  360. item->expected = be32_to_cpu(cqe->expected_trans_sig) >> 16;
  361. item->actual = be32_to_cpu(cqe->actual_trans_sig) >> 16;
  362. } else
  363. if (syndrome & REFTAG_ERR) {
  364. item->err_type = IB_SIG_BAD_REFTAG;
  365. item->expected = be32_to_cpu(cqe->expected_reftag);
  366. item->actual = be32_to_cpu(cqe->actual_reftag);
  367. } else
  368. if (syndrome & APPTAG_ERR) {
  369. item->err_type = IB_SIG_BAD_APPTAG;
  370. item->expected = be32_to_cpu(cqe->expected_trans_sig) & 0xffff;
  371. item->actual = be32_to_cpu(cqe->actual_trans_sig) & 0xffff;
  372. } else {
  373. pr_err("Got signature completion error with bad syndrome %04x\n",
  374. syndrome);
  375. }
  376. item->sig_err_offset = be64_to_cpu(cqe->err_offset);
  377. item->key = be32_to_cpu(cqe->mkey);
  378. }
  379. static void sw_send_comp(struct mlx5_ib_qp *qp, int num_entries,
  380. struct ib_wc *wc, int *npolled)
  381. {
  382. struct mlx5_ib_wq *wq;
  383. unsigned int cur;
  384. unsigned int idx;
  385. int np;
  386. int i;
  387. wq = &qp->sq;
  388. cur = wq->head - wq->tail;
  389. np = *npolled;
  390. if (cur == 0)
  391. return;
  392. for (i = 0; i < cur && np < num_entries; i++) {
  393. idx = wq->last_poll & (wq->wqe_cnt - 1);
  394. wc->wr_id = wq->wrid[idx];
  395. wc->status = IB_WC_WR_FLUSH_ERR;
  396. wc->vendor_err = MLX5_CQE_SYNDROME_WR_FLUSH_ERR;
  397. wq->tail++;
  398. np++;
  399. wc->qp = &qp->ibqp;
  400. wc++;
  401. wq->last_poll = wq->w_list[idx].next;
  402. }
  403. *npolled = np;
  404. }
  405. static void sw_recv_comp(struct mlx5_ib_qp *qp, int num_entries,
  406. struct ib_wc *wc, int *npolled)
  407. {
  408. struct mlx5_ib_wq *wq;
  409. unsigned int cur;
  410. int np;
  411. int i;
  412. wq = &qp->rq;
  413. cur = wq->head - wq->tail;
  414. np = *npolled;
  415. if (cur == 0)
  416. return;
  417. for (i = 0; i < cur && np < num_entries; i++) {
  418. wc->wr_id = wq->wrid[wq->tail & (wq->wqe_cnt - 1)];
  419. wc->status = IB_WC_WR_FLUSH_ERR;
  420. wc->vendor_err = MLX5_CQE_SYNDROME_WR_FLUSH_ERR;
  421. wq->tail++;
  422. np++;
  423. wc->qp = &qp->ibqp;
  424. wc++;
  425. }
  426. *npolled = np;
  427. }
  428. static void mlx5_ib_poll_sw_comp(struct mlx5_ib_cq *cq, int num_entries,
  429. struct ib_wc *wc, int *npolled)
  430. {
  431. struct mlx5_ib_qp *qp;
  432. *npolled = 0;
  433. /* Find uncompleted WQEs belonging to that cq and retrun mmics ones */
  434. list_for_each_entry(qp, &cq->list_send_qp, cq_send_list) {
  435. sw_send_comp(qp, num_entries, wc + *npolled, npolled);
  436. if (*npolled >= num_entries)
  437. return;
  438. }
  439. list_for_each_entry(qp, &cq->list_recv_qp, cq_recv_list) {
  440. sw_recv_comp(qp, num_entries, wc + *npolled, npolled);
  441. if (*npolled >= num_entries)
  442. return;
  443. }
  444. }
  445. static int mlx5_poll_one(struct mlx5_ib_cq *cq,
  446. struct mlx5_ib_qp **cur_qp,
  447. struct ib_wc *wc)
  448. {
  449. struct mlx5_ib_dev *dev = to_mdev(cq->ibcq.device);
  450. struct mlx5_err_cqe *err_cqe;
  451. struct mlx5_cqe64 *cqe64;
  452. struct mlx5_core_qp *mqp;
  453. struct mlx5_ib_wq *wq;
  454. struct mlx5_sig_err_cqe *sig_err_cqe;
  455. struct mlx5_core_mkey *mmkey;
  456. struct mlx5_ib_mr *mr;
  457. uint8_t opcode;
  458. uint32_t qpn;
  459. u16 wqe_ctr;
  460. void *cqe;
  461. int idx;
  462. repoll:
  463. cqe = next_cqe_sw(cq);
  464. if (!cqe)
  465. return -EAGAIN;
  466. cqe64 = (cq->mcq.cqe_sz == 64) ? cqe : cqe + 64;
  467. ++cq->mcq.cons_index;
  468. /* Make sure we read CQ entry contents after we've checked the
  469. * ownership bit.
  470. */
  471. rmb();
  472. opcode = cqe64->op_own >> 4;
  473. if (unlikely(opcode == MLX5_CQE_RESIZE_CQ)) {
  474. if (likely(cq->resize_buf)) {
  475. free_cq_buf(dev, &cq->buf);
  476. cq->buf = *cq->resize_buf;
  477. kfree(cq->resize_buf);
  478. cq->resize_buf = NULL;
  479. goto repoll;
  480. } else {
  481. mlx5_ib_warn(dev, "unexpected resize cqe\n");
  482. }
  483. }
  484. qpn = ntohl(cqe64->sop_drop_qpn) & 0xffffff;
  485. if (!*cur_qp || (qpn != (*cur_qp)->ibqp.qp_num)) {
  486. /* We do not have to take the QP table lock here,
  487. * because CQs will be locked while QPs are removed
  488. * from the table.
  489. */
  490. mqp = __mlx5_qp_lookup(dev->mdev, qpn);
  491. if (unlikely(!mqp)) {
  492. mlx5_ib_warn(dev, "CQE@CQ %06x for unknown QPN %6x\n",
  493. cq->mcq.cqn, qpn);
  494. return -EINVAL;
  495. }
  496. *cur_qp = to_mibqp(mqp);
  497. }
  498. wc->qp = &(*cur_qp)->ibqp;
  499. switch (opcode) {
  500. case MLX5_CQE_REQ:
  501. wq = &(*cur_qp)->sq;
  502. wqe_ctr = be16_to_cpu(cqe64->wqe_counter);
  503. idx = wqe_ctr & (wq->wqe_cnt - 1);
  504. handle_good_req(wc, cqe64, wq, idx);
  505. handle_atomics(*cur_qp, cqe64, wq->last_poll, idx);
  506. wc->wr_id = wq->wrid[idx];
  507. wq->tail = wq->wqe_head[idx] + 1;
  508. wc->status = IB_WC_SUCCESS;
  509. break;
  510. case MLX5_CQE_RESP_WR_IMM:
  511. case MLX5_CQE_RESP_SEND:
  512. case MLX5_CQE_RESP_SEND_IMM:
  513. case MLX5_CQE_RESP_SEND_INV:
  514. handle_responder(wc, cqe64, *cur_qp);
  515. wc->status = IB_WC_SUCCESS;
  516. break;
  517. case MLX5_CQE_RESIZE_CQ:
  518. break;
  519. case MLX5_CQE_REQ_ERR:
  520. case MLX5_CQE_RESP_ERR:
  521. err_cqe = (struct mlx5_err_cqe *)cqe64;
  522. mlx5_handle_error_cqe(dev, err_cqe, wc);
  523. mlx5_ib_dbg(dev, "%s error cqe on cqn 0x%x:\n",
  524. opcode == MLX5_CQE_REQ_ERR ?
  525. "Requestor" : "Responder", cq->mcq.cqn);
  526. mlx5_ib_dbg(dev, "syndrome 0x%x, vendor syndrome 0x%x\n",
  527. err_cqe->syndrome, err_cqe->vendor_err_synd);
  528. if (opcode == MLX5_CQE_REQ_ERR) {
  529. wq = &(*cur_qp)->sq;
  530. wqe_ctr = be16_to_cpu(cqe64->wqe_counter);
  531. idx = wqe_ctr & (wq->wqe_cnt - 1);
  532. wc->wr_id = wq->wrid[idx];
  533. wq->tail = wq->wqe_head[idx] + 1;
  534. } else {
  535. struct mlx5_ib_srq *srq;
  536. if ((*cur_qp)->ibqp.srq) {
  537. srq = to_msrq((*cur_qp)->ibqp.srq);
  538. wqe_ctr = be16_to_cpu(cqe64->wqe_counter);
  539. wc->wr_id = srq->wrid[wqe_ctr];
  540. mlx5_ib_free_srq_wqe(srq, wqe_ctr);
  541. } else {
  542. wq = &(*cur_qp)->rq;
  543. wc->wr_id = wq->wrid[wq->tail & (wq->wqe_cnt - 1)];
  544. ++wq->tail;
  545. }
  546. }
  547. break;
  548. case MLX5_CQE_SIG_ERR:
  549. sig_err_cqe = (struct mlx5_sig_err_cqe *)cqe64;
  550. read_lock(&dev->mdev->priv.mkey_table.lock);
  551. mmkey = __mlx5_mr_lookup(dev->mdev,
  552. mlx5_base_mkey(be32_to_cpu(sig_err_cqe->mkey)));
  553. if (unlikely(!mmkey)) {
  554. read_unlock(&dev->mdev->priv.mkey_table.lock);
  555. mlx5_ib_warn(dev, "CQE@CQ %06x for unknown MR %6x\n",
  556. cq->mcq.cqn, be32_to_cpu(sig_err_cqe->mkey));
  557. return -EINVAL;
  558. }
  559. mr = to_mibmr(mmkey);
  560. get_sig_err_item(sig_err_cqe, &mr->sig->err_item);
  561. mr->sig->sig_err_exists = true;
  562. mr->sig->sigerr_count++;
  563. mlx5_ib_warn(dev, "CQN: 0x%x Got SIGERR on key: 0x%x err_type %x err_offset %llx expected %x actual %x\n",
  564. cq->mcq.cqn, mr->sig->err_item.key,
  565. mr->sig->err_item.err_type,
  566. mr->sig->err_item.sig_err_offset,
  567. mr->sig->err_item.expected,
  568. mr->sig->err_item.actual);
  569. read_unlock(&dev->mdev->priv.mkey_table.lock);
  570. goto repoll;
  571. }
  572. return 0;
  573. }
  574. static int poll_soft_wc(struct mlx5_ib_cq *cq, int num_entries,
  575. struct ib_wc *wc)
  576. {
  577. struct mlx5_ib_dev *dev = to_mdev(cq->ibcq.device);
  578. struct mlx5_ib_wc *soft_wc, *next;
  579. int npolled = 0;
  580. list_for_each_entry_safe(soft_wc, next, &cq->wc_list, list) {
  581. if (npolled >= num_entries)
  582. break;
  583. mlx5_ib_dbg(dev, "polled software generated completion on CQ 0x%x\n",
  584. cq->mcq.cqn);
  585. wc[npolled++] = soft_wc->wc;
  586. list_del(&soft_wc->list);
  587. kfree(soft_wc);
  588. }
  589. return npolled;
  590. }
  591. int mlx5_ib_poll_cq(struct ib_cq *ibcq, int num_entries, struct ib_wc *wc)
  592. {
  593. struct mlx5_ib_cq *cq = to_mcq(ibcq);
  594. struct mlx5_ib_qp *cur_qp = NULL;
  595. struct mlx5_ib_dev *dev = to_mdev(cq->ibcq.device);
  596. struct mlx5_core_dev *mdev = dev->mdev;
  597. unsigned long flags;
  598. int soft_polled = 0;
  599. int npolled;
  600. int err = 0;
  601. spin_lock_irqsave(&cq->lock, flags);
  602. if (mdev->state == MLX5_DEVICE_STATE_INTERNAL_ERROR) {
  603. mlx5_ib_poll_sw_comp(cq, num_entries, wc, &npolled);
  604. goto out;
  605. }
  606. if (unlikely(!list_empty(&cq->wc_list)))
  607. soft_polled = poll_soft_wc(cq, num_entries, wc);
  608. for (npolled = 0; npolled < num_entries - soft_polled; npolled++) {
  609. err = mlx5_poll_one(cq, &cur_qp, wc + soft_polled + npolled);
  610. if (err)
  611. break;
  612. }
  613. if (npolled)
  614. mlx5_cq_set_ci(&cq->mcq);
  615. out:
  616. spin_unlock_irqrestore(&cq->lock, flags);
  617. if (err == 0 || err == -EAGAIN)
  618. return soft_polled + npolled;
  619. else
  620. return err;
  621. }
  622. int mlx5_ib_arm_cq(struct ib_cq *ibcq, enum ib_cq_notify_flags flags)
  623. {
  624. struct mlx5_core_dev *mdev = to_mdev(ibcq->device)->mdev;
  625. struct mlx5_ib_cq *cq = to_mcq(ibcq);
  626. void __iomem *uar_page = mdev->priv.uuari.uars[0].map;
  627. unsigned long irq_flags;
  628. int ret = 0;
  629. spin_lock_irqsave(&cq->lock, irq_flags);
  630. if (cq->notify_flags != IB_CQ_NEXT_COMP)
  631. cq->notify_flags = flags & IB_CQ_SOLICITED_MASK;
  632. if ((flags & IB_CQ_REPORT_MISSED_EVENTS) && !list_empty(&cq->wc_list))
  633. ret = 1;
  634. spin_unlock_irqrestore(&cq->lock, irq_flags);
  635. mlx5_cq_arm(&cq->mcq,
  636. (flags & IB_CQ_SOLICITED_MASK) == IB_CQ_SOLICITED ?
  637. MLX5_CQ_DB_REQ_NOT_SOL : MLX5_CQ_DB_REQ_NOT,
  638. uar_page,
  639. MLX5_GET_DOORBELL_LOCK(&mdev->priv.cq_uar_lock),
  640. to_mcq(ibcq)->mcq.cons_index);
  641. return ret;
  642. }
  643. static int alloc_cq_buf(struct mlx5_ib_dev *dev, struct mlx5_ib_cq_buf *buf,
  644. int nent, int cqe_size)
  645. {
  646. int err;
  647. err = mlx5_buf_alloc(dev->mdev, nent * cqe_size, &buf->buf);
  648. if (err)
  649. return err;
  650. buf->cqe_size = cqe_size;
  651. buf->nent = nent;
  652. return 0;
  653. }
  654. static int create_cq_user(struct mlx5_ib_dev *dev, struct ib_udata *udata,
  655. struct ib_ucontext *context, struct mlx5_ib_cq *cq,
  656. int entries, struct mlx5_create_cq_mbox_in **cqb,
  657. int *cqe_size, int *index, int *inlen)
  658. {
  659. struct mlx5_ib_create_cq ucmd;
  660. size_t ucmdlen;
  661. int page_shift;
  662. int npages;
  663. int ncont;
  664. int err;
  665. ucmdlen =
  666. (udata->inlen - sizeof(struct ib_uverbs_cmd_hdr) <
  667. sizeof(ucmd)) ? (sizeof(ucmd) -
  668. sizeof(ucmd.reserved)) : sizeof(ucmd);
  669. if (ib_copy_from_udata(&ucmd, udata, ucmdlen))
  670. return -EFAULT;
  671. if (ucmdlen == sizeof(ucmd) &&
  672. ucmd.reserved != 0)
  673. return -EINVAL;
  674. if (ucmd.cqe_size != 64 && ucmd.cqe_size != 128)
  675. return -EINVAL;
  676. *cqe_size = ucmd.cqe_size;
  677. cq->buf.umem = ib_umem_get(context, ucmd.buf_addr,
  678. entries * ucmd.cqe_size,
  679. IB_ACCESS_LOCAL_WRITE, 1);
  680. if (IS_ERR(cq->buf.umem)) {
  681. err = PTR_ERR(cq->buf.umem);
  682. return err;
  683. }
  684. err = mlx5_ib_db_map_user(to_mucontext(context), ucmd.db_addr,
  685. &cq->db);
  686. if (err)
  687. goto err_umem;
  688. mlx5_ib_cont_pages(cq->buf.umem, ucmd.buf_addr, &npages, &page_shift,
  689. &ncont, NULL);
  690. mlx5_ib_dbg(dev, "addr 0x%llx, size %u, npages %d, page_shift %d, ncont %d\n",
  691. ucmd.buf_addr, entries * ucmd.cqe_size, npages, page_shift, ncont);
  692. *inlen = sizeof(**cqb) + sizeof(*(*cqb)->pas) * ncont;
  693. *cqb = mlx5_vzalloc(*inlen);
  694. if (!*cqb) {
  695. err = -ENOMEM;
  696. goto err_db;
  697. }
  698. mlx5_ib_populate_pas(dev, cq->buf.umem, page_shift, (*cqb)->pas, 0);
  699. (*cqb)->ctx.log_pg_sz = page_shift - MLX5_ADAPTER_PAGE_SHIFT;
  700. *index = to_mucontext(context)->uuari.uars[0].index;
  701. return 0;
  702. err_db:
  703. mlx5_ib_db_unmap_user(to_mucontext(context), &cq->db);
  704. err_umem:
  705. ib_umem_release(cq->buf.umem);
  706. return err;
  707. }
  708. static void destroy_cq_user(struct mlx5_ib_cq *cq, struct ib_ucontext *context)
  709. {
  710. mlx5_ib_db_unmap_user(to_mucontext(context), &cq->db);
  711. ib_umem_release(cq->buf.umem);
  712. }
  713. static void init_cq_buf(struct mlx5_ib_cq *cq, struct mlx5_ib_cq_buf *buf)
  714. {
  715. int i;
  716. void *cqe;
  717. struct mlx5_cqe64 *cqe64;
  718. for (i = 0; i < buf->nent; i++) {
  719. cqe = get_cqe_from_buf(buf, i, buf->cqe_size);
  720. cqe64 = buf->cqe_size == 64 ? cqe : cqe + 64;
  721. cqe64->op_own = MLX5_CQE_INVALID << 4;
  722. }
  723. }
  724. static int create_cq_kernel(struct mlx5_ib_dev *dev, struct mlx5_ib_cq *cq,
  725. int entries, int cqe_size,
  726. struct mlx5_create_cq_mbox_in **cqb,
  727. int *index, int *inlen)
  728. {
  729. int err;
  730. err = mlx5_db_alloc(dev->mdev, &cq->db);
  731. if (err)
  732. return err;
  733. cq->mcq.set_ci_db = cq->db.db;
  734. cq->mcq.arm_db = cq->db.db + 1;
  735. cq->mcq.cqe_sz = cqe_size;
  736. err = alloc_cq_buf(dev, &cq->buf, entries, cqe_size);
  737. if (err)
  738. goto err_db;
  739. init_cq_buf(cq, &cq->buf);
  740. *inlen = sizeof(**cqb) + sizeof(*(*cqb)->pas) * cq->buf.buf.npages;
  741. *cqb = mlx5_vzalloc(*inlen);
  742. if (!*cqb) {
  743. err = -ENOMEM;
  744. goto err_buf;
  745. }
  746. mlx5_fill_page_array(&cq->buf.buf, (*cqb)->pas);
  747. (*cqb)->ctx.log_pg_sz = cq->buf.buf.page_shift - MLX5_ADAPTER_PAGE_SHIFT;
  748. *index = dev->mdev->priv.uuari.uars[0].index;
  749. return 0;
  750. err_buf:
  751. free_cq_buf(dev, &cq->buf);
  752. err_db:
  753. mlx5_db_free(dev->mdev, &cq->db);
  754. return err;
  755. }
  756. static void destroy_cq_kernel(struct mlx5_ib_dev *dev, struct mlx5_ib_cq *cq)
  757. {
  758. free_cq_buf(dev, &cq->buf);
  759. mlx5_db_free(dev->mdev, &cq->db);
  760. }
  761. static void notify_soft_wc_handler(struct work_struct *work)
  762. {
  763. struct mlx5_ib_cq *cq = container_of(work, struct mlx5_ib_cq,
  764. notify_work);
  765. cq->ibcq.comp_handler(&cq->ibcq, cq->ibcq.cq_context);
  766. }
  767. struct ib_cq *mlx5_ib_create_cq(struct ib_device *ibdev,
  768. const struct ib_cq_init_attr *attr,
  769. struct ib_ucontext *context,
  770. struct ib_udata *udata)
  771. {
  772. int entries = attr->cqe;
  773. int vector = attr->comp_vector;
  774. struct mlx5_create_cq_mbox_in *cqb = NULL;
  775. struct mlx5_ib_dev *dev = to_mdev(ibdev);
  776. struct mlx5_ib_cq *cq;
  777. int uninitialized_var(index);
  778. int uninitialized_var(inlen);
  779. int cqe_size;
  780. unsigned int irqn;
  781. int eqn;
  782. int err;
  783. if (entries < 0 ||
  784. (entries > (1 << MLX5_CAP_GEN(dev->mdev, log_max_cq_sz))))
  785. return ERR_PTR(-EINVAL);
  786. if (check_cq_create_flags(attr->flags))
  787. return ERR_PTR(-EOPNOTSUPP);
  788. entries = roundup_pow_of_two(entries + 1);
  789. if (entries > (1 << MLX5_CAP_GEN(dev->mdev, log_max_cq_sz)))
  790. return ERR_PTR(-EINVAL);
  791. cq = kzalloc(sizeof(*cq), GFP_KERNEL);
  792. if (!cq)
  793. return ERR_PTR(-ENOMEM);
  794. cq->ibcq.cqe = entries - 1;
  795. mutex_init(&cq->resize_mutex);
  796. spin_lock_init(&cq->lock);
  797. cq->resize_buf = NULL;
  798. cq->resize_umem = NULL;
  799. cq->create_flags = attr->flags;
  800. INIT_LIST_HEAD(&cq->list_send_qp);
  801. INIT_LIST_HEAD(&cq->list_recv_qp);
  802. if (context) {
  803. err = create_cq_user(dev, udata, context, cq, entries,
  804. &cqb, &cqe_size, &index, &inlen);
  805. if (err)
  806. goto err_create;
  807. } else {
  808. /* for now choose 64 bytes till we have a proper interface */
  809. cqe_size = 64;
  810. err = create_cq_kernel(dev, cq, entries, cqe_size, &cqb,
  811. &index, &inlen);
  812. if (err)
  813. goto err_create;
  814. INIT_WORK(&cq->notify_work, notify_soft_wc_handler);
  815. }
  816. cq->cqe_size = cqe_size;
  817. cqb->ctx.cqe_sz_flags = cqe_sz_to_mlx_sz(cqe_size) << 5;
  818. if (cq->create_flags & IB_CQ_FLAGS_IGNORE_OVERRUN)
  819. cqb->ctx.cqe_sz_flags |= (1 << 1);
  820. cqb->ctx.log_sz_usr_page = cpu_to_be32((ilog2(entries) << 24) | index);
  821. err = mlx5_vector2eqn(dev->mdev, vector, &eqn, &irqn);
  822. if (err)
  823. goto err_cqb;
  824. cqb->ctx.c_eqn = cpu_to_be16(eqn);
  825. cqb->ctx.db_record_addr = cpu_to_be64(cq->db.dma);
  826. err = mlx5_core_create_cq(dev->mdev, &cq->mcq, cqb, inlen);
  827. if (err)
  828. goto err_cqb;
  829. mlx5_ib_dbg(dev, "cqn 0x%x\n", cq->mcq.cqn);
  830. cq->mcq.irqn = irqn;
  831. if (context)
  832. cq->mcq.tasklet_ctx.comp = mlx5_ib_cq_comp;
  833. else
  834. cq->mcq.comp = mlx5_ib_cq_comp;
  835. cq->mcq.event = mlx5_ib_cq_event;
  836. INIT_LIST_HEAD(&cq->wc_list);
  837. if (context)
  838. if (ib_copy_to_udata(udata, &cq->mcq.cqn, sizeof(__u32))) {
  839. err = -EFAULT;
  840. goto err_cmd;
  841. }
  842. kvfree(cqb);
  843. return &cq->ibcq;
  844. err_cmd:
  845. mlx5_core_destroy_cq(dev->mdev, &cq->mcq);
  846. err_cqb:
  847. kvfree(cqb);
  848. if (context)
  849. destroy_cq_user(cq, context);
  850. else
  851. destroy_cq_kernel(dev, cq);
  852. err_create:
  853. kfree(cq);
  854. return ERR_PTR(err);
  855. }
  856. int mlx5_ib_destroy_cq(struct ib_cq *cq)
  857. {
  858. struct mlx5_ib_dev *dev = to_mdev(cq->device);
  859. struct mlx5_ib_cq *mcq = to_mcq(cq);
  860. struct ib_ucontext *context = NULL;
  861. if (cq->uobject)
  862. context = cq->uobject->context;
  863. mlx5_core_destroy_cq(dev->mdev, &mcq->mcq);
  864. if (context)
  865. destroy_cq_user(mcq, context);
  866. else
  867. destroy_cq_kernel(dev, mcq);
  868. kfree(mcq);
  869. return 0;
  870. }
  871. static int is_equal_rsn(struct mlx5_cqe64 *cqe64, u32 rsn)
  872. {
  873. return rsn == (ntohl(cqe64->sop_drop_qpn) & 0xffffff);
  874. }
  875. void __mlx5_ib_cq_clean(struct mlx5_ib_cq *cq, u32 rsn, struct mlx5_ib_srq *srq)
  876. {
  877. struct mlx5_cqe64 *cqe64, *dest64;
  878. void *cqe, *dest;
  879. u32 prod_index;
  880. int nfreed = 0;
  881. u8 owner_bit;
  882. if (!cq)
  883. return;
  884. /* First we need to find the current producer index, so we
  885. * know where to start cleaning from. It doesn't matter if HW
  886. * adds new entries after this loop -- the QP we're worried
  887. * about is already in RESET, so the new entries won't come
  888. * from our QP and therefore don't need to be checked.
  889. */
  890. for (prod_index = cq->mcq.cons_index; get_sw_cqe(cq, prod_index); prod_index++)
  891. if (prod_index == cq->mcq.cons_index + cq->ibcq.cqe)
  892. break;
  893. /* Now sweep backwards through the CQ, removing CQ entries
  894. * that match our QP by copying older entries on top of them.
  895. */
  896. while ((int) --prod_index - (int) cq->mcq.cons_index >= 0) {
  897. cqe = get_cqe(cq, prod_index & cq->ibcq.cqe);
  898. cqe64 = (cq->mcq.cqe_sz == 64) ? cqe : cqe + 64;
  899. if (is_equal_rsn(cqe64, rsn)) {
  900. if (srq && (ntohl(cqe64->srqn) & 0xffffff))
  901. mlx5_ib_free_srq_wqe(srq, be16_to_cpu(cqe64->wqe_counter));
  902. ++nfreed;
  903. } else if (nfreed) {
  904. dest = get_cqe(cq, (prod_index + nfreed) & cq->ibcq.cqe);
  905. dest64 = (cq->mcq.cqe_sz == 64) ? dest : dest + 64;
  906. owner_bit = dest64->op_own & MLX5_CQE_OWNER_MASK;
  907. memcpy(dest, cqe, cq->mcq.cqe_sz);
  908. dest64->op_own = owner_bit |
  909. (dest64->op_own & ~MLX5_CQE_OWNER_MASK);
  910. }
  911. }
  912. if (nfreed) {
  913. cq->mcq.cons_index += nfreed;
  914. /* Make sure update of buffer contents is done before
  915. * updating consumer index.
  916. */
  917. wmb();
  918. mlx5_cq_set_ci(&cq->mcq);
  919. }
  920. }
  921. void mlx5_ib_cq_clean(struct mlx5_ib_cq *cq, u32 qpn, struct mlx5_ib_srq *srq)
  922. {
  923. if (!cq)
  924. return;
  925. spin_lock_irq(&cq->lock);
  926. __mlx5_ib_cq_clean(cq, qpn, srq);
  927. spin_unlock_irq(&cq->lock);
  928. }
  929. int mlx5_ib_modify_cq(struct ib_cq *cq, u16 cq_count, u16 cq_period)
  930. {
  931. struct mlx5_modify_cq_mbox_in *in;
  932. struct mlx5_ib_dev *dev = to_mdev(cq->device);
  933. struct mlx5_ib_cq *mcq = to_mcq(cq);
  934. int err;
  935. u32 fsel;
  936. if (!MLX5_CAP_GEN(dev->mdev, cq_moderation))
  937. return -ENOSYS;
  938. in = kzalloc(sizeof(*in), GFP_KERNEL);
  939. if (!in)
  940. return -ENOMEM;
  941. in->cqn = cpu_to_be32(mcq->mcq.cqn);
  942. fsel = (MLX5_CQ_MODIFY_PERIOD | MLX5_CQ_MODIFY_COUNT);
  943. in->ctx.cq_period = cpu_to_be16(cq_period);
  944. in->ctx.cq_max_count = cpu_to_be16(cq_count);
  945. in->field_select = cpu_to_be32(fsel);
  946. err = mlx5_core_modify_cq(dev->mdev, &mcq->mcq, in, sizeof(*in));
  947. kfree(in);
  948. if (err)
  949. mlx5_ib_warn(dev, "modify cq 0x%x failed\n", mcq->mcq.cqn);
  950. return err;
  951. }
  952. static int resize_user(struct mlx5_ib_dev *dev, struct mlx5_ib_cq *cq,
  953. int entries, struct ib_udata *udata, int *npas,
  954. int *page_shift, int *cqe_size)
  955. {
  956. struct mlx5_ib_resize_cq ucmd;
  957. struct ib_umem *umem;
  958. int err;
  959. int npages;
  960. struct ib_ucontext *context = cq->buf.umem->context;
  961. err = ib_copy_from_udata(&ucmd, udata, sizeof(ucmd));
  962. if (err)
  963. return err;
  964. if (ucmd.reserved0 || ucmd.reserved1)
  965. return -EINVAL;
  966. umem = ib_umem_get(context, ucmd.buf_addr, entries * ucmd.cqe_size,
  967. IB_ACCESS_LOCAL_WRITE, 1);
  968. if (IS_ERR(umem)) {
  969. err = PTR_ERR(umem);
  970. return err;
  971. }
  972. mlx5_ib_cont_pages(umem, ucmd.buf_addr, &npages, page_shift,
  973. npas, NULL);
  974. cq->resize_umem = umem;
  975. *cqe_size = ucmd.cqe_size;
  976. return 0;
  977. }
  978. static void un_resize_user(struct mlx5_ib_cq *cq)
  979. {
  980. ib_umem_release(cq->resize_umem);
  981. }
  982. static int resize_kernel(struct mlx5_ib_dev *dev, struct mlx5_ib_cq *cq,
  983. int entries, int cqe_size)
  984. {
  985. int err;
  986. cq->resize_buf = kzalloc(sizeof(*cq->resize_buf), GFP_KERNEL);
  987. if (!cq->resize_buf)
  988. return -ENOMEM;
  989. err = alloc_cq_buf(dev, cq->resize_buf, entries, cqe_size);
  990. if (err)
  991. goto ex;
  992. init_cq_buf(cq, cq->resize_buf);
  993. return 0;
  994. ex:
  995. kfree(cq->resize_buf);
  996. return err;
  997. }
  998. static void un_resize_kernel(struct mlx5_ib_dev *dev, struct mlx5_ib_cq *cq)
  999. {
  1000. free_cq_buf(dev, cq->resize_buf);
  1001. cq->resize_buf = NULL;
  1002. }
  1003. static int copy_resize_cqes(struct mlx5_ib_cq *cq)
  1004. {
  1005. struct mlx5_ib_dev *dev = to_mdev(cq->ibcq.device);
  1006. struct mlx5_cqe64 *scqe64;
  1007. struct mlx5_cqe64 *dcqe64;
  1008. void *start_cqe;
  1009. void *scqe;
  1010. void *dcqe;
  1011. int ssize;
  1012. int dsize;
  1013. int i;
  1014. u8 sw_own;
  1015. ssize = cq->buf.cqe_size;
  1016. dsize = cq->resize_buf->cqe_size;
  1017. if (ssize != dsize) {
  1018. mlx5_ib_warn(dev, "resize from different cqe size is not supported\n");
  1019. return -EINVAL;
  1020. }
  1021. i = cq->mcq.cons_index;
  1022. scqe = get_sw_cqe(cq, i);
  1023. scqe64 = ssize == 64 ? scqe : scqe + 64;
  1024. start_cqe = scqe;
  1025. if (!scqe) {
  1026. mlx5_ib_warn(dev, "expected cqe in sw ownership\n");
  1027. return -EINVAL;
  1028. }
  1029. while ((scqe64->op_own >> 4) != MLX5_CQE_RESIZE_CQ) {
  1030. dcqe = get_cqe_from_buf(cq->resize_buf,
  1031. (i + 1) & (cq->resize_buf->nent),
  1032. dsize);
  1033. dcqe64 = dsize == 64 ? dcqe : dcqe + 64;
  1034. sw_own = sw_ownership_bit(i + 1, cq->resize_buf->nent);
  1035. memcpy(dcqe, scqe, dsize);
  1036. dcqe64->op_own = (dcqe64->op_own & ~MLX5_CQE_OWNER_MASK) | sw_own;
  1037. ++i;
  1038. scqe = get_sw_cqe(cq, i);
  1039. scqe64 = ssize == 64 ? scqe : scqe + 64;
  1040. if (!scqe) {
  1041. mlx5_ib_warn(dev, "expected cqe in sw ownership\n");
  1042. return -EINVAL;
  1043. }
  1044. if (scqe == start_cqe) {
  1045. pr_warn("resize CQ failed to get resize CQE, CQN 0x%x\n",
  1046. cq->mcq.cqn);
  1047. return -ENOMEM;
  1048. }
  1049. }
  1050. ++cq->mcq.cons_index;
  1051. return 0;
  1052. }
  1053. int mlx5_ib_resize_cq(struct ib_cq *ibcq, int entries, struct ib_udata *udata)
  1054. {
  1055. struct mlx5_ib_dev *dev = to_mdev(ibcq->device);
  1056. struct mlx5_ib_cq *cq = to_mcq(ibcq);
  1057. struct mlx5_modify_cq_mbox_in *in;
  1058. int err;
  1059. int npas;
  1060. int page_shift;
  1061. int inlen;
  1062. int uninitialized_var(cqe_size);
  1063. unsigned long flags;
  1064. if (!MLX5_CAP_GEN(dev->mdev, cq_resize)) {
  1065. pr_info("Firmware does not support resize CQ\n");
  1066. return -ENOSYS;
  1067. }
  1068. if (entries < 1 ||
  1069. entries > (1 << MLX5_CAP_GEN(dev->mdev, log_max_cq_sz))) {
  1070. mlx5_ib_warn(dev, "wrong entries number %d, max %d\n",
  1071. entries,
  1072. 1 << MLX5_CAP_GEN(dev->mdev, log_max_cq_sz));
  1073. return -EINVAL;
  1074. }
  1075. entries = roundup_pow_of_two(entries + 1);
  1076. if (entries > (1 << MLX5_CAP_GEN(dev->mdev, log_max_cq_sz)) + 1)
  1077. return -EINVAL;
  1078. if (entries == ibcq->cqe + 1)
  1079. return 0;
  1080. mutex_lock(&cq->resize_mutex);
  1081. if (udata) {
  1082. err = resize_user(dev, cq, entries, udata, &npas, &page_shift,
  1083. &cqe_size);
  1084. } else {
  1085. cqe_size = 64;
  1086. err = resize_kernel(dev, cq, entries, cqe_size);
  1087. if (!err) {
  1088. npas = cq->resize_buf->buf.npages;
  1089. page_shift = cq->resize_buf->buf.page_shift;
  1090. }
  1091. }
  1092. if (err)
  1093. goto ex;
  1094. inlen = sizeof(*in) + npas * sizeof(in->pas[0]);
  1095. in = mlx5_vzalloc(inlen);
  1096. if (!in) {
  1097. err = -ENOMEM;
  1098. goto ex_resize;
  1099. }
  1100. if (udata)
  1101. mlx5_ib_populate_pas(dev, cq->resize_umem, page_shift,
  1102. in->pas, 0);
  1103. else
  1104. mlx5_fill_page_array(&cq->resize_buf->buf, in->pas);
  1105. in->field_select = cpu_to_be32(MLX5_MODIFY_CQ_MASK_LOG_SIZE |
  1106. MLX5_MODIFY_CQ_MASK_PG_OFFSET |
  1107. MLX5_MODIFY_CQ_MASK_PG_SIZE);
  1108. in->ctx.log_pg_sz = page_shift - MLX5_ADAPTER_PAGE_SHIFT;
  1109. in->ctx.cqe_sz_flags = cqe_sz_to_mlx_sz(cqe_size) << 5;
  1110. in->ctx.page_offset = 0;
  1111. in->ctx.log_sz_usr_page = cpu_to_be32(ilog2(entries) << 24);
  1112. in->hdr.opmod = cpu_to_be16(MLX5_CQ_OPMOD_RESIZE);
  1113. in->cqn = cpu_to_be32(cq->mcq.cqn);
  1114. err = mlx5_core_modify_cq(dev->mdev, &cq->mcq, in, inlen);
  1115. if (err)
  1116. goto ex_alloc;
  1117. if (udata) {
  1118. cq->ibcq.cqe = entries - 1;
  1119. ib_umem_release(cq->buf.umem);
  1120. cq->buf.umem = cq->resize_umem;
  1121. cq->resize_umem = NULL;
  1122. } else {
  1123. struct mlx5_ib_cq_buf tbuf;
  1124. int resized = 0;
  1125. spin_lock_irqsave(&cq->lock, flags);
  1126. if (cq->resize_buf) {
  1127. err = copy_resize_cqes(cq);
  1128. if (!err) {
  1129. tbuf = cq->buf;
  1130. cq->buf = *cq->resize_buf;
  1131. kfree(cq->resize_buf);
  1132. cq->resize_buf = NULL;
  1133. resized = 1;
  1134. }
  1135. }
  1136. cq->ibcq.cqe = entries - 1;
  1137. spin_unlock_irqrestore(&cq->lock, flags);
  1138. if (resized)
  1139. free_cq_buf(dev, &tbuf);
  1140. }
  1141. mutex_unlock(&cq->resize_mutex);
  1142. kvfree(in);
  1143. return 0;
  1144. ex_alloc:
  1145. kvfree(in);
  1146. ex_resize:
  1147. if (udata)
  1148. un_resize_user(cq);
  1149. else
  1150. un_resize_kernel(dev, cq);
  1151. ex:
  1152. mutex_unlock(&cq->resize_mutex);
  1153. return err;
  1154. }
  1155. int mlx5_ib_get_cqe_size(struct mlx5_ib_dev *dev, struct ib_cq *ibcq)
  1156. {
  1157. struct mlx5_ib_cq *cq;
  1158. if (!ibcq)
  1159. return 128;
  1160. cq = to_mcq(ibcq);
  1161. return cq->cqe_size;
  1162. }
  1163. /* Called from atomic context */
  1164. int mlx5_ib_generate_wc(struct ib_cq *ibcq, struct ib_wc *wc)
  1165. {
  1166. struct mlx5_ib_wc *soft_wc;
  1167. struct mlx5_ib_cq *cq = to_mcq(ibcq);
  1168. unsigned long flags;
  1169. soft_wc = kmalloc(sizeof(*soft_wc), GFP_ATOMIC);
  1170. if (!soft_wc)
  1171. return -ENOMEM;
  1172. soft_wc->wc = *wc;
  1173. spin_lock_irqsave(&cq->lock, flags);
  1174. list_add_tail(&soft_wc->list, &cq->wc_list);
  1175. if (cq->notify_flags == IB_CQ_NEXT_COMP ||
  1176. wc->status != IB_WC_SUCCESS) {
  1177. cq->notify_flags = 0;
  1178. schedule_work(&cq->notify_work);
  1179. }
  1180. spin_unlock_irqrestore(&cq->lock, flags);
  1181. return 0;
  1182. }