ib_send.c 29 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989
  1. /*
  2. * Copyright (c) 2006 Oracle. 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. */
  33. #include <linux/kernel.h>
  34. #include <linux/in.h>
  35. #include <linux/device.h>
  36. #include <linux/dmapool.h>
  37. #include <linux/ratelimit.h>
  38. #include "rds.h"
  39. #include "ib.h"
  40. /*
  41. * Convert IB-specific error message to RDS error message and call core
  42. * completion handler.
  43. */
  44. static void rds_ib_send_complete(struct rds_message *rm,
  45. int wc_status,
  46. void (*complete)(struct rds_message *rm, int status))
  47. {
  48. int notify_status;
  49. switch (wc_status) {
  50. case IB_WC_WR_FLUSH_ERR:
  51. return;
  52. case IB_WC_SUCCESS:
  53. notify_status = RDS_RDMA_SUCCESS;
  54. break;
  55. case IB_WC_REM_ACCESS_ERR:
  56. notify_status = RDS_RDMA_REMOTE_ERROR;
  57. break;
  58. default:
  59. notify_status = RDS_RDMA_OTHER_ERROR;
  60. break;
  61. }
  62. complete(rm, notify_status);
  63. }
  64. static void rds_ib_send_unmap_data(struct rds_ib_connection *ic,
  65. struct rm_data_op *op,
  66. int wc_status)
  67. {
  68. if (op->op_nents)
  69. ib_dma_unmap_sg(ic->i_cm_id->device,
  70. op->op_sg, op->op_nents,
  71. DMA_TO_DEVICE);
  72. }
  73. static void rds_ib_send_unmap_rdma(struct rds_ib_connection *ic,
  74. struct rm_rdma_op *op,
  75. int wc_status)
  76. {
  77. if (op->op_mapped) {
  78. ib_dma_unmap_sg(ic->i_cm_id->device,
  79. op->op_sg, op->op_nents,
  80. op->op_write ? DMA_TO_DEVICE : DMA_FROM_DEVICE);
  81. op->op_mapped = 0;
  82. }
  83. /* If the user asked for a completion notification on this
  84. * message, we can implement three different semantics:
  85. * 1. Notify when we received the ACK on the RDS message
  86. * that was queued with the RDMA. This provides reliable
  87. * notification of RDMA status at the expense of a one-way
  88. * packet delay.
  89. * 2. Notify when the IB stack gives us the completion event for
  90. * the RDMA operation.
  91. * 3. Notify when the IB stack gives us the completion event for
  92. * the accompanying RDS messages.
  93. * Here, we implement approach #3. To implement approach #2,
  94. * we would need to take an event for the rdma WR. To implement #1,
  95. * don't call rds_rdma_send_complete at all, and fall back to the notify
  96. * handling in the ACK processing code.
  97. *
  98. * Note: There's no need to explicitly sync any RDMA buffers using
  99. * ib_dma_sync_sg_for_cpu - the completion for the RDMA
  100. * operation itself unmapped the RDMA buffers, which takes care
  101. * of synching.
  102. */
  103. rds_ib_send_complete(container_of(op, struct rds_message, rdma),
  104. wc_status, rds_rdma_send_complete);
  105. if (op->op_write)
  106. rds_stats_add(s_send_rdma_bytes, op->op_bytes);
  107. else
  108. rds_stats_add(s_recv_rdma_bytes, op->op_bytes);
  109. }
  110. static void rds_ib_send_unmap_atomic(struct rds_ib_connection *ic,
  111. struct rm_atomic_op *op,
  112. int wc_status)
  113. {
  114. /* unmap atomic recvbuf */
  115. if (op->op_mapped) {
  116. ib_dma_unmap_sg(ic->i_cm_id->device, op->op_sg, 1,
  117. DMA_FROM_DEVICE);
  118. op->op_mapped = 0;
  119. }
  120. rds_ib_send_complete(container_of(op, struct rds_message, atomic),
  121. wc_status, rds_atomic_send_complete);
  122. if (op->op_type == RDS_ATOMIC_TYPE_CSWP)
  123. rds_ib_stats_inc(s_ib_atomic_cswp);
  124. else
  125. rds_ib_stats_inc(s_ib_atomic_fadd);
  126. }
  127. /*
  128. * Unmap the resources associated with a struct send_work.
  129. *
  130. * Returns the rm for no good reason other than it is unobtainable
  131. * other than by switching on wr.opcode, currently, and the caller,
  132. * the event handler, needs it.
  133. */
  134. static struct rds_message *rds_ib_send_unmap_op(struct rds_ib_connection *ic,
  135. struct rds_ib_send_work *send,
  136. int wc_status)
  137. {
  138. struct rds_message *rm = NULL;
  139. /* In the error case, wc.opcode sometimes contains garbage */
  140. switch (send->s_wr.opcode) {
  141. case IB_WR_SEND:
  142. if (send->s_op) {
  143. rm = container_of(send->s_op, struct rds_message, data);
  144. rds_ib_send_unmap_data(ic, send->s_op, wc_status);
  145. }
  146. break;
  147. case IB_WR_RDMA_WRITE:
  148. case IB_WR_RDMA_READ:
  149. if (send->s_op) {
  150. rm = container_of(send->s_op, struct rds_message, rdma);
  151. rds_ib_send_unmap_rdma(ic, send->s_op, wc_status);
  152. }
  153. break;
  154. case IB_WR_ATOMIC_FETCH_AND_ADD:
  155. case IB_WR_ATOMIC_CMP_AND_SWP:
  156. if (send->s_op) {
  157. rm = container_of(send->s_op, struct rds_message, atomic);
  158. rds_ib_send_unmap_atomic(ic, send->s_op, wc_status);
  159. }
  160. break;
  161. default:
  162. printk_ratelimited(KERN_NOTICE
  163. "RDS/IB: %s: unexpected opcode 0x%x in WR!\n",
  164. __func__, send->s_wr.opcode);
  165. break;
  166. }
  167. send->s_wr.opcode = 0xdead;
  168. return rm;
  169. }
  170. void rds_ib_send_init_ring(struct rds_ib_connection *ic)
  171. {
  172. struct rds_ib_send_work *send;
  173. u32 i;
  174. for (i = 0, send = ic->i_sends; i < ic->i_send_ring.w_nr; i++, send++) {
  175. struct ib_sge *sge;
  176. send->s_op = NULL;
  177. send->s_wr.wr_id = i;
  178. send->s_wr.sg_list = send->s_sge;
  179. send->s_wr.ex.imm_data = 0;
  180. sge = &send->s_sge[0];
  181. sge->addr = ic->i_send_hdrs_dma + (i * sizeof(struct rds_header));
  182. sge->length = sizeof(struct rds_header);
  183. sge->lkey = ic->i_pd->local_dma_lkey;
  184. send->s_sge[1].lkey = ic->i_pd->local_dma_lkey;
  185. }
  186. }
  187. void rds_ib_send_clear_ring(struct rds_ib_connection *ic)
  188. {
  189. struct rds_ib_send_work *send;
  190. u32 i;
  191. for (i = 0, send = ic->i_sends; i < ic->i_send_ring.w_nr; i++, send++) {
  192. if (send->s_op && send->s_wr.opcode != 0xdead)
  193. rds_ib_send_unmap_op(ic, send, IB_WC_WR_FLUSH_ERR);
  194. }
  195. }
  196. /*
  197. * The only fast path caller always has a non-zero nr, so we don't
  198. * bother testing nr before performing the atomic sub.
  199. */
  200. static void rds_ib_sub_signaled(struct rds_ib_connection *ic, int nr)
  201. {
  202. if ((atomic_sub_return(nr, &ic->i_signaled_sends) == 0) &&
  203. waitqueue_active(&rds_ib_ring_empty_wait))
  204. wake_up(&rds_ib_ring_empty_wait);
  205. BUG_ON(atomic_read(&ic->i_signaled_sends) < 0);
  206. }
  207. /*
  208. * The _oldest/_free ring operations here race cleanly with the alloc/unalloc
  209. * operations performed in the send path. As the sender allocs and potentially
  210. * unallocs the next free entry in the ring it doesn't alter which is
  211. * the next to be freed, which is what this is concerned with.
  212. */
  213. void rds_ib_send_cqe_handler(struct rds_ib_connection *ic, struct ib_wc *wc)
  214. {
  215. struct rds_message *rm = NULL;
  216. struct rds_connection *conn = ic->conn;
  217. struct rds_ib_send_work *send;
  218. u32 completed;
  219. u32 oldest;
  220. u32 i = 0;
  221. int nr_sig = 0;
  222. rdsdebug("wc wr_id 0x%llx status %u (%s) byte_len %u imm_data %u\n",
  223. (unsigned long long)wc->wr_id, wc->status,
  224. ib_wc_status_msg(wc->status), wc->byte_len,
  225. be32_to_cpu(wc->ex.imm_data));
  226. rds_ib_stats_inc(s_ib_tx_cq_event);
  227. if (wc->wr_id == RDS_IB_ACK_WR_ID) {
  228. if (time_after(jiffies, ic->i_ack_queued + HZ / 2))
  229. rds_ib_stats_inc(s_ib_tx_stalled);
  230. rds_ib_ack_send_complete(ic);
  231. return;
  232. }
  233. oldest = rds_ib_ring_oldest(&ic->i_send_ring);
  234. completed = rds_ib_ring_completed(&ic->i_send_ring, wc->wr_id, oldest);
  235. for (i = 0; i < completed; i++) {
  236. send = &ic->i_sends[oldest];
  237. if (send->s_wr.send_flags & IB_SEND_SIGNALED)
  238. nr_sig++;
  239. rm = rds_ib_send_unmap_op(ic, send, wc->status);
  240. if (time_after(jiffies, send->s_queued + HZ / 2))
  241. rds_ib_stats_inc(s_ib_tx_stalled);
  242. if (send->s_op) {
  243. if (send->s_op == rm->m_final_op) {
  244. /* If anyone waited for this message to get
  245. * flushed out, wake them up now
  246. */
  247. rds_message_unmapped(rm);
  248. }
  249. rds_message_put(rm);
  250. send->s_op = NULL;
  251. }
  252. oldest = (oldest + 1) % ic->i_send_ring.w_nr;
  253. }
  254. rds_ib_ring_free(&ic->i_send_ring, completed);
  255. rds_ib_sub_signaled(ic, nr_sig);
  256. nr_sig = 0;
  257. if (test_and_clear_bit(RDS_LL_SEND_FULL, &conn->c_flags) ||
  258. test_bit(0, &conn->c_map_queued))
  259. queue_delayed_work(rds_wq, &conn->c_send_w, 0);
  260. /* We expect errors as the qp is drained during shutdown */
  261. if (wc->status != IB_WC_SUCCESS && rds_conn_up(conn)) {
  262. rds_ib_conn_error(conn, "send completion on %pI4 had status %u (%s), disconnecting and reconnecting\n",
  263. &conn->c_faddr, wc->status,
  264. ib_wc_status_msg(wc->status));
  265. }
  266. }
  267. /*
  268. * This is the main function for allocating credits when sending
  269. * messages.
  270. *
  271. * Conceptually, we have two counters:
  272. * - send credits: this tells us how many WRs we're allowed
  273. * to submit without overruning the receiver's queue. For
  274. * each SEND WR we post, we decrement this by one.
  275. *
  276. * - posted credits: this tells us how many WRs we recently
  277. * posted to the receive queue. This value is transferred
  278. * to the peer as a "credit update" in a RDS header field.
  279. * Every time we transmit credits to the peer, we subtract
  280. * the amount of transferred credits from this counter.
  281. *
  282. * It is essential that we avoid situations where both sides have
  283. * exhausted their send credits, and are unable to send new credits
  284. * to the peer. We achieve this by requiring that we send at least
  285. * one credit update to the peer before exhausting our credits.
  286. * When new credits arrive, we subtract one credit that is withheld
  287. * until we've posted new buffers and are ready to transmit these
  288. * credits (see rds_ib_send_add_credits below).
  289. *
  290. * The RDS send code is essentially single-threaded; rds_send_xmit
  291. * sets RDS_IN_XMIT to ensure exclusive access to the send ring.
  292. * However, the ACK sending code is independent and can race with
  293. * message SENDs.
  294. *
  295. * In the send path, we need to update the counters for send credits
  296. * and the counter of posted buffers atomically - when we use the
  297. * last available credit, we cannot allow another thread to race us
  298. * and grab the posted credits counter. Hence, we have to use a
  299. * spinlock to protect the credit counter, or use atomics.
  300. *
  301. * Spinlocks shared between the send and the receive path are bad,
  302. * because they create unnecessary delays. An early implementation
  303. * using a spinlock showed a 5% degradation in throughput at some
  304. * loads.
  305. *
  306. * This implementation avoids spinlocks completely, putting both
  307. * counters into a single atomic, and updating that atomic using
  308. * atomic_add (in the receive path, when receiving fresh credits),
  309. * and using atomic_cmpxchg when updating the two counters.
  310. */
  311. int rds_ib_send_grab_credits(struct rds_ib_connection *ic,
  312. u32 wanted, u32 *adv_credits, int need_posted, int max_posted)
  313. {
  314. unsigned int avail, posted, got = 0, advertise;
  315. long oldval, newval;
  316. *adv_credits = 0;
  317. if (!ic->i_flowctl)
  318. return wanted;
  319. try_again:
  320. advertise = 0;
  321. oldval = newval = atomic_read(&ic->i_credits);
  322. posted = IB_GET_POST_CREDITS(oldval);
  323. avail = IB_GET_SEND_CREDITS(oldval);
  324. rdsdebug("wanted=%u credits=%u posted=%u\n",
  325. wanted, avail, posted);
  326. /* The last credit must be used to send a credit update. */
  327. if (avail && !posted)
  328. avail--;
  329. if (avail < wanted) {
  330. struct rds_connection *conn = ic->i_cm_id->context;
  331. /* Oops, there aren't that many credits left! */
  332. set_bit(RDS_LL_SEND_FULL, &conn->c_flags);
  333. got = avail;
  334. } else {
  335. /* Sometimes you get what you want, lalala. */
  336. got = wanted;
  337. }
  338. newval -= IB_SET_SEND_CREDITS(got);
  339. /*
  340. * If need_posted is non-zero, then the caller wants
  341. * the posted regardless of whether any send credits are
  342. * available.
  343. */
  344. if (posted && (got || need_posted)) {
  345. advertise = min_t(unsigned int, posted, max_posted);
  346. newval -= IB_SET_POST_CREDITS(advertise);
  347. }
  348. /* Finally bill everything */
  349. if (atomic_cmpxchg(&ic->i_credits, oldval, newval) != oldval)
  350. goto try_again;
  351. *adv_credits = advertise;
  352. return got;
  353. }
  354. void rds_ib_send_add_credits(struct rds_connection *conn, unsigned int credits)
  355. {
  356. struct rds_ib_connection *ic = conn->c_transport_data;
  357. if (credits == 0)
  358. return;
  359. rdsdebug("credits=%u current=%u%s\n",
  360. credits,
  361. IB_GET_SEND_CREDITS(atomic_read(&ic->i_credits)),
  362. test_bit(RDS_LL_SEND_FULL, &conn->c_flags) ? ", ll_send_full" : "");
  363. atomic_add(IB_SET_SEND_CREDITS(credits), &ic->i_credits);
  364. if (test_and_clear_bit(RDS_LL_SEND_FULL, &conn->c_flags))
  365. queue_delayed_work(rds_wq, &conn->c_send_w, 0);
  366. WARN_ON(IB_GET_SEND_CREDITS(credits) >= 16384);
  367. rds_ib_stats_inc(s_ib_rx_credit_updates);
  368. }
  369. void rds_ib_advertise_credits(struct rds_connection *conn, unsigned int posted)
  370. {
  371. struct rds_ib_connection *ic = conn->c_transport_data;
  372. if (posted == 0)
  373. return;
  374. atomic_add(IB_SET_POST_CREDITS(posted), &ic->i_credits);
  375. /* Decide whether to send an update to the peer now.
  376. * If we would send a credit update for every single buffer we
  377. * post, we would end up with an ACK storm (ACK arrives,
  378. * consumes buffer, we refill the ring, send ACK to remote
  379. * advertising the newly posted buffer... ad inf)
  380. *
  381. * Performance pretty much depends on how often we send
  382. * credit updates - too frequent updates mean lots of ACKs.
  383. * Too infrequent updates, and the peer will run out of
  384. * credits and has to throttle.
  385. * For the time being, 16 seems to be a good compromise.
  386. */
  387. if (IB_GET_POST_CREDITS(atomic_read(&ic->i_credits)) >= 16)
  388. set_bit(IB_ACK_REQUESTED, &ic->i_ack_flags);
  389. }
  390. static inline int rds_ib_set_wr_signal_state(struct rds_ib_connection *ic,
  391. struct rds_ib_send_work *send,
  392. bool notify)
  393. {
  394. /*
  395. * We want to delay signaling completions just enough to get
  396. * the batching benefits but not so much that we create dead time
  397. * on the wire.
  398. */
  399. if (ic->i_unsignaled_wrs-- == 0 || notify) {
  400. ic->i_unsignaled_wrs = rds_ib_sysctl_max_unsig_wrs;
  401. send->s_wr.send_flags |= IB_SEND_SIGNALED;
  402. return 1;
  403. }
  404. return 0;
  405. }
  406. /*
  407. * This can be called multiple times for a given message. The first time
  408. * we see a message we map its scatterlist into the IB device so that
  409. * we can provide that mapped address to the IB scatter gather entries
  410. * in the IB work requests. We translate the scatterlist into a series
  411. * of work requests that fragment the message. These work requests complete
  412. * in order so we pass ownership of the message to the completion handler
  413. * once we send the final fragment.
  414. *
  415. * The RDS core uses the c_send_lock to only enter this function once
  416. * per connection. This makes sure that the tx ring alloc/unalloc pairs
  417. * don't get out of sync and confuse the ring.
  418. */
  419. int rds_ib_xmit(struct rds_connection *conn, struct rds_message *rm,
  420. unsigned int hdr_off, unsigned int sg, unsigned int off)
  421. {
  422. struct rds_ib_connection *ic = conn->c_transport_data;
  423. struct ib_device *dev = ic->i_cm_id->device;
  424. struct rds_ib_send_work *send = NULL;
  425. struct rds_ib_send_work *first;
  426. struct rds_ib_send_work *prev;
  427. struct ib_send_wr *failed_wr;
  428. struct scatterlist *scat;
  429. u32 pos;
  430. u32 i;
  431. u32 work_alloc;
  432. u32 credit_alloc = 0;
  433. u32 posted;
  434. u32 adv_credits = 0;
  435. int send_flags = 0;
  436. int bytes_sent = 0;
  437. int ret;
  438. int flow_controlled = 0;
  439. int nr_sig = 0;
  440. BUG_ON(off % RDS_FRAG_SIZE);
  441. BUG_ON(hdr_off != 0 && hdr_off != sizeof(struct rds_header));
  442. /* Do not send cong updates to IB loopback */
  443. if (conn->c_loopback
  444. && rm->m_inc.i_hdr.h_flags & RDS_FLAG_CONG_BITMAP) {
  445. rds_cong_map_updated(conn->c_fcong, ~(u64) 0);
  446. scat = &rm->data.op_sg[sg];
  447. ret = max_t(int, RDS_CONG_MAP_BYTES, scat->length);
  448. return sizeof(struct rds_header) + ret;
  449. }
  450. /* FIXME we may overallocate here */
  451. if (be32_to_cpu(rm->m_inc.i_hdr.h_len) == 0)
  452. i = 1;
  453. else
  454. i = ceil(be32_to_cpu(rm->m_inc.i_hdr.h_len), RDS_FRAG_SIZE);
  455. work_alloc = rds_ib_ring_alloc(&ic->i_send_ring, i, &pos);
  456. if (work_alloc == 0) {
  457. set_bit(RDS_LL_SEND_FULL, &conn->c_flags);
  458. rds_ib_stats_inc(s_ib_tx_ring_full);
  459. ret = -ENOMEM;
  460. goto out;
  461. }
  462. if (ic->i_flowctl) {
  463. credit_alloc = rds_ib_send_grab_credits(ic, work_alloc, &posted, 0, RDS_MAX_ADV_CREDIT);
  464. adv_credits += posted;
  465. if (credit_alloc < work_alloc) {
  466. rds_ib_ring_unalloc(&ic->i_send_ring, work_alloc - credit_alloc);
  467. work_alloc = credit_alloc;
  468. flow_controlled = 1;
  469. }
  470. if (work_alloc == 0) {
  471. set_bit(RDS_LL_SEND_FULL, &conn->c_flags);
  472. rds_ib_stats_inc(s_ib_tx_throttle);
  473. ret = -ENOMEM;
  474. goto out;
  475. }
  476. }
  477. /* map the message the first time we see it */
  478. if (!ic->i_data_op) {
  479. if (rm->data.op_nents) {
  480. rm->data.op_count = ib_dma_map_sg(dev,
  481. rm->data.op_sg,
  482. rm->data.op_nents,
  483. DMA_TO_DEVICE);
  484. rdsdebug("ic %p mapping rm %p: %d\n", ic, rm, rm->data.op_count);
  485. if (rm->data.op_count == 0) {
  486. rds_ib_stats_inc(s_ib_tx_sg_mapping_failure);
  487. rds_ib_ring_unalloc(&ic->i_send_ring, work_alloc);
  488. ret = -ENOMEM; /* XXX ? */
  489. goto out;
  490. }
  491. } else {
  492. rm->data.op_count = 0;
  493. }
  494. rds_message_addref(rm);
  495. rm->data.op_dmasg = 0;
  496. rm->data.op_dmaoff = 0;
  497. ic->i_data_op = &rm->data;
  498. /* Finalize the header */
  499. if (test_bit(RDS_MSG_ACK_REQUIRED, &rm->m_flags))
  500. rm->m_inc.i_hdr.h_flags |= RDS_FLAG_ACK_REQUIRED;
  501. if (test_bit(RDS_MSG_RETRANSMITTED, &rm->m_flags))
  502. rm->m_inc.i_hdr.h_flags |= RDS_FLAG_RETRANSMITTED;
  503. /* If it has a RDMA op, tell the peer we did it. This is
  504. * used by the peer to release use-once RDMA MRs. */
  505. if (rm->rdma.op_active) {
  506. struct rds_ext_header_rdma ext_hdr;
  507. ext_hdr.h_rdma_rkey = cpu_to_be32(rm->rdma.op_rkey);
  508. rds_message_add_extension(&rm->m_inc.i_hdr,
  509. RDS_EXTHDR_RDMA, &ext_hdr, sizeof(ext_hdr));
  510. }
  511. if (rm->m_rdma_cookie) {
  512. rds_message_add_rdma_dest_extension(&rm->m_inc.i_hdr,
  513. rds_rdma_cookie_key(rm->m_rdma_cookie),
  514. rds_rdma_cookie_offset(rm->m_rdma_cookie));
  515. }
  516. /* Note - rds_ib_piggyb_ack clears the ACK_REQUIRED bit, so
  517. * we should not do this unless we have a chance of at least
  518. * sticking the header into the send ring. Which is why we
  519. * should call rds_ib_ring_alloc first. */
  520. rm->m_inc.i_hdr.h_ack = cpu_to_be64(rds_ib_piggyb_ack(ic));
  521. rds_message_make_checksum(&rm->m_inc.i_hdr);
  522. /*
  523. * Update adv_credits since we reset the ACK_REQUIRED bit.
  524. */
  525. if (ic->i_flowctl) {
  526. rds_ib_send_grab_credits(ic, 0, &posted, 1, RDS_MAX_ADV_CREDIT - adv_credits);
  527. adv_credits += posted;
  528. BUG_ON(adv_credits > 255);
  529. }
  530. }
  531. /* Sometimes you want to put a fence between an RDMA
  532. * READ and the following SEND.
  533. * We could either do this all the time
  534. * or when requested by the user. Right now, we let
  535. * the application choose.
  536. */
  537. if (rm->rdma.op_active && rm->rdma.op_fence)
  538. send_flags = IB_SEND_FENCE;
  539. /* Each frag gets a header. Msgs may be 0 bytes */
  540. send = &ic->i_sends[pos];
  541. first = send;
  542. prev = NULL;
  543. scat = &ic->i_data_op->op_sg[rm->data.op_dmasg];
  544. i = 0;
  545. do {
  546. unsigned int len = 0;
  547. /* Set up the header */
  548. send->s_wr.send_flags = send_flags;
  549. send->s_wr.opcode = IB_WR_SEND;
  550. send->s_wr.num_sge = 1;
  551. send->s_wr.next = NULL;
  552. send->s_queued = jiffies;
  553. send->s_op = NULL;
  554. send->s_sge[0].addr = ic->i_send_hdrs_dma
  555. + (pos * sizeof(struct rds_header));
  556. send->s_sge[0].length = sizeof(struct rds_header);
  557. memcpy(&ic->i_send_hdrs[pos], &rm->m_inc.i_hdr, sizeof(struct rds_header));
  558. /* Set up the data, if present */
  559. if (i < work_alloc
  560. && scat != &rm->data.op_sg[rm->data.op_count]) {
  561. len = min(RDS_FRAG_SIZE,
  562. ib_sg_dma_len(dev, scat) - rm->data.op_dmaoff);
  563. send->s_wr.num_sge = 2;
  564. send->s_sge[1].addr = ib_sg_dma_address(dev, scat);
  565. send->s_sge[1].addr += rm->data.op_dmaoff;
  566. send->s_sge[1].length = len;
  567. bytes_sent += len;
  568. rm->data.op_dmaoff += len;
  569. if (rm->data.op_dmaoff == ib_sg_dma_len(dev, scat)) {
  570. scat++;
  571. rm->data.op_dmasg++;
  572. rm->data.op_dmaoff = 0;
  573. }
  574. }
  575. rds_ib_set_wr_signal_state(ic, send, 0);
  576. /*
  577. * Always signal the last one if we're stopping due to flow control.
  578. */
  579. if (ic->i_flowctl && flow_controlled && i == (work_alloc-1))
  580. send->s_wr.send_flags |= IB_SEND_SIGNALED | IB_SEND_SOLICITED;
  581. if (send->s_wr.send_flags & IB_SEND_SIGNALED)
  582. nr_sig++;
  583. rdsdebug("send %p wr %p num_sge %u next %p\n", send,
  584. &send->s_wr, send->s_wr.num_sge, send->s_wr.next);
  585. if (ic->i_flowctl && adv_credits) {
  586. struct rds_header *hdr = &ic->i_send_hdrs[pos];
  587. /* add credit and redo the header checksum */
  588. hdr->h_credit = adv_credits;
  589. rds_message_make_checksum(hdr);
  590. adv_credits = 0;
  591. rds_ib_stats_inc(s_ib_tx_credit_updates);
  592. }
  593. if (prev)
  594. prev->s_wr.next = &send->s_wr;
  595. prev = send;
  596. pos = (pos + 1) % ic->i_send_ring.w_nr;
  597. send = &ic->i_sends[pos];
  598. i++;
  599. } while (i < work_alloc
  600. && scat != &rm->data.op_sg[rm->data.op_count]);
  601. /* Account the RDS header in the number of bytes we sent, but just once.
  602. * The caller has no concept of fragmentation. */
  603. if (hdr_off == 0)
  604. bytes_sent += sizeof(struct rds_header);
  605. /* if we finished the message then send completion owns it */
  606. if (scat == &rm->data.op_sg[rm->data.op_count]) {
  607. prev->s_op = ic->i_data_op;
  608. prev->s_wr.send_flags |= IB_SEND_SOLICITED;
  609. if (!(prev->s_wr.send_flags & IB_SEND_SIGNALED)) {
  610. ic->i_unsignaled_wrs = rds_ib_sysctl_max_unsig_wrs;
  611. prev->s_wr.send_flags |= IB_SEND_SIGNALED;
  612. nr_sig++;
  613. }
  614. ic->i_data_op = NULL;
  615. }
  616. /* Put back wrs & credits we didn't use */
  617. if (i < work_alloc) {
  618. rds_ib_ring_unalloc(&ic->i_send_ring, work_alloc - i);
  619. work_alloc = i;
  620. }
  621. if (ic->i_flowctl && i < credit_alloc)
  622. rds_ib_send_add_credits(conn, credit_alloc - i);
  623. if (nr_sig)
  624. atomic_add(nr_sig, &ic->i_signaled_sends);
  625. /* XXX need to worry about failed_wr and partial sends. */
  626. failed_wr = &first->s_wr;
  627. ret = ib_post_send(ic->i_cm_id->qp, &first->s_wr, &failed_wr);
  628. rdsdebug("ic %p first %p (wr %p) ret %d wr %p\n", ic,
  629. first, &first->s_wr, ret, failed_wr);
  630. BUG_ON(failed_wr != &first->s_wr);
  631. if (ret) {
  632. printk(KERN_WARNING "RDS/IB: ib_post_send to %pI4 "
  633. "returned %d\n", &conn->c_faddr, ret);
  634. rds_ib_ring_unalloc(&ic->i_send_ring, work_alloc);
  635. rds_ib_sub_signaled(ic, nr_sig);
  636. if (prev->s_op) {
  637. ic->i_data_op = prev->s_op;
  638. prev->s_op = NULL;
  639. }
  640. rds_ib_conn_error(ic->conn, "ib_post_send failed\n");
  641. goto out;
  642. }
  643. ret = bytes_sent;
  644. out:
  645. BUG_ON(adv_credits);
  646. return ret;
  647. }
  648. /*
  649. * Issue atomic operation.
  650. * A simplified version of the rdma case, we always map 1 SG, and
  651. * only 8 bytes, for the return value from the atomic operation.
  652. */
  653. int rds_ib_xmit_atomic(struct rds_connection *conn, struct rm_atomic_op *op)
  654. {
  655. struct rds_ib_connection *ic = conn->c_transport_data;
  656. struct rds_ib_send_work *send = NULL;
  657. struct ib_send_wr *failed_wr;
  658. struct rds_ib_device *rds_ibdev;
  659. u32 pos;
  660. u32 work_alloc;
  661. int ret;
  662. int nr_sig = 0;
  663. rds_ibdev = ib_get_client_data(ic->i_cm_id->device, &rds_ib_client);
  664. work_alloc = rds_ib_ring_alloc(&ic->i_send_ring, 1, &pos);
  665. if (work_alloc != 1) {
  666. rds_ib_ring_unalloc(&ic->i_send_ring, work_alloc);
  667. rds_ib_stats_inc(s_ib_tx_ring_full);
  668. ret = -ENOMEM;
  669. goto out;
  670. }
  671. /* address of send request in ring */
  672. send = &ic->i_sends[pos];
  673. send->s_queued = jiffies;
  674. if (op->op_type == RDS_ATOMIC_TYPE_CSWP) {
  675. send->s_atomic_wr.wr.opcode = IB_WR_MASKED_ATOMIC_CMP_AND_SWP;
  676. send->s_atomic_wr.compare_add = op->op_m_cswp.compare;
  677. send->s_atomic_wr.swap = op->op_m_cswp.swap;
  678. send->s_atomic_wr.compare_add_mask = op->op_m_cswp.compare_mask;
  679. send->s_atomic_wr.swap_mask = op->op_m_cswp.swap_mask;
  680. } else { /* FADD */
  681. send->s_atomic_wr.wr.opcode = IB_WR_MASKED_ATOMIC_FETCH_AND_ADD;
  682. send->s_atomic_wr.compare_add = op->op_m_fadd.add;
  683. send->s_atomic_wr.swap = 0;
  684. send->s_atomic_wr.compare_add_mask = op->op_m_fadd.nocarry_mask;
  685. send->s_atomic_wr.swap_mask = 0;
  686. }
  687. nr_sig = rds_ib_set_wr_signal_state(ic, send, op->op_notify);
  688. send->s_atomic_wr.wr.num_sge = 1;
  689. send->s_atomic_wr.wr.next = NULL;
  690. send->s_atomic_wr.remote_addr = op->op_remote_addr;
  691. send->s_atomic_wr.rkey = op->op_rkey;
  692. send->s_op = op;
  693. rds_message_addref(container_of(send->s_op, struct rds_message, atomic));
  694. /* map 8 byte retval buffer to the device */
  695. ret = ib_dma_map_sg(ic->i_cm_id->device, op->op_sg, 1, DMA_FROM_DEVICE);
  696. rdsdebug("ic %p mapping atomic op %p. mapped %d pg\n", ic, op, ret);
  697. if (ret != 1) {
  698. rds_ib_ring_unalloc(&ic->i_send_ring, work_alloc);
  699. rds_ib_stats_inc(s_ib_tx_sg_mapping_failure);
  700. ret = -ENOMEM; /* XXX ? */
  701. goto out;
  702. }
  703. /* Convert our struct scatterlist to struct ib_sge */
  704. send->s_sge[0].addr = ib_sg_dma_address(ic->i_cm_id->device, op->op_sg);
  705. send->s_sge[0].length = ib_sg_dma_len(ic->i_cm_id->device, op->op_sg);
  706. send->s_sge[0].lkey = ic->i_pd->local_dma_lkey;
  707. rdsdebug("rva %Lx rpa %Lx len %u\n", op->op_remote_addr,
  708. send->s_sge[0].addr, send->s_sge[0].length);
  709. if (nr_sig)
  710. atomic_add(nr_sig, &ic->i_signaled_sends);
  711. failed_wr = &send->s_atomic_wr.wr;
  712. ret = ib_post_send(ic->i_cm_id->qp, &send->s_atomic_wr.wr, &failed_wr);
  713. rdsdebug("ic %p send %p (wr %p) ret %d wr %p\n", ic,
  714. send, &send->s_atomic_wr, ret, failed_wr);
  715. BUG_ON(failed_wr != &send->s_atomic_wr.wr);
  716. if (ret) {
  717. printk(KERN_WARNING "RDS/IB: atomic ib_post_send to %pI4 "
  718. "returned %d\n", &conn->c_faddr, ret);
  719. rds_ib_ring_unalloc(&ic->i_send_ring, work_alloc);
  720. rds_ib_sub_signaled(ic, nr_sig);
  721. goto out;
  722. }
  723. if (unlikely(failed_wr != &send->s_atomic_wr.wr)) {
  724. printk(KERN_WARNING "RDS/IB: atomic ib_post_send() rc=%d, but failed_wqe updated!\n", ret);
  725. BUG_ON(failed_wr != &send->s_atomic_wr.wr);
  726. }
  727. out:
  728. return ret;
  729. }
  730. int rds_ib_xmit_rdma(struct rds_connection *conn, struct rm_rdma_op *op)
  731. {
  732. struct rds_ib_connection *ic = conn->c_transport_data;
  733. struct rds_ib_send_work *send = NULL;
  734. struct rds_ib_send_work *first;
  735. struct rds_ib_send_work *prev;
  736. struct ib_send_wr *failed_wr;
  737. struct scatterlist *scat;
  738. unsigned long len;
  739. u64 remote_addr = op->op_remote_addr;
  740. u32 max_sge = ic->rds_ibdev->max_sge;
  741. u32 pos;
  742. u32 work_alloc;
  743. u32 i;
  744. u32 j;
  745. int sent;
  746. int ret;
  747. int num_sge;
  748. int nr_sig = 0;
  749. /* map the op the first time we see it */
  750. if (!op->op_mapped) {
  751. op->op_count = ib_dma_map_sg(ic->i_cm_id->device,
  752. op->op_sg, op->op_nents, (op->op_write) ?
  753. DMA_TO_DEVICE : DMA_FROM_DEVICE);
  754. rdsdebug("ic %p mapping op %p: %d\n", ic, op, op->op_count);
  755. if (op->op_count == 0) {
  756. rds_ib_stats_inc(s_ib_tx_sg_mapping_failure);
  757. ret = -ENOMEM; /* XXX ? */
  758. goto out;
  759. }
  760. op->op_mapped = 1;
  761. }
  762. /*
  763. * Instead of knowing how to return a partial rdma read/write we insist that there
  764. * be enough work requests to send the entire message.
  765. */
  766. i = ceil(op->op_count, max_sge);
  767. work_alloc = rds_ib_ring_alloc(&ic->i_send_ring, i, &pos);
  768. if (work_alloc != i) {
  769. rds_ib_ring_unalloc(&ic->i_send_ring, work_alloc);
  770. rds_ib_stats_inc(s_ib_tx_ring_full);
  771. ret = -ENOMEM;
  772. goto out;
  773. }
  774. send = &ic->i_sends[pos];
  775. first = send;
  776. prev = NULL;
  777. scat = &op->op_sg[0];
  778. sent = 0;
  779. num_sge = op->op_count;
  780. for (i = 0; i < work_alloc && scat != &op->op_sg[op->op_count]; i++) {
  781. send->s_wr.send_flags = 0;
  782. send->s_queued = jiffies;
  783. send->s_op = NULL;
  784. nr_sig += rds_ib_set_wr_signal_state(ic, send, op->op_notify);
  785. send->s_wr.opcode = op->op_write ? IB_WR_RDMA_WRITE : IB_WR_RDMA_READ;
  786. send->s_rdma_wr.remote_addr = remote_addr;
  787. send->s_rdma_wr.rkey = op->op_rkey;
  788. if (num_sge > max_sge) {
  789. send->s_rdma_wr.wr.num_sge = max_sge;
  790. num_sge -= max_sge;
  791. } else {
  792. send->s_rdma_wr.wr.num_sge = num_sge;
  793. }
  794. send->s_rdma_wr.wr.next = NULL;
  795. if (prev)
  796. prev->s_rdma_wr.wr.next = &send->s_rdma_wr.wr;
  797. for (j = 0; j < send->s_rdma_wr.wr.num_sge &&
  798. scat != &op->op_sg[op->op_count]; j++) {
  799. len = ib_sg_dma_len(ic->i_cm_id->device, scat);
  800. send->s_sge[j].addr =
  801. ib_sg_dma_address(ic->i_cm_id->device, scat);
  802. send->s_sge[j].length = len;
  803. send->s_sge[j].lkey = ic->i_pd->local_dma_lkey;
  804. sent += len;
  805. rdsdebug("ic %p sent %d remote_addr %llu\n", ic, sent, remote_addr);
  806. remote_addr += len;
  807. scat++;
  808. }
  809. rdsdebug("send %p wr %p num_sge %u next %p\n", send,
  810. &send->s_rdma_wr.wr,
  811. send->s_rdma_wr.wr.num_sge,
  812. send->s_rdma_wr.wr.next);
  813. prev = send;
  814. if (++send == &ic->i_sends[ic->i_send_ring.w_nr])
  815. send = ic->i_sends;
  816. }
  817. /* give a reference to the last op */
  818. if (scat == &op->op_sg[op->op_count]) {
  819. prev->s_op = op;
  820. rds_message_addref(container_of(op, struct rds_message, rdma));
  821. }
  822. if (i < work_alloc) {
  823. rds_ib_ring_unalloc(&ic->i_send_ring, work_alloc - i);
  824. work_alloc = i;
  825. }
  826. if (nr_sig)
  827. atomic_add(nr_sig, &ic->i_signaled_sends);
  828. failed_wr = &first->s_rdma_wr.wr;
  829. ret = ib_post_send(ic->i_cm_id->qp, &first->s_rdma_wr.wr, &failed_wr);
  830. rdsdebug("ic %p first %p (wr %p) ret %d wr %p\n", ic,
  831. first, &first->s_rdma_wr.wr, ret, failed_wr);
  832. BUG_ON(failed_wr != &first->s_rdma_wr.wr);
  833. if (ret) {
  834. printk(KERN_WARNING "RDS/IB: rdma ib_post_send to %pI4 "
  835. "returned %d\n", &conn->c_faddr, ret);
  836. rds_ib_ring_unalloc(&ic->i_send_ring, work_alloc);
  837. rds_ib_sub_signaled(ic, nr_sig);
  838. goto out;
  839. }
  840. if (unlikely(failed_wr != &first->s_rdma_wr.wr)) {
  841. printk(KERN_WARNING "RDS/IB: ib_post_send() rc=%d, but failed_wqe updated!\n", ret);
  842. BUG_ON(failed_wr != &first->s_rdma_wr.wr);
  843. }
  844. out:
  845. return ret;
  846. }
  847. void rds_ib_xmit_complete(struct rds_connection *conn)
  848. {
  849. struct rds_ib_connection *ic = conn->c_transport_data;
  850. /* We may have a pending ACK or window update we were unable
  851. * to send previously (due to flow control). Try again. */
  852. rds_ib_attempt_ack(ic);
  853. }