iser_verbs.c 23 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838
  1. /*
  2. * Copyright (c) 2004, 2005, 2006 Voltaire, Inc. All rights reserved.
  3. * Copyright (c) 2005, 2006 Cisco Systems. All rights reserved.
  4. *
  5. * This software is available to you under a choice of one of two
  6. * licenses. You may choose to be licensed under the terms of the GNU
  7. * General Public License (GPL) Version 2, available from the file
  8. * COPYING in the main directory of this source tree, or the
  9. * OpenIB.org BSD license below:
  10. *
  11. * Redistribution and use in source and binary forms, with or
  12. * without modification, are permitted provided that the following
  13. * conditions are met:
  14. *
  15. * - Redistributions of source code must retain the above
  16. * copyright notice, this list of conditions and the following
  17. * disclaimer.
  18. *
  19. * - Redistributions in binary form must reproduce the above
  20. * copyright notice, this list of conditions and the following
  21. * disclaimer in the documentation and/or other materials
  22. * provided with the distribution.
  23. *
  24. * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
  25. * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
  26. * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
  27. * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
  28. * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
  29. * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
  30. * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
  31. * SOFTWARE.
  32. */
  33. #include <linux/kernel.h>
  34. #include <linux/module.h>
  35. #include <linux/slab.h>
  36. #include <linux/delay.h>
  37. #include "iscsi_iser.h"
  38. #define ISCSI_ISER_MAX_CONN 8
  39. #define ISER_MAX_RX_CQ_LEN (ISER_QP_MAX_RECV_DTOS * ISCSI_ISER_MAX_CONN)
  40. #define ISER_MAX_TX_CQ_LEN (ISER_QP_MAX_REQ_DTOS * ISCSI_ISER_MAX_CONN)
  41. static void iser_cq_tasklet_fn(unsigned long data);
  42. static void iser_cq_callback(struct ib_cq *cq, void *cq_context);
  43. static void iser_cq_event_callback(struct ib_event *cause, void *context)
  44. {
  45. iser_err("got cq event %d \n", cause->event);
  46. }
  47. static void iser_qp_event_callback(struct ib_event *cause, void *context)
  48. {
  49. iser_err("got qp event %d\n",cause->event);
  50. }
  51. static void iser_event_handler(struct ib_event_handler *handler,
  52. struct ib_event *event)
  53. {
  54. iser_err("async event %d on device %s port %d\n", event->event,
  55. event->device->name, event->element.port_num);
  56. }
  57. /**
  58. * iser_create_device_ib_res - creates Protection Domain (PD), Completion
  59. * Queue (CQ), DMA Memory Region (DMA MR) with the device associated with
  60. * the adapator.
  61. *
  62. * returns 0 on success, -1 on failure
  63. */
  64. static int iser_create_device_ib_res(struct iser_device *device)
  65. {
  66. device->pd = ib_alloc_pd(device->ib_device);
  67. if (IS_ERR(device->pd))
  68. goto pd_err;
  69. device->rx_cq = ib_create_cq(device->ib_device,
  70. iser_cq_callback,
  71. iser_cq_event_callback,
  72. (void *)device,
  73. ISER_MAX_RX_CQ_LEN, 0);
  74. if (IS_ERR(device->rx_cq))
  75. goto rx_cq_err;
  76. device->tx_cq = ib_create_cq(device->ib_device,
  77. NULL, iser_cq_event_callback,
  78. (void *)device,
  79. ISER_MAX_TX_CQ_LEN, 0);
  80. if (IS_ERR(device->tx_cq))
  81. goto tx_cq_err;
  82. if (ib_req_notify_cq(device->rx_cq, IB_CQ_NEXT_COMP))
  83. goto cq_arm_err;
  84. tasklet_init(&device->cq_tasklet,
  85. iser_cq_tasklet_fn,
  86. (unsigned long)device);
  87. device->mr = ib_get_dma_mr(device->pd, IB_ACCESS_LOCAL_WRITE |
  88. IB_ACCESS_REMOTE_WRITE |
  89. IB_ACCESS_REMOTE_READ);
  90. if (IS_ERR(device->mr))
  91. goto dma_mr_err;
  92. INIT_IB_EVENT_HANDLER(&device->event_handler, device->ib_device,
  93. iser_event_handler);
  94. if (ib_register_event_handler(&device->event_handler))
  95. goto handler_err;
  96. return 0;
  97. handler_err:
  98. ib_dereg_mr(device->mr);
  99. dma_mr_err:
  100. tasklet_kill(&device->cq_tasklet);
  101. cq_arm_err:
  102. ib_destroy_cq(device->tx_cq);
  103. tx_cq_err:
  104. ib_destroy_cq(device->rx_cq);
  105. rx_cq_err:
  106. ib_dealloc_pd(device->pd);
  107. pd_err:
  108. iser_err("failed to allocate an IB resource\n");
  109. return -1;
  110. }
  111. /**
  112. * iser_free_device_ib_res - destroy/dealloc/dereg the DMA MR,
  113. * CQ and PD created with the device associated with the adapator.
  114. */
  115. static void iser_free_device_ib_res(struct iser_device *device)
  116. {
  117. BUG_ON(device->mr == NULL);
  118. tasklet_kill(&device->cq_tasklet);
  119. (void)ib_unregister_event_handler(&device->event_handler);
  120. (void)ib_dereg_mr(device->mr);
  121. (void)ib_destroy_cq(device->tx_cq);
  122. (void)ib_destroy_cq(device->rx_cq);
  123. (void)ib_dealloc_pd(device->pd);
  124. device->mr = NULL;
  125. device->tx_cq = NULL;
  126. device->rx_cq = NULL;
  127. device->pd = NULL;
  128. }
  129. /**
  130. * iser_create_ib_conn_res - Creates FMR pool and Queue-Pair (QP)
  131. *
  132. * returns 0 on success, -1 on failure
  133. */
  134. static int iser_create_ib_conn_res(struct iser_conn *ib_conn)
  135. {
  136. struct iser_device *device;
  137. struct ib_qp_init_attr init_attr;
  138. int ret = -ENOMEM;
  139. struct ib_fmr_pool_param params;
  140. BUG_ON(ib_conn->device == NULL);
  141. device = ib_conn->device;
  142. ib_conn->login_buf = kmalloc(ISER_RX_LOGIN_SIZE, GFP_KERNEL);
  143. if (!ib_conn->login_buf)
  144. goto out_err;
  145. ib_conn->login_dma = ib_dma_map_single(ib_conn->device->ib_device,
  146. (void *)ib_conn->login_buf, ISER_RX_LOGIN_SIZE,
  147. DMA_FROM_DEVICE);
  148. ib_conn->page_vec = kmalloc(sizeof(struct iser_page_vec) +
  149. (sizeof(u64) * (ISCSI_ISER_SG_TABLESIZE +1)),
  150. GFP_KERNEL);
  151. if (!ib_conn->page_vec)
  152. goto out_err;
  153. ib_conn->page_vec->pages = (u64 *) (ib_conn->page_vec + 1);
  154. params.page_shift = SHIFT_4K;
  155. /* when the first/last SG element are not start/end *
  156. * page aligned, the map whould be of N+1 pages */
  157. params.max_pages_per_fmr = ISCSI_ISER_SG_TABLESIZE + 1;
  158. /* make the pool size twice the max number of SCSI commands *
  159. * the ML is expected to queue, watermark for unmap at 50% */
  160. params.pool_size = ISCSI_DEF_XMIT_CMDS_MAX * 2;
  161. params.dirty_watermark = ISCSI_DEF_XMIT_CMDS_MAX;
  162. params.cache = 0;
  163. params.flush_function = NULL;
  164. params.access = (IB_ACCESS_LOCAL_WRITE |
  165. IB_ACCESS_REMOTE_WRITE |
  166. IB_ACCESS_REMOTE_READ);
  167. ib_conn->fmr_pool = ib_create_fmr_pool(device->pd, &params);
  168. if (IS_ERR(ib_conn->fmr_pool)) {
  169. ret = PTR_ERR(ib_conn->fmr_pool);
  170. ib_conn->fmr_pool = NULL;
  171. goto out_err;
  172. }
  173. memset(&init_attr, 0, sizeof init_attr);
  174. init_attr.event_handler = iser_qp_event_callback;
  175. init_attr.qp_context = (void *)ib_conn;
  176. init_attr.send_cq = device->tx_cq;
  177. init_attr.recv_cq = device->rx_cq;
  178. init_attr.cap.max_send_wr = ISER_QP_MAX_REQ_DTOS;
  179. init_attr.cap.max_recv_wr = ISER_QP_MAX_RECV_DTOS;
  180. init_attr.cap.max_send_sge = 2;
  181. init_attr.cap.max_recv_sge = 1;
  182. init_attr.sq_sig_type = IB_SIGNAL_REQ_WR;
  183. init_attr.qp_type = IB_QPT_RC;
  184. ret = rdma_create_qp(ib_conn->cma_id, device->pd, &init_attr);
  185. if (ret)
  186. goto out_err;
  187. ib_conn->qp = ib_conn->cma_id->qp;
  188. iser_err("setting conn %p cma_id %p: fmr_pool %p qp %p\n",
  189. ib_conn, ib_conn->cma_id,
  190. ib_conn->fmr_pool, ib_conn->cma_id->qp);
  191. return ret;
  192. out_err:
  193. iser_err("unable to alloc mem or create resource, err %d\n", ret);
  194. return ret;
  195. }
  196. /**
  197. * releases the FMR pool, QP and CMA ID objects, returns 0 on success,
  198. * -1 on failure
  199. */
  200. static int iser_free_ib_conn_res(struct iser_conn *ib_conn, int can_destroy_id)
  201. {
  202. BUG_ON(ib_conn == NULL);
  203. iser_err("freeing conn %p cma_id %p fmr pool %p qp %p\n",
  204. ib_conn, ib_conn->cma_id,
  205. ib_conn->fmr_pool, ib_conn->qp);
  206. /* qp is created only once both addr & route are resolved */
  207. if (ib_conn->fmr_pool != NULL)
  208. ib_destroy_fmr_pool(ib_conn->fmr_pool);
  209. if (ib_conn->qp != NULL)
  210. rdma_destroy_qp(ib_conn->cma_id);
  211. /* if cma handler context, the caller acts s.t the cma destroy the id */
  212. if (ib_conn->cma_id != NULL && can_destroy_id)
  213. rdma_destroy_id(ib_conn->cma_id);
  214. ib_conn->fmr_pool = NULL;
  215. ib_conn->qp = NULL;
  216. ib_conn->cma_id = NULL;
  217. kfree(ib_conn->page_vec);
  218. return 0;
  219. }
  220. /**
  221. * based on the resolved device node GUID see if there already allocated
  222. * device for this device. If there's no such, create one.
  223. */
  224. static
  225. struct iser_device *iser_device_find_by_ib_device(struct rdma_cm_id *cma_id)
  226. {
  227. struct iser_device *device;
  228. mutex_lock(&ig.device_list_mutex);
  229. list_for_each_entry(device, &ig.device_list, ig_list)
  230. /* find if there's a match using the node GUID */
  231. if (device->ib_device->node_guid == cma_id->device->node_guid)
  232. goto inc_refcnt;
  233. device = kzalloc(sizeof *device, GFP_KERNEL);
  234. if (device == NULL)
  235. goto out;
  236. /* assign this device to the device */
  237. device->ib_device = cma_id->device;
  238. /* init the device and link it into ig device list */
  239. if (iser_create_device_ib_res(device)) {
  240. kfree(device);
  241. device = NULL;
  242. goto out;
  243. }
  244. list_add(&device->ig_list, &ig.device_list);
  245. inc_refcnt:
  246. device->refcount++;
  247. out:
  248. mutex_unlock(&ig.device_list_mutex);
  249. return device;
  250. }
  251. /* if there's no demand for this device, release it */
  252. static void iser_device_try_release(struct iser_device *device)
  253. {
  254. mutex_lock(&ig.device_list_mutex);
  255. device->refcount--;
  256. iser_err("device %p refcount %d\n",device,device->refcount);
  257. if (!device->refcount) {
  258. iser_free_device_ib_res(device);
  259. list_del(&device->ig_list);
  260. kfree(device);
  261. }
  262. mutex_unlock(&ig.device_list_mutex);
  263. }
  264. static int iser_conn_state_comp_exch(struct iser_conn *ib_conn,
  265. enum iser_ib_conn_state comp,
  266. enum iser_ib_conn_state exch)
  267. {
  268. int ret;
  269. spin_lock_bh(&ib_conn->lock);
  270. if ((ret = (ib_conn->state == comp)))
  271. ib_conn->state = exch;
  272. spin_unlock_bh(&ib_conn->lock);
  273. return ret;
  274. }
  275. /**
  276. * Frees all conn objects and deallocs conn descriptor
  277. */
  278. static void iser_conn_release(struct iser_conn *ib_conn, int can_destroy_id)
  279. {
  280. struct iser_device *device = ib_conn->device;
  281. BUG_ON(ib_conn->state != ISER_CONN_DOWN);
  282. mutex_lock(&ig.connlist_mutex);
  283. list_del(&ib_conn->conn_list);
  284. mutex_unlock(&ig.connlist_mutex);
  285. iser_free_rx_descriptors(ib_conn);
  286. iser_free_ib_conn_res(ib_conn, can_destroy_id);
  287. ib_conn->device = NULL;
  288. /* on EVENT_ADDR_ERROR there's no device yet for this conn */
  289. if (device != NULL)
  290. iser_device_try_release(device);
  291. iscsi_destroy_endpoint(ib_conn->ep);
  292. }
  293. void iser_conn_get(struct iser_conn *ib_conn)
  294. {
  295. atomic_inc(&ib_conn->refcount);
  296. }
  297. int iser_conn_put(struct iser_conn *ib_conn, int can_destroy_id)
  298. {
  299. if (atomic_dec_and_test(&ib_conn->refcount)) {
  300. iser_conn_release(ib_conn, can_destroy_id);
  301. return 1;
  302. }
  303. return 0;
  304. }
  305. /**
  306. * triggers start of the disconnect procedures and wait for them to be done
  307. */
  308. void iser_conn_terminate(struct iser_conn *ib_conn)
  309. {
  310. int err = 0;
  311. /* change the ib conn state only if the conn is UP, however always call
  312. * rdma_disconnect since this is the only way to cause the CMA to change
  313. * the QP state to ERROR
  314. */
  315. iser_conn_state_comp_exch(ib_conn, ISER_CONN_UP, ISER_CONN_TERMINATING);
  316. err = rdma_disconnect(ib_conn->cma_id);
  317. if (err)
  318. iser_err("Failed to disconnect, conn: 0x%p err %d\n",
  319. ib_conn,err);
  320. wait_event_interruptible(ib_conn->wait,
  321. ib_conn->state == ISER_CONN_DOWN);
  322. iser_conn_put(ib_conn, 1); /* deref ib conn deallocate */
  323. }
  324. static int iser_connect_error(struct rdma_cm_id *cma_id)
  325. {
  326. struct iser_conn *ib_conn;
  327. ib_conn = (struct iser_conn *)cma_id->context;
  328. ib_conn->state = ISER_CONN_DOWN;
  329. wake_up_interruptible(&ib_conn->wait);
  330. return iser_conn_put(ib_conn, 0); /* deref ib conn's cma id */
  331. }
  332. static int iser_addr_handler(struct rdma_cm_id *cma_id)
  333. {
  334. struct iser_device *device;
  335. struct iser_conn *ib_conn;
  336. int ret;
  337. device = iser_device_find_by_ib_device(cma_id);
  338. if (!device) {
  339. iser_err("device lookup/creation failed\n");
  340. return iser_connect_error(cma_id);
  341. }
  342. ib_conn = (struct iser_conn *)cma_id->context;
  343. ib_conn->device = device;
  344. ret = rdma_resolve_route(cma_id, 1000);
  345. if (ret) {
  346. iser_err("resolve route failed: %d\n", ret);
  347. return iser_connect_error(cma_id);
  348. }
  349. return 0;
  350. }
  351. static int iser_route_handler(struct rdma_cm_id *cma_id)
  352. {
  353. struct rdma_conn_param conn_param;
  354. int ret;
  355. ret = iser_create_ib_conn_res((struct iser_conn *)cma_id->context);
  356. if (ret)
  357. goto failure;
  358. memset(&conn_param, 0, sizeof conn_param);
  359. conn_param.responder_resources = 4;
  360. conn_param.initiator_depth = 1;
  361. conn_param.retry_count = 7;
  362. conn_param.rnr_retry_count = 6;
  363. ret = rdma_connect(cma_id, &conn_param);
  364. if (ret) {
  365. iser_err("failure connecting: %d\n", ret);
  366. goto failure;
  367. }
  368. return 0;
  369. failure:
  370. return iser_connect_error(cma_id);
  371. }
  372. static void iser_connected_handler(struct rdma_cm_id *cma_id)
  373. {
  374. struct iser_conn *ib_conn;
  375. ib_conn = (struct iser_conn *)cma_id->context;
  376. ib_conn->state = ISER_CONN_UP;
  377. wake_up_interruptible(&ib_conn->wait);
  378. }
  379. static int iser_disconnected_handler(struct rdma_cm_id *cma_id)
  380. {
  381. struct iser_conn *ib_conn;
  382. int ret;
  383. ib_conn = (struct iser_conn *)cma_id->context;
  384. /* getting here when the state is UP means that the conn is being *
  385. * terminated asynchronously from the iSCSI layer's perspective. */
  386. if (iser_conn_state_comp_exch(ib_conn, ISER_CONN_UP,
  387. ISER_CONN_TERMINATING))
  388. iscsi_conn_failure(ib_conn->iser_conn->iscsi_conn,
  389. ISCSI_ERR_CONN_FAILED);
  390. /* Complete the termination process if no posts are pending */
  391. if (ib_conn->post_recv_buf_count == 0 &&
  392. (atomic_read(&ib_conn->post_send_buf_count) == 0)) {
  393. ib_conn->state = ISER_CONN_DOWN;
  394. wake_up_interruptible(&ib_conn->wait);
  395. }
  396. ret = iser_conn_put(ib_conn, 0); /* deref ib conn's cma id */
  397. return ret;
  398. }
  399. static int iser_cma_handler(struct rdma_cm_id *cma_id, struct rdma_cm_event *event)
  400. {
  401. int ret = 0;
  402. iser_err("event %d status %d conn %p id %p\n",
  403. event->event, event->status, cma_id->context, cma_id);
  404. switch (event->event) {
  405. case RDMA_CM_EVENT_ADDR_RESOLVED:
  406. ret = iser_addr_handler(cma_id);
  407. break;
  408. case RDMA_CM_EVENT_ROUTE_RESOLVED:
  409. ret = iser_route_handler(cma_id);
  410. break;
  411. case RDMA_CM_EVENT_ESTABLISHED:
  412. iser_connected_handler(cma_id);
  413. break;
  414. case RDMA_CM_EVENT_ADDR_ERROR:
  415. case RDMA_CM_EVENT_ROUTE_ERROR:
  416. case RDMA_CM_EVENT_CONNECT_ERROR:
  417. case RDMA_CM_EVENT_UNREACHABLE:
  418. case RDMA_CM_EVENT_REJECTED:
  419. ret = iser_connect_error(cma_id);
  420. break;
  421. case RDMA_CM_EVENT_DISCONNECTED:
  422. case RDMA_CM_EVENT_DEVICE_REMOVAL:
  423. case RDMA_CM_EVENT_ADDR_CHANGE:
  424. ret = iser_disconnected_handler(cma_id);
  425. break;
  426. default:
  427. iser_err("Unexpected RDMA CM event (%d)\n", event->event);
  428. break;
  429. }
  430. return ret;
  431. }
  432. void iser_conn_init(struct iser_conn *ib_conn)
  433. {
  434. ib_conn->state = ISER_CONN_INIT;
  435. init_waitqueue_head(&ib_conn->wait);
  436. ib_conn->post_recv_buf_count = 0;
  437. atomic_set(&ib_conn->post_send_buf_count, 0);
  438. atomic_set(&ib_conn->refcount, 1); /* ref ib conn allocation */
  439. INIT_LIST_HEAD(&ib_conn->conn_list);
  440. spin_lock_init(&ib_conn->lock);
  441. }
  442. /**
  443. * starts the process of connecting to the target
  444. * sleeps until the connection is established or rejected
  445. */
  446. int iser_connect(struct iser_conn *ib_conn,
  447. struct sockaddr_in *src_addr,
  448. struct sockaddr_in *dst_addr,
  449. int non_blocking)
  450. {
  451. struct sockaddr *src, *dst;
  452. int err = 0;
  453. sprintf(ib_conn->name, "%pI4:%d",
  454. &dst_addr->sin_addr.s_addr, dst_addr->sin_port);
  455. /* the device is known only --after-- address resolution */
  456. ib_conn->device = NULL;
  457. iser_err("connecting to: %pI4, port 0x%x\n",
  458. &dst_addr->sin_addr, dst_addr->sin_port);
  459. ib_conn->state = ISER_CONN_PENDING;
  460. iser_conn_get(ib_conn); /* ref ib conn's cma id */
  461. ib_conn->cma_id = rdma_create_id(iser_cma_handler,
  462. (void *)ib_conn,
  463. RDMA_PS_TCP, IB_QPT_RC);
  464. if (IS_ERR(ib_conn->cma_id)) {
  465. err = PTR_ERR(ib_conn->cma_id);
  466. iser_err("rdma_create_id failed: %d\n", err);
  467. goto id_failure;
  468. }
  469. src = (struct sockaddr *)src_addr;
  470. dst = (struct sockaddr *)dst_addr;
  471. err = rdma_resolve_addr(ib_conn->cma_id, src, dst, 1000);
  472. if (err) {
  473. iser_err("rdma_resolve_addr failed: %d\n", err);
  474. goto addr_failure;
  475. }
  476. if (!non_blocking) {
  477. wait_event_interruptible(ib_conn->wait,
  478. (ib_conn->state != ISER_CONN_PENDING));
  479. if (ib_conn->state != ISER_CONN_UP) {
  480. err = -EIO;
  481. goto connect_failure;
  482. }
  483. }
  484. mutex_lock(&ig.connlist_mutex);
  485. list_add(&ib_conn->conn_list, &ig.connlist);
  486. mutex_unlock(&ig.connlist_mutex);
  487. return 0;
  488. id_failure:
  489. ib_conn->cma_id = NULL;
  490. addr_failure:
  491. ib_conn->state = ISER_CONN_DOWN;
  492. connect_failure:
  493. iser_conn_release(ib_conn, 1);
  494. return err;
  495. }
  496. /**
  497. * iser_reg_page_vec - Register physical memory
  498. *
  499. * returns: 0 on success, errno code on failure
  500. */
  501. int iser_reg_page_vec(struct iser_conn *ib_conn,
  502. struct iser_page_vec *page_vec,
  503. struct iser_mem_reg *mem_reg)
  504. {
  505. struct ib_pool_fmr *mem;
  506. u64 io_addr;
  507. u64 *page_list;
  508. int status;
  509. page_list = page_vec->pages;
  510. io_addr = page_list[0];
  511. mem = ib_fmr_pool_map_phys(ib_conn->fmr_pool,
  512. page_list,
  513. page_vec->length,
  514. io_addr);
  515. if (IS_ERR(mem)) {
  516. status = (int)PTR_ERR(mem);
  517. iser_err("ib_fmr_pool_map_phys failed: %d\n", status);
  518. return status;
  519. }
  520. mem_reg->lkey = mem->fmr->lkey;
  521. mem_reg->rkey = mem->fmr->rkey;
  522. mem_reg->len = page_vec->length * SIZE_4K;
  523. mem_reg->va = io_addr;
  524. mem_reg->is_fmr = 1;
  525. mem_reg->mem_h = (void *)mem;
  526. mem_reg->va += page_vec->offset;
  527. mem_reg->len = page_vec->data_size;
  528. iser_dbg("PHYSICAL Mem.register, [PHYS p_array: 0x%p, sz: %d, "
  529. "entry[0]: (0x%08lx,%ld)] -> "
  530. "[lkey: 0x%08X mem_h: 0x%p va: 0x%08lX sz: %ld]\n",
  531. page_vec, page_vec->length,
  532. (unsigned long)page_vec->pages[0],
  533. (unsigned long)page_vec->data_size,
  534. (unsigned int)mem_reg->lkey, mem_reg->mem_h,
  535. (unsigned long)mem_reg->va, (unsigned long)mem_reg->len);
  536. return 0;
  537. }
  538. /**
  539. * Unregister (previosuly registered) memory.
  540. */
  541. void iser_unreg_mem(struct iser_mem_reg *reg)
  542. {
  543. int ret;
  544. iser_dbg("PHYSICAL Mem.Unregister mem_h %p\n",reg->mem_h);
  545. ret = ib_fmr_pool_unmap((struct ib_pool_fmr *)reg->mem_h);
  546. if (ret)
  547. iser_err("ib_fmr_pool_unmap failed %d\n", ret);
  548. reg->mem_h = NULL;
  549. }
  550. int iser_post_recvl(struct iser_conn *ib_conn)
  551. {
  552. struct ib_recv_wr rx_wr, *rx_wr_failed;
  553. struct ib_sge sge;
  554. int ib_ret;
  555. sge.addr = ib_conn->login_dma;
  556. sge.length = ISER_RX_LOGIN_SIZE;
  557. sge.lkey = ib_conn->device->mr->lkey;
  558. rx_wr.wr_id = (unsigned long)ib_conn->login_buf;
  559. rx_wr.sg_list = &sge;
  560. rx_wr.num_sge = 1;
  561. rx_wr.next = NULL;
  562. ib_conn->post_recv_buf_count++;
  563. ib_ret = ib_post_recv(ib_conn->qp, &rx_wr, &rx_wr_failed);
  564. if (ib_ret) {
  565. iser_err("ib_post_recv failed ret=%d\n", ib_ret);
  566. ib_conn->post_recv_buf_count--;
  567. }
  568. return ib_ret;
  569. }
  570. int iser_post_recvm(struct iser_conn *ib_conn, int count)
  571. {
  572. struct ib_recv_wr *rx_wr, *rx_wr_failed;
  573. int i, ib_ret;
  574. unsigned int my_rx_head = ib_conn->rx_desc_head;
  575. struct iser_rx_desc *rx_desc;
  576. for (rx_wr = ib_conn->rx_wr, i = 0; i < count; i++, rx_wr++) {
  577. rx_desc = &ib_conn->rx_descs[my_rx_head];
  578. rx_wr->wr_id = (unsigned long)rx_desc;
  579. rx_wr->sg_list = &rx_desc->rx_sg;
  580. rx_wr->num_sge = 1;
  581. rx_wr->next = rx_wr + 1;
  582. my_rx_head = (my_rx_head + 1) & (ISER_QP_MAX_RECV_DTOS - 1);
  583. }
  584. rx_wr--;
  585. rx_wr->next = NULL; /* mark end of work requests list */
  586. ib_conn->post_recv_buf_count += count;
  587. ib_ret = ib_post_recv(ib_conn->qp, ib_conn->rx_wr, &rx_wr_failed);
  588. if (ib_ret) {
  589. iser_err("ib_post_recv failed ret=%d\n", ib_ret);
  590. ib_conn->post_recv_buf_count -= count;
  591. } else
  592. ib_conn->rx_desc_head = my_rx_head;
  593. return ib_ret;
  594. }
  595. /**
  596. * iser_start_send - Initiate a Send DTO operation
  597. *
  598. * returns 0 on success, -1 on failure
  599. */
  600. int iser_post_send(struct iser_conn *ib_conn, struct iser_tx_desc *tx_desc)
  601. {
  602. int ib_ret;
  603. struct ib_send_wr send_wr, *send_wr_failed;
  604. ib_dma_sync_single_for_device(ib_conn->device->ib_device,
  605. tx_desc->dma_addr, ISER_HEADERS_LEN, DMA_TO_DEVICE);
  606. send_wr.next = NULL;
  607. send_wr.wr_id = (unsigned long)tx_desc;
  608. send_wr.sg_list = tx_desc->tx_sg;
  609. send_wr.num_sge = tx_desc->num_sge;
  610. send_wr.opcode = IB_WR_SEND;
  611. send_wr.send_flags = IB_SEND_SIGNALED;
  612. atomic_inc(&ib_conn->post_send_buf_count);
  613. ib_ret = ib_post_send(ib_conn->qp, &send_wr, &send_wr_failed);
  614. if (ib_ret) {
  615. iser_err("ib_post_send failed, ret:%d\n", ib_ret);
  616. atomic_dec(&ib_conn->post_send_buf_count);
  617. }
  618. return ib_ret;
  619. }
  620. static void iser_handle_comp_error(struct iser_tx_desc *desc,
  621. struct iser_conn *ib_conn)
  622. {
  623. if (desc && desc->type == ISCSI_TX_DATAOUT)
  624. kmem_cache_free(ig.desc_cache, desc);
  625. if (ib_conn->post_recv_buf_count == 0 &&
  626. atomic_read(&ib_conn->post_send_buf_count) == 0) {
  627. /* getting here when the state is UP means that the conn is *
  628. * being terminated asynchronously from the iSCSI layer's *
  629. * perspective. */
  630. if (iser_conn_state_comp_exch(ib_conn, ISER_CONN_UP,
  631. ISER_CONN_TERMINATING))
  632. iscsi_conn_failure(ib_conn->iser_conn->iscsi_conn,
  633. ISCSI_ERR_CONN_FAILED);
  634. /* no more non completed posts to the QP, complete the
  635. * termination process w.o worrying on disconnect event */
  636. ib_conn->state = ISER_CONN_DOWN;
  637. wake_up_interruptible(&ib_conn->wait);
  638. }
  639. }
  640. static int iser_drain_tx_cq(struct iser_device *device)
  641. {
  642. struct ib_cq *cq = device->tx_cq;
  643. struct ib_wc wc;
  644. struct iser_tx_desc *tx_desc;
  645. struct iser_conn *ib_conn;
  646. int completed_tx = 0;
  647. while (ib_poll_cq(cq, 1, &wc) == 1) {
  648. tx_desc = (struct iser_tx_desc *) (unsigned long) wc.wr_id;
  649. ib_conn = wc.qp->qp_context;
  650. if (wc.status == IB_WC_SUCCESS) {
  651. if (wc.opcode == IB_WC_SEND)
  652. iser_snd_completion(tx_desc, ib_conn);
  653. else
  654. iser_err("expected opcode %d got %d\n",
  655. IB_WC_SEND, wc.opcode);
  656. } else {
  657. iser_err("tx id %llx status %d vend_err %x\n",
  658. wc.wr_id, wc.status, wc.vendor_err);
  659. atomic_dec(&ib_conn->post_send_buf_count);
  660. iser_handle_comp_error(tx_desc, ib_conn);
  661. }
  662. completed_tx++;
  663. }
  664. return completed_tx;
  665. }
  666. static void iser_cq_tasklet_fn(unsigned long data)
  667. {
  668. struct iser_device *device = (struct iser_device *)data;
  669. struct ib_cq *cq = device->rx_cq;
  670. struct ib_wc wc;
  671. struct iser_rx_desc *desc;
  672. unsigned long xfer_len;
  673. struct iser_conn *ib_conn;
  674. int completed_tx, completed_rx;
  675. completed_tx = completed_rx = 0;
  676. while (ib_poll_cq(cq, 1, &wc) == 1) {
  677. desc = (struct iser_rx_desc *) (unsigned long) wc.wr_id;
  678. BUG_ON(desc == NULL);
  679. ib_conn = wc.qp->qp_context;
  680. if (wc.status == IB_WC_SUCCESS) {
  681. if (wc.opcode == IB_WC_RECV) {
  682. xfer_len = (unsigned long)wc.byte_len;
  683. iser_rcv_completion(desc, xfer_len, ib_conn);
  684. } else
  685. iser_err("expected opcode %d got %d\n",
  686. IB_WC_RECV, wc.opcode);
  687. } else {
  688. if (wc.status != IB_WC_WR_FLUSH_ERR)
  689. iser_err("rx id %llx status %d vend_err %x\n",
  690. wc.wr_id, wc.status, wc.vendor_err);
  691. ib_conn->post_recv_buf_count--;
  692. iser_handle_comp_error(NULL, ib_conn);
  693. }
  694. completed_rx++;
  695. if (!(completed_rx & 63))
  696. completed_tx += iser_drain_tx_cq(device);
  697. }
  698. /* #warning "it is assumed here that arming CQ only once its empty" *
  699. * " would not cause interrupts to be missed" */
  700. ib_req_notify_cq(cq, IB_CQ_NEXT_COMP);
  701. completed_tx += iser_drain_tx_cq(device);
  702. iser_dbg("got %d rx %d tx completions\n", completed_rx, completed_tx);
  703. }
  704. static void iser_cq_callback(struct ib_cq *cq, void *cq_context)
  705. {
  706. struct iser_device *device = (struct iser_device *)cq_context;
  707. tasklet_schedule(&device->cq_tasklet);
  708. }