ib_srp.c 57 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903190419051906190719081909191019111912191319141915191619171918191919201921192219231924192519261927192819291930193119321933193419351936193719381939194019411942194319441945194619471948194919501951195219531954195519561957195819591960196119621963196419651966196719681969197019711972197319741975197619771978197919801981198219831984198519861987198819891990199119921993199419951996199719981999200020012002200320042005200620072008200920102011201220132014201520162017201820192020202120222023202420252026202720282029203020312032203320342035203620372038203920402041204220432044204520462047204820492050205120522053205420552056205720582059206020612062206320642065206620672068206920702071207220732074207520762077207820792080208120822083208420852086208720882089209020912092209320942095209620972098209921002101210221032104210521062107210821092110211121122113211421152116211721182119212021212122212321242125212621272128212921302131213221332134213521362137213821392140214121422143214421452146214721482149215021512152215321542155215621572158215921602161216221632164216521662167216821692170217121722173217421752176217721782179218021812182218321842185218621872188218921902191219221932194219521962197219821992200220122022203220422052206220722082209221022112212221322142215221622172218221922202221222222232224222522262227222822292230223122322233223422352236223722382239224022412242224322442245224622472248224922502251225222532254225522562257225822592260226122622263
  1. /*
  2. * Copyright (c) 2005 Cisco Systems. 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/module.h>
  33. #include <linux/init.h>
  34. #include <linux/slab.h>
  35. #include <linux/err.h>
  36. #include <linux/string.h>
  37. #include <linux/parser.h>
  38. #include <linux/random.h>
  39. #include <linux/jiffies.h>
  40. #include <asm/atomic.h>
  41. #include <scsi/scsi.h>
  42. #include <scsi/scsi_device.h>
  43. #include <scsi/scsi_dbg.h>
  44. #include <scsi/srp.h>
  45. #include <scsi/scsi_transport_srp.h>
  46. #include "ib_srp.h"
  47. #define DRV_NAME "ib_srp"
  48. #define PFX DRV_NAME ": "
  49. #define DRV_VERSION "0.2"
  50. #define DRV_RELDATE "November 1, 2005"
  51. MODULE_AUTHOR("Roland Dreier");
  52. MODULE_DESCRIPTION("InfiniBand SCSI RDMA Protocol initiator "
  53. "v" DRV_VERSION " (" DRV_RELDATE ")");
  54. MODULE_LICENSE("Dual BSD/GPL");
  55. static int srp_sg_tablesize = SRP_DEF_SG_TABLESIZE;
  56. static int srp_max_iu_len;
  57. module_param(srp_sg_tablesize, int, 0444);
  58. MODULE_PARM_DESC(srp_sg_tablesize,
  59. "Max number of gather/scatter entries per I/O (default is 12, max 255)");
  60. static int topspin_workarounds = 1;
  61. module_param(topspin_workarounds, int, 0444);
  62. MODULE_PARM_DESC(topspin_workarounds,
  63. "Enable workarounds for Topspin/Cisco SRP target bugs if != 0");
  64. static void srp_add_one(struct ib_device *device);
  65. static void srp_remove_one(struct ib_device *device);
  66. static void srp_recv_completion(struct ib_cq *cq, void *target_ptr);
  67. static void srp_send_completion(struct ib_cq *cq, void *target_ptr);
  68. static int srp_cm_handler(struct ib_cm_id *cm_id, struct ib_cm_event *event);
  69. static struct scsi_transport_template *ib_srp_transport_template;
  70. static struct ib_client srp_client = {
  71. .name = "srp",
  72. .add = srp_add_one,
  73. .remove = srp_remove_one
  74. };
  75. static struct ib_sa_client srp_sa_client;
  76. static inline struct srp_target_port *host_to_target(struct Scsi_Host *host)
  77. {
  78. return (struct srp_target_port *) host->hostdata;
  79. }
  80. static const char *srp_target_info(struct Scsi_Host *host)
  81. {
  82. return host_to_target(host)->target_name;
  83. }
  84. static int srp_target_is_topspin(struct srp_target_port *target)
  85. {
  86. static const u8 topspin_oui[3] = { 0x00, 0x05, 0xad };
  87. static const u8 cisco_oui[3] = { 0x00, 0x1b, 0x0d };
  88. return topspin_workarounds &&
  89. (!memcmp(&target->ioc_guid, topspin_oui, sizeof topspin_oui) ||
  90. !memcmp(&target->ioc_guid, cisco_oui, sizeof cisco_oui));
  91. }
  92. static struct srp_iu *srp_alloc_iu(struct srp_host *host, size_t size,
  93. gfp_t gfp_mask,
  94. enum dma_data_direction direction)
  95. {
  96. struct srp_iu *iu;
  97. iu = kmalloc(sizeof *iu, gfp_mask);
  98. if (!iu)
  99. goto out;
  100. iu->buf = kzalloc(size, gfp_mask);
  101. if (!iu->buf)
  102. goto out_free_iu;
  103. iu->dma = ib_dma_map_single(host->srp_dev->dev, iu->buf, size,
  104. direction);
  105. if (ib_dma_mapping_error(host->srp_dev->dev, iu->dma))
  106. goto out_free_buf;
  107. iu->size = size;
  108. iu->direction = direction;
  109. return iu;
  110. out_free_buf:
  111. kfree(iu->buf);
  112. out_free_iu:
  113. kfree(iu);
  114. out:
  115. return NULL;
  116. }
  117. static void srp_free_iu(struct srp_host *host, struct srp_iu *iu)
  118. {
  119. if (!iu)
  120. return;
  121. ib_dma_unmap_single(host->srp_dev->dev, iu->dma, iu->size,
  122. iu->direction);
  123. kfree(iu->buf);
  124. kfree(iu);
  125. }
  126. static void srp_qp_event(struct ib_event *event, void *context)
  127. {
  128. printk(KERN_ERR PFX "QP event %d\n", event->event);
  129. }
  130. static int srp_init_qp(struct srp_target_port *target,
  131. struct ib_qp *qp)
  132. {
  133. struct ib_qp_attr *attr;
  134. int ret;
  135. attr = kmalloc(sizeof *attr, GFP_KERNEL);
  136. if (!attr)
  137. return -ENOMEM;
  138. ret = ib_find_pkey(target->srp_host->srp_dev->dev,
  139. target->srp_host->port,
  140. be16_to_cpu(target->path.pkey),
  141. &attr->pkey_index);
  142. if (ret)
  143. goto out;
  144. attr->qp_state = IB_QPS_INIT;
  145. attr->qp_access_flags = (IB_ACCESS_REMOTE_READ |
  146. IB_ACCESS_REMOTE_WRITE);
  147. attr->port_num = target->srp_host->port;
  148. ret = ib_modify_qp(qp, attr,
  149. IB_QP_STATE |
  150. IB_QP_PKEY_INDEX |
  151. IB_QP_ACCESS_FLAGS |
  152. IB_QP_PORT);
  153. out:
  154. kfree(attr);
  155. return ret;
  156. }
  157. static int srp_new_cm_id(struct srp_target_port *target)
  158. {
  159. struct ib_cm_id *new_cm_id;
  160. new_cm_id = ib_create_cm_id(target->srp_host->srp_dev->dev,
  161. srp_cm_handler, target);
  162. if (IS_ERR(new_cm_id))
  163. return PTR_ERR(new_cm_id);
  164. if (target->cm_id)
  165. ib_destroy_cm_id(target->cm_id);
  166. target->cm_id = new_cm_id;
  167. return 0;
  168. }
  169. static int srp_create_target_ib(struct srp_target_port *target)
  170. {
  171. struct ib_qp_init_attr *init_attr;
  172. int ret;
  173. init_attr = kzalloc(sizeof *init_attr, GFP_KERNEL);
  174. if (!init_attr)
  175. return -ENOMEM;
  176. target->recv_cq = ib_create_cq(target->srp_host->srp_dev->dev,
  177. srp_recv_completion, NULL, target, SRP_RQ_SIZE, 0);
  178. if (IS_ERR(target->recv_cq)) {
  179. ret = PTR_ERR(target->recv_cq);
  180. goto err;
  181. }
  182. target->send_cq = ib_create_cq(target->srp_host->srp_dev->dev,
  183. srp_send_completion, NULL, target, SRP_SQ_SIZE, 0);
  184. if (IS_ERR(target->send_cq)) {
  185. ret = PTR_ERR(target->send_cq);
  186. goto err_recv_cq;
  187. }
  188. ib_req_notify_cq(target->recv_cq, IB_CQ_NEXT_COMP);
  189. init_attr->event_handler = srp_qp_event;
  190. init_attr->cap.max_send_wr = SRP_SQ_SIZE;
  191. init_attr->cap.max_recv_wr = SRP_RQ_SIZE;
  192. init_attr->cap.max_recv_sge = 1;
  193. init_attr->cap.max_send_sge = 1;
  194. init_attr->sq_sig_type = IB_SIGNAL_ALL_WR;
  195. init_attr->qp_type = IB_QPT_RC;
  196. init_attr->send_cq = target->send_cq;
  197. init_attr->recv_cq = target->recv_cq;
  198. target->qp = ib_create_qp(target->srp_host->srp_dev->pd, init_attr);
  199. if (IS_ERR(target->qp)) {
  200. ret = PTR_ERR(target->qp);
  201. goto err_send_cq;
  202. }
  203. ret = srp_init_qp(target, target->qp);
  204. if (ret)
  205. goto err_qp;
  206. kfree(init_attr);
  207. return 0;
  208. err_qp:
  209. ib_destroy_qp(target->qp);
  210. err_send_cq:
  211. ib_destroy_cq(target->send_cq);
  212. err_recv_cq:
  213. ib_destroy_cq(target->recv_cq);
  214. err:
  215. kfree(init_attr);
  216. return ret;
  217. }
  218. static void srp_free_target_ib(struct srp_target_port *target)
  219. {
  220. int i;
  221. ib_destroy_qp(target->qp);
  222. ib_destroy_cq(target->send_cq);
  223. ib_destroy_cq(target->recv_cq);
  224. for (i = 0; i < SRP_RQ_SIZE; ++i)
  225. srp_free_iu(target->srp_host, target->rx_ring[i]);
  226. for (i = 0; i < SRP_SQ_SIZE; ++i)
  227. srp_free_iu(target->srp_host, target->tx_ring[i]);
  228. }
  229. static void srp_path_rec_completion(int status,
  230. struct ib_sa_path_rec *pathrec,
  231. void *target_ptr)
  232. {
  233. struct srp_target_port *target = target_ptr;
  234. target->status = status;
  235. if (status)
  236. shost_printk(KERN_ERR, target->scsi_host,
  237. PFX "Got failed path rec status %d\n", status);
  238. else
  239. target->path = *pathrec;
  240. complete(&target->done);
  241. }
  242. static int srp_lookup_path(struct srp_target_port *target)
  243. {
  244. target->path.numb_path = 1;
  245. init_completion(&target->done);
  246. target->path_query_id = ib_sa_path_rec_get(&srp_sa_client,
  247. target->srp_host->srp_dev->dev,
  248. target->srp_host->port,
  249. &target->path,
  250. IB_SA_PATH_REC_SERVICE_ID |
  251. IB_SA_PATH_REC_DGID |
  252. IB_SA_PATH_REC_SGID |
  253. IB_SA_PATH_REC_NUMB_PATH |
  254. IB_SA_PATH_REC_PKEY,
  255. SRP_PATH_REC_TIMEOUT_MS,
  256. GFP_KERNEL,
  257. srp_path_rec_completion,
  258. target, &target->path_query);
  259. if (target->path_query_id < 0)
  260. return target->path_query_id;
  261. wait_for_completion(&target->done);
  262. if (target->status < 0)
  263. shost_printk(KERN_WARNING, target->scsi_host,
  264. PFX "Path record query failed\n");
  265. return target->status;
  266. }
  267. static int srp_send_req(struct srp_target_port *target)
  268. {
  269. struct {
  270. struct ib_cm_req_param param;
  271. struct srp_login_req priv;
  272. } *req = NULL;
  273. int status;
  274. req = kzalloc(sizeof *req, GFP_KERNEL);
  275. if (!req)
  276. return -ENOMEM;
  277. req->param.primary_path = &target->path;
  278. req->param.alternate_path = NULL;
  279. req->param.service_id = target->service_id;
  280. req->param.qp_num = target->qp->qp_num;
  281. req->param.qp_type = target->qp->qp_type;
  282. req->param.private_data = &req->priv;
  283. req->param.private_data_len = sizeof req->priv;
  284. req->param.flow_control = 1;
  285. get_random_bytes(&req->param.starting_psn, 4);
  286. req->param.starting_psn &= 0xffffff;
  287. /*
  288. * Pick some arbitrary defaults here; we could make these
  289. * module parameters if anyone cared about setting them.
  290. */
  291. req->param.responder_resources = 4;
  292. req->param.remote_cm_response_timeout = 20;
  293. req->param.local_cm_response_timeout = 20;
  294. req->param.retry_count = 7;
  295. req->param.rnr_retry_count = 7;
  296. req->param.max_cm_retries = 15;
  297. req->priv.opcode = SRP_LOGIN_REQ;
  298. req->priv.tag = 0;
  299. req->priv.req_it_iu_len = cpu_to_be32(srp_max_iu_len);
  300. req->priv.req_buf_fmt = cpu_to_be16(SRP_BUF_FORMAT_DIRECT |
  301. SRP_BUF_FORMAT_INDIRECT);
  302. /*
  303. * In the published SRP specification (draft rev. 16a), the
  304. * port identifier format is 8 bytes of ID extension followed
  305. * by 8 bytes of GUID. Older drafts put the two halves in the
  306. * opposite order, so that the GUID comes first.
  307. *
  308. * Targets conforming to these obsolete drafts can be
  309. * recognized by the I/O Class they report.
  310. */
  311. if (target->io_class == SRP_REV10_IB_IO_CLASS) {
  312. memcpy(req->priv.initiator_port_id,
  313. &target->path.sgid.global.interface_id, 8);
  314. memcpy(req->priv.initiator_port_id + 8,
  315. &target->initiator_ext, 8);
  316. memcpy(req->priv.target_port_id, &target->ioc_guid, 8);
  317. memcpy(req->priv.target_port_id + 8, &target->id_ext, 8);
  318. } else {
  319. memcpy(req->priv.initiator_port_id,
  320. &target->initiator_ext, 8);
  321. memcpy(req->priv.initiator_port_id + 8,
  322. &target->path.sgid.global.interface_id, 8);
  323. memcpy(req->priv.target_port_id, &target->id_ext, 8);
  324. memcpy(req->priv.target_port_id + 8, &target->ioc_guid, 8);
  325. }
  326. /*
  327. * Topspin/Cisco SRP targets will reject our login unless we
  328. * zero out the first 8 bytes of our initiator port ID and set
  329. * the second 8 bytes to the local node GUID.
  330. */
  331. if (srp_target_is_topspin(target)) {
  332. shost_printk(KERN_DEBUG, target->scsi_host,
  333. PFX "Topspin/Cisco initiator port ID workaround "
  334. "activated for target GUID %016llx\n",
  335. (unsigned long long) be64_to_cpu(target->ioc_guid));
  336. memset(req->priv.initiator_port_id, 0, 8);
  337. memcpy(req->priv.initiator_port_id + 8,
  338. &target->srp_host->srp_dev->dev->node_guid, 8);
  339. }
  340. status = ib_send_cm_req(target->cm_id, &req->param);
  341. kfree(req);
  342. return status;
  343. }
  344. static void srp_disconnect_target(struct srp_target_port *target)
  345. {
  346. /* XXX should send SRP_I_LOGOUT request */
  347. init_completion(&target->done);
  348. if (ib_send_cm_dreq(target->cm_id, NULL, 0)) {
  349. shost_printk(KERN_DEBUG, target->scsi_host,
  350. PFX "Sending CM DREQ failed\n");
  351. return;
  352. }
  353. wait_for_completion(&target->done);
  354. }
  355. static bool srp_change_state(struct srp_target_port *target,
  356. enum srp_target_state old,
  357. enum srp_target_state new)
  358. {
  359. bool changed = false;
  360. spin_lock_irq(&target->lock);
  361. if (target->state == old) {
  362. target->state = new;
  363. changed = true;
  364. }
  365. spin_unlock_irq(&target->lock);
  366. return changed;
  367. }
  368. static void srp_remove_work(struct work_struct *work)
  369. {
  370. struct srp_target_port *target =
  371. container_of(work, struct srp_target_port, work);
  372. if (!srp_change_state(target, SRP_TARGET_DEAD, SRP_TARGET_REMOVED))
  373. return;
  374. spin_lock(&target->srp_host->target_lock);
  375. list_del(&target->list);
  376. spin_unlock(&target->srp_host->target_lock);
  377. srp_remove_host(target->scsi_host);
  378. scsi_remove_host(target->scsi_host);
  379. ib_destroy_cm_id(target->cm_id);
  380. srp_free_target_ib(target);
  381. scsi_host_put(target->scsi_host);
  382. }
  383. static int srp_connect_target(struct srp_target_port *target)
  384. {
  385. int retries = 3;
  386. int ret;
  387. ret = srp_lookup_path(target);
  388. if (ret)
  389. return ret;
  390. while (1) {
  391. init_completion(&target->done);
  392. ret = srp_send_req(target);
  393. if (ret)
  394. return ret;
  395. wait_for_completion(&target->done);
  396. /*
  397. * The CM event handling code will set status to
  398. * SRP_PORT_REDIRECT if we get a port redirect REJ
  399. * back, or SRP_DLID_REDIRECT if we get a lid/qp
  400. * redirect REJ back.
  401. */
  402. switch (target->status) {
  403. case 0:
  404. return 0;
  405. case SRP_PORT_REDIRECT:
  406. ret = srp_lookup_path(target);
  407. if (ret)
  408. return ret;
  409. break;
  410. case SRP_DLID_REDIRECT:
  411. break;
  412. case SRP_STALE_CONN:
  413. /* Our current CM id was stale, and is now in timewait.
  414. * Try to reconnect with a new one.
  415. */
  416. if (!retries-- || srp_new_cm_id(target)) {
  417. shost_printk(KERN_ERR, target->scsi_host, PFX
  418. "giving up on stale connection\n");
  419. target->status = -ECONNRESET;
  420. return target->status;
  421. }
  422. shost_printk(KERN_ERR, target->scsi_host, PFX
  423. "retrying stale connection\n");
  424. break;
  425. default:
  426. return target->status;
  427. }
  428. }
  429. }
  430. static void srp_unmap_data(struct scsi_cmnd *scmnd,
  431. struct srp_target_port *target,
  432. struct srp_request *req)
  433. {
  434. if (!scsi_sglist(scmnd) ||
  435. (scmnd->sc_data_direction != DMA_TO_DEVICE &&
  436. scmnd->sc_data_direction != DMA_FROM_DEVICE))
  437. return;
  438. if (req->fmr) {
  439. ib_fmr_pool_unmap(req->fmr);
  440. req->fmr = NULL;
  441. }
  442. ib_dma_unmap_sg(target->srp_host->srp_dev->dev, scsi_sglist(scmnd),
  443. scsi_sg_count(scmnd), scmnd->sc_data_direction);
  444. }
  445. static void srp_remove_req(struct srp_target_port *target,
  446. struct srp_request *req, s32 req_lim_delta)
  447. {
  448. unsigned long flags;
  449. srp_unmap_data(req->scmnd, target, req);
  450. spin_lock_irqsave(&target->lock, flags);
  451. target->req_lim += req_lim_delta;
  452. req->scmnd = NULL;
  453. list_add_tail(&req->list, &target->free_reqs);
  454. spin_unlock_irqrestore(&target->lock, flags);
  455. }
  456. static void srp_reset_req(struct srp_target_port *target, struct srp_request *req)
  457. {
  458. req->scmnd->result = DID_RESET << 16;
  459. req->scmnd->scsi_done(req->scmnd);
  460. srp_remove_req(target, req, 0);
  461. }
  462. static int srp_reconnect_target(struct srp_target_port *target)
  463. {
  464. struct ib_qp_attr qp_attr;
  465. struct ib_wc wc;
  466. int i, ret;
  467. if (!srp_change_state(target, SRP_TARGET_LIVE, SRP_TARGET_CONNECTING))
  468. return -EAGAIN;
  469. srp_disconnect_target(target);
  470. /*
  471. * Now get a new local CM ID so that we avoid confusing the
  472. * target in case things are really fouled up.
  473. */
  474. ret = srp_new_cm_id(target);
  475. if (ret)
  476. goto err;
  477. qp_attr.qp_state = IB_QPS_RESET;
  478. ret = ib_modify_qp(target->qp, &qp_attr, IB_QP_STATE);
  479. if (ret)
  480. goto err;
  481. ret = srp_init_qp(target, target->qp);
  482. if (ret)
  483. goto err;
  484. while (ib_poll_cq(target->recv_cq, 1, &wc) > 0)
  485. ; /* nothing */
  486. while (ib_poll_cq(target->send_cq, 1, &wc) > 0)
  487. ; /* nothing */
  488. for (i = 0; i < SRP_CMD_SQ_SIZE; ++i) {
  489. struct srp_request *req = &target->req_ring[i];
  490. if (req->scmnd)
  491. srp_reset_req(target, req);
  492. }
  493. INIT_LIST_HEAD(&target->free_tx);
  494. for (i = 0; i < SRP_SQ_SIZE; ++i)
  495. list_add(&target->tx_ring[i]->list, &target->free_tx);
  496. target->qp_in_error = 0;
  497. ret = srp_connect_target(target);
  498. if (ret)
  499. goto err;
  500. if (!srp_change_state(target, SRP_TARGET_CONNECTING, SRP_TARGET_LIVE))
  501. ret = -EAGAIN;
  502. return ret;
  503. err:
  504. shost_printk(KERN_ERR, target->scsi_host,
  505. PFX "reconnect failed (%d), removing target port.\n", ret);
  506. /*
  507. * We couldn't reconnect, so kill our target port off.
  508. * However, we have to defer the real removal because we
  509. * are in the context of the SCSI error handler now, which
  510. * will deadlock if we call scsi_remove_host().
  511. *
  512. * Schedule our work inside the lock to avoid a race with
  513. * the flush_scheduled_work() in srp_remove_one().
  514. */
  515. spin_lock_irq(&target->lock);
  516. if (target->state == SRP_TARGET_CONNECTING) {
  517. target->state = SRP_TARGET_DEAD;
  518. INIT_WORK(&target->work, srp_remove_work);
  519. queue_work(ib_wq, &target->work);
  520. }
  521. spin_unlock_irq(&target->lock);
  522. return ret;
  523. }
  524. static int srp_map_fmr(struct srp_target_port *target, struct scatterlist *scat,
  525. int sg_cnt, struct srp_request *req,
  526. struct srp_direct_buf *buf)
  527. {
  528. u64 io_addr = 0;
  529. u64 *dma_pages;
  530. u32 len;
  531. int page_cnt;
  532. int i, j;
  533. int ret;
  534. struct srp_device *dev = target->srp_host->srp_dev;
  535. struct ib_device *ibdev = dev->dev;
  536. struct scatterlist *sg;
  537. if (!dev->fmr_pool)
  538. return -ENODEV;
  539. if (ib_sg_dma_address(ibdev, &scat[0]) & ~dev->fmr_page_mask)
  540. return -EINVAL;
  541. len = page_cnt = 0;
  542. scsi_for_each_sg(req->scmnd, sg, sg_cnt, i) {
  543. unsigned int dma_len = ib_sg_dma_len(ibdev, sg);
  544. if (ib_sg_dma_address(ibdev, sg) & ~dev->fmr_page_mask) {
  545. if (i > 0)
  546. return -EINVAL;
  547. else
  548. ++page_cnt;
  549. }
  550. if ((ib_sg_dma_address(ibdev, sg) + dma_len) &
  551. ~dev->fmr_page_mask) {
  552. if (i < sg_cnt - 1)
  553. return -EINVAL;
  554. else
  555. ++page_cnt;
  556. }
  557. len += dma_len;
  558. }
  559. page_cnt += len >> dev->fmr_page_shift;
  560. if (page_cnt > SRP_FMR_SIZE)
  561. return -ENOMEM;
  562. dma_pages = kmalloc(sizeof (u64) * page_cnt, GFP_ATOMIC);
  563. if (!dma_pages)
  564. return -ENOMEM;
  565. page_cnt = 0;
  566. scsi_for_each_sg(req->scmnd, sg, sg_cnt, i) {
  567. unsigned int dma_len = ib_sg_dma_len(ibdev, sg);
  568. for (j = 0; j < dma_len; j += dev->fmr_page_size)
  569. dma_pages[page_cnt++] =
  570. (ib_sg_dma_address(ibdev, sg) &
  571. dev->fmr_page_mask) + j;
  572. }
  573. req->fmr = ib_fmr_pool_map_phys(dev->fmr_pool,
  574. dma_pages, page_cnt, io_addr);
  575. if (IS_ERR(req->fmr)) {
  576. ret = PTR_ERR(req->fmr);
  577. req->fmr = NULL;
  578. goto out;
  579. }
  580. buf->va = cpu_to_be64(ib_sg_dma_address(ibdev, &scat[0]) &
  581. ~dev->fmr_page_mask);
  582. buf->key = cpu_to_be32(req->fmr->fmr->rkey);
  583. buf->len = cpu_to_be32(len);
  584. ret = 0;
  585. out:
  586. kfree(dma_pages);
  587. return ret;
  588. }
  589. static int srp_map_data(struct scsi_cmnd *scmnd, struct srp_target_port *target,
  590. struct srp_request *req)
  591. {
  592. struct scatterlist *scat;
  593. struct srp_cmd *cmd = req->cmd->buf;
  594. int len, nents, count;
  595. u8 fmt = SRP_DATA_DESC_DIRECT;
  596. struct srp_device *dev;
  597. struct ib_device *ibdev;
  598. if (!scsi_sglist(scmnd) || scmnd->sc_data_direction == DMA_NONE)
  599. return sizeof (struct srp_cmd);
  600. if (scmnd->sc_data_direction != DMA_FROM_DEVICE &&
  601. scmnd->sc_data_direction != DMA_TO_DEVICE) {
  602. shost_printk(KERN_WARNING, target->scsi_host,
  603. PFX "Unhandled data direction %d\n",
  604. scmnd->sc_data_direction);
  605. return -EINVAL;
  606. }
  607. nents = scsi_sg_count(scmnd);
  608. scat = scsi_sglist(scmnd);
  609. dev = target->srp_host->srp_dev;
  610. ibdev = dev->dev;
  611. count = ib_dma_map_sg(ibdev, scat, nents, scmnd->sc_data_direction);
  612. fmt = SRP_DATA_DESC_DIRECT;
  613. len = sizeof (struct srp_cmd) + sizeof (struct srp_direct_buf);
  614. if (count == 1) {
  615. /*
  616. * The midlayer only generated a single gather/scatter
  617. * entry, or DMA mapping coalesced everything to a
  618. * single entry. So a direct descriptor along with
  619. * the DMA MR suffices.
  620. */
  621. struct srp_direct_buf *buf = (void *) cmd->add_data;
  622. buf->va = cpu_to_be64(ib_sg_dma_address(ibdev, scat));
  623. buf->key = cpu_to_be32(target->rkey);
  624. buf->len = cpu_to_be32(ib_sg_dma_len(ibdev, scat));
  625. } else if (srp_map_fmr(target, scat, count, req,
  626. (void *) cmd->add_data)) {
  627. /*
  628. * FMR mapping failed, and the scatterlist has more
  629. * than one entry. Generate an indirect memory
  630. * descriptor.
  631. */
  632. struct srp_indirect_buf *buf = (void *) cmd->add_data;
  633. struct scatterlist *sg;
  634. u32 datalen = 0;
  635. int i;
  636. fmt = SRP_DATA_DESC_INDIRECT;
  637. len = sizeof (struct srp_cmd) +
  638. sizeof (struct srp_indirect_buf) +
  639. count * sizeof (struct srp_direct_buf);
  640. scsi_for_each_sg(scmnd, sg, count, i) {
  641. unsigned int dma_len = ib_sg_dma_len(ibdev, sg);
  642. buf->desc_list[i].va =
  643. cpu_to_be64(ib_sg_dma_address(ibdev, sg));
  644. buf->desc_list[i].key =
  645. cpu_to_be32(target->rkey);
  646. buf->desc_list[i].len = cpu_to_be32(dma_len);
  647. datalen += dma_len;
  648. }
  649. if (scmnd->sc_data_direction == DMA_TO_DEVICE)
  650. cmd->data_out_desc_cnt = count;
  651. else
  652. cmd->data_in_desc_cnt = count;
  653. buf->table_desc.va =
  654. cpu_to_be64(req->cmd->dma + sizeof *cmd + sizeof *buf);
  655. buf->table_desc.key =
  656. cpu_to_be32(target->rkey);
  657. buf->table_desc.len =
  658. cpu_to_be32(count * sizeof (struct srp_direct_buf));
  659. buf->len = cpu_to_be32(datalen);
  660. }
  661. if (scmnd->sc_data_direction == DMA_TO_DEVICE)
  662. cmd->buf_fmt = fmt << 4;
  663. else
  664. cmd->buf_fmt = fmt;
  665. return len;
  666. }
  667. /*
  668. * Return an IU and possible credit to the free pool
  669. */
  670. static void srp_put_tx_iu(struct srp_target_port *target, struct srp_iu *iu,
  671. enum srp_iu_type iu_type)
  672. {
  673. unsigned long flags;
  674. spin_lock_irqsave(&target->lock, flags);
  675. list_add(&iu->list, &target->free_tx);
  676. if (iu_type != SRP_IU_RSP)
  677. ++target->req_lim;
  678. spin_unlock_irqrestore(&target->lock, flags);
  679. }
  680. /*
  681. * Must be called with target->lock held to protect req_lim and free_tx.
  682. * If IU is not sent, it must be returned using srp_put_tx_iu().
  683. *
  684. * Note:
  685. * An upper limit for the number of allocated information units for each
  686. * request type is:
  687. * - SRP_IU_CMD: SRP_CMD_SQ_SIZE, since the SCSI mid-layer never queues
  688. * more than Scsi_Host.can_queue requests.
  689. * - SRP_IU_TSK_MGMT: SRP_TSK_MGMT_SQ_SIZE.
  690. * - SRP_IU_RSP: 1, since a conforming SRP target never sends more than
  691. * one unanswered SRP request to an initiator.
  692. */
  693. static struct srp_iu *__srp_get_tx_iu(struct srp_target_port *target,
  694. enum srp_iu_type iu_type)
  695. {
  696. s32 rsv = (iu_type == SRP_IU_TSK_MGMT) ? 0 : SRP_TSK_MGMT_SQ_SIZE;
  697. struct srp_iu *iu;
  698. srp_send_completion(target->send_cq, target);
  699. if (list_empty(&target->free_tx))
  700. return NULL;
  701. /* Initiator responses to target requests do not consume credits */
  702. if (iu_type != SRP_IU_RSP) {
  703. if (target->req_lim <= rsv) {
  704. ++target->zero_req_lim;
  705. return NULL;
  706. }
  707. --target->req_lim;
  708. }
  709. iu = list_first_entry(&target->free_tx, struct srp_iu, list);
  710. list_del(&iu->list);
  711. return iu;
  712. }
  713. static int srp_post_send(struct srp_target_port *target,
  714. struct srp_iu *iu, int len)
  715. {
  716. struct ib_sge list;
  717. struct ib_send_wr wr, *bad_wr;
  718. list.addr = iu->dma;
  719. list.length = len;
  720. list.lkey = target->lkey;
  721. wr.next = NULL;
  722. wr.wr_id = (uintptr_t) iu;
  723. wr.sg_list = &list;
  724. wr.num_sge = 1;
  725. wr.opcode = IB_WR_SEND;
  726. wr.send_flags = IB_SEND_SIGNALED;
  727. return ib_post_send(target->qp, &wr, &bad_wr);
  728. }
  729. static int srp_post_recv(struct srp_target_port *target, struct srp_iu *iu)
  730. {
  731. struct ib_recv_wr wr, *bad_wr;
  732. struct ib_sge list;
  733. list.addr = iu->dma;
  734. list.length = iu->size;
  735. list.lkey = target->lkey;
  736. wr.next = NULL;
  737. wr.wr_id = (uintptr_t) iu;
  738. wr.sg_list = &list;
  739. wr.num_sge = 1;
  740. return ib_post_recv(target->qp, &wr, &bad_wr);
  741. }
  742. static void srp_process_rsp(struct srp_target_port *target, struct srp_rsp *rsp)
  743. {
  744. struct srp_request *req;
  745. struct scsi_cmnd *scmnd;
  746. unsigned long flags;
  747. if (unlikely(rsp->tag & SRP_TAG_TSK_MGMT)) {
  748. spin_lock_irqsave(&target->lock, flags);
  749. target->req_lim += be32_to_cpu(rsp->req_lim_delta);
  750. spin_unlock_irqrestore(&target->lock, flags);
  751. target->tsk_mgmt_status = -1;
  752. if (be32_to_cpu(rsp->resp_data_len) >= 4)
  753. target->tsk_mgmt_status = rsp->data[3];
  754. complete(&target->tsk_mgmt_done);
  755. } else {
  756. req = &target->req_ring[rsp->tag];
  757. scmnd = req->scmnd;
  758. if (!scmnd)
  759. shost_printk(KERN_ERR, target->scsi_host,
  760. "Null scmnd for RSP w/tag %016llx\n",
  761. (unsigned long long) rsp->tag);
  762. scmnd->result = rsp->status;
  763. if (rsp->flags & SRP_RSP_FLAG_SNSVALID) {
  764. memcpy(scmnd->sense_buffer, rsp->data +
  765. be32_to_cpu(rsp->resp_data_len),
  766. min_t(int, be32_to_cpu(rsp->sense_data_len),
  767. SCSI_SENSE_BUFFERSIZE));
  768. }
  769. if (rsp->flags & (SRP_RSP_FLAG_DOOVER | SRP_RSP_FLAG_DOUNDER))
  770. scsi_set_resid(scmnd, be32_to_cpu(rsp->data_out_res_cnt));
  771. else if (rsp->flags & (SRP_RSP_FLAG_DIOVER | SRP_RSP_FLAG_DIUNDER))
  772. scsi_set_resid(scmnd, be32_to_cpu(rsp->data_in_res_cnt));
  773. srp_remove_req(target, req, be32_to_cpu(rsp->req_lim_delta));
  774. scmnd->host_scribble = NULL;
  775. scmnd->scsi_done(scmnd);
  776. }
  777. }
  778. static int srp_response_common(struct srp_target_port *target, s32 req_delta,
  779. void *rsp, int len)
  780. {
  781. struct ib_device *dev = target->srp_host->srp_dev->dev;
  782. unsigned long flags;
  783. struct srp_iu *iu;
  784. int err;
  785. spin_lock_irqsave(&target->lock, flags);
  786. target->req_lim += req_delta;
  787. iu = __srp_get_tx_iu(target, SRP_IU_RSP);
  788. spin_unlock_irqrestore(&target->lock, flags);
  789. if (!iu) {
  790. shost_printk(KERN_ERR, target->scsi_host, PFX
  791. "no IU available to send response\n");
  792. return 1;
  793. }
  794. ib_dma_sync_single_for_cpu(dev, iu->dma, len, DMA_TO_DEVICE);
  795. memcpy(iu->buf, rsp, len);
  796. ib_dma_sync_single_for_device(dev, iu->dma, len, DMA_TO_DEVICE);
  797. err = srp_post_send(target, iu, len);
  798. if (err) {
  799. shost_printk(KERN_ERR, target->scsi_host, PFX
  800. "unable to post response: %d\n", err);
  801. srp_put_tx_iu(target, iu, SRP_IU_RSP);
  802. }
  803. return err;
  804. }
  805. static void srp_process_cred_req(struct srp_target_port *target,
  806. struct srp_cred_req *req)
  807. {
  808. struct srp_cred_rsp rsp = {
  809. .opcode = SRP_CRED_RSP,
  810. .tag = req->tag,
  811. };
  812. s32 delta = be32_to_cpu(req->req_lim_delta);
  813. if (srp_response_common(target, delta, &rsp, sizeof rsp))
  814. shost_printk(KERN_ERR, target->scsi_host, PFX
  815. "problems processing SRP_CRED_REQ\n");
  816. }
  817. static void srp_process_aer_req(struct srp_target_port *target,
  818. struct srp_aer_req *req)
  819. {
  820. struct srp_aer_rsp rsp = {
  821. .opcode = SRP_AER_RSP,
  822. .tag = req->tag,
  823. };
  824. s32 delta = be32_to_cpu(req->req_lim_delta);
  825. shost_printk(KERN_ERR, target->scsi_host, PFX
  826. "ignoring AER for LUN %llu\n", be64_to_cpu(req->lun));
  827. if (srp_response_common(target, delta, &rsp, sizeof rsp))
  828. shost_printk(KERN_ERR, target->scsi_host, PFX
  829. "problems processing SRP_AER_REQ\n");
  830. }
  831. static void srp_handle_recv(struct srp_target_port *target, struct ib_wc *wc)
  832. {
  833. struct ib_device *dev = target->srp_host->srp_dev->dev;
  834. struct srp_iu *iu = (struct srp_iu *) wc->wr_id;
  835. int res;
  836. u8 opcode;
  837. ib_dma_sync_single_for_cpu(dev, iu->dma, target->max_ti_iu_len,
  838. DMA_FROM_DEVICE);
  839. opcode = *(u8 *) iu->buf;
  840. if (0) {
  841. shost_printk(KERN_ERR, target->scsi_host,
  842. PFX "recv completion, opcode 0x%02x\n", opcode);
  843. print_hex_dump(KERN_ERR, "", DUMP_PREFIX_OFFSET, 8, 1,
  844. iu->buf, wc->byte_len, true);
  845. }
  846. switch (opcode) {
  847. case SRP_RSP:
  848. srp_process_rsp(target, iu->buf);
  849. break;
  850. case SRP_CRED_REQ:
  851. srp_process_cred_req(target, iu->buf);
  852. break;
  853. case SRP_AER_REQ:
  854. srp_process_aer_req(target, iu->buf);
  855. break;
  856. case SRP_T_LOGOUT:
  857. /* XXX Handle target logout */
  858. shost_printk(KERN_WARNING, target->scsi_host,
  859. PFX "Got target logout request\n");
  860. break;
  861. default:
  862. shost_printk(KERN_WARNING, target->scsi_host,
  863. PFX "Unhandled SRP opcode 0x%02x\n", opcode);
  864. break;
  865. }
  866. ib_dma_sync_single_for_device(dev, iu->dma, target->max_ti_iu_len,
  867. DMA_FROM_DEVICE);
  868. res = srp_post_recv(target, iu);
  869. if (res != 0)
  870. shost_printk(KERN_ERR, target->scsi_host,
  871. PFX "Recv failed with error code %d\n", res);
  872. }
  873. static void srp_recv_completion(struct ib_cq *cq, void *target_ptr)
  874. {
  875. struct srp_target_port *target = target_ptr;
  876. struct ib_wc wc;
  877. ib_req_notify_cq(cq, IB_CQ_NEXT_COMP);
  878. while (ib_poll_cq(cq, 1, &wc) > 0) {
  879. if (wc.status) {
  880. shost_printk(KERN_ERR, target->scsi_host,
  881. PFX "failed receive status %d\n",
  882. wc.status);
  883. target->qp_in_error = 1;
  884. break;
  885. }
  886. srp_handle_recv(target, &wc);
  887. }
  888. }
  889. static void srp_send_completion(struct ib_cq *cq, void *target_ptr)
  890. {
  891. struct srp_target_port *target = target_ptr;
  892. struct ib_wc wc;
  893. struct srp_iu *iu;
  894. while (ib_poll_cq(cq, 1, &wc) > 0) {
  895. if (wc.status) {
  896. shost_printk(KERN_ERR, target->scsi_host,
  897. PFX "failed send status %d\n",
  898. wc.status);
  899. target->qp_in_error = 1;
  900. break;
  901. }
  902. iu = (struct srp_iu *) wc.wr_id;
  903. list_add(&iu->list, &target->free_tx);
  904. }
  905. }
  906. static int srp_queuecommand(struct Scsi_Host *shost, struct scsi_cmnd *scmnd)
  907. {
  908. struct srp_target_port *target = host_to_target(shost);
  909. struct srp_request *req;
  910. struct srp_iu *iu;
  911. struct srp_cmd *cmd;
  912. struct ib_device *dev;
  913. unsigned long flags;
  914. int len;
  915. if (target->state == SRP_TARGET_CONNECTING)
  916. goto err;
  917. if (target->state == SRP_TARGET_DEAD ||
  918. target->state == SRP_TARGET_REMOVED) {
  919. scmnd->result = DID_BAD_TARGET << 16;
  920. scmnd->scsi_done(scmnd);
  921. return 0;
  922. }
  923. spin_lock_irqsave(&target->lock, flags);
  924. iu = __srp_get_tx_iu(target, SRP_IU_CMD);
  925. if (!iu)
  926. goto err_unlock;
  927. req = list_first_entry(&target->free_reqs, struct srp_request, list);
  928. list_del(&req->list);
  929. spin_unlock_irqrestore(&target->lock, flags);
  930. dev = target->srp_host->srp_dev->dev;
  931. ib_dma_sync_single_for_cpu(dev, iu->dma, srp_max_iu_len,
  932. DMA_TO_DEVICE);
  933. scmnd->result = 0;
  934. scmnd->host_scribble = (void *) req;
  935. cmd = iu->buf;
  936. memset(cmd, 0, sizeof *cmd);
  937. cmd->opcode = SRP_CMD;
  938. cmd->lun = cpu_to_be64((u64) scmnd->device->lun << 48);
  939. cmd->tag = req->index;
  940. memcpy(cmd->cdb, scmnd->cmnd, scmnd->cmd_len);
  941. req->scmnd = scmnd;
  942. req->cmd = iu;
  943. len = srp_map_data(scmnd, target, req);
  944. if (len < 0) {
  945. shost_printk(KERN_ERR, target->scsi_host,
  946. PFX "Failed to map data\n");
  947. goto err_iu;
  948. }
  949. ib_dma_sync_single_for_device(dev, iu->dma, srp_max_iu_len,
  950. DMA_TO_DEVICE);
  951. if (srp_post_send(target, iu, len)) {
  952. shost_printk(KERN_ERR, target->scsi_host, PFX "Send failed\n");
  953. goto err_unmap;
  954. }
  955. return 0;
  956. err_unmap:
  957. srp_unmap_data(scmnd, target, req);
  958. err_iu:
  959. srp_put_tx_iu(target, iu, SRP_IU_CMD);
  960. spin_lock_irqsave(&target->lock, flags);
  961. list_add(&req->list, &target->free_reqs);
  962. err_unlock:
  963. spin_unlock_irqrestore(&target->lock, flags);
  964. err:
  965. return SCSI_MLQUEUE_HOST_BUSY;
  966. }
  967. static int srp_alloc_iu_bufs(struct srp_target_port *target)
  968. {
  969. int i;
  970. for (i = 0; i < SRP_RQ_SIZE; ++i) {
  971. target->rx_ring[i] = srp_alloc_iu(target->srp_host,
  972. target->max_ti_iu_len,
  973. GFP_KERNEL, DMA_FROM_DEVICE);
  974. if (!target->rx_ring[i])
  975. goto err;
  976. }
  977. for (i = 0; i < SRP_SQ_SIZE; ++i) {
  978. target->tx_ring[i] = srp_alloc_iu(target->srp_host,
  979. srp_max_iu_len,
  980. GFP_KERNEL, DMA_TO_DEVICE);
  981. if (!target->tx_ring[i])
  982. goto err;
  983. list_add(&target->tx_ring[i]->list, &target->free_tx);
  984. }
  985. return 0;
  986. err:
  987. for (i = 0; i < SRP_RQ_SIZE; ++i) {
  988. srp_free_iu(target->srp_host, target->rx_ring[i]);
  989. target->rx_ring[i] = NULL;
  990. }
  991. for (i = 0; i < SRP_SQ_SIZE; ++i) {
  992. srp_free_iu(target->srp_host, target->tx_ring[i]);
  993. target->tx_ring[i] = NULL;
  994. }
  995. return -ENOMEM;
  996. }
  997. static void srp_cm_rej_handler(struct ib_cm_id *cm_id,
  998. struct ib_cm_event *event,
  999. struct srp_target_port *target)
  1000. {
  1001. struct Scsi_Host *shost = target->scsi_host;
  1002. struct ib_class_port_info *cpi;
  1003. int opcode;
  1004. switch (event->param.rej_rcvd.reason) {
  1005. case IB_CM_REJ_PORT_CM_REDIRECT:
  1006. cpi = event->param.rej_rcvd.ari;
  1007. target->path.dlid = cpi->redirect_lid;
  1008. target->path.pkey = cpi->redirect_pkey;
  1009. cm_id->remote_cm_qpn = be32_to_cpu(cpi->redirect_qp) & 0x00ffffff;
  1010. memcpy(target->path.dgid.raw, cpi->redirect_gid, 16);
  1011. target->status = target->path.dlid ?
  1012. SRP_DLID_REDIRECT : SRP_PORT_REDIRECT;
  1013. break;
  1014. case IB_CM_REJ_PORT_REDIRECT:
  1015. if (srp_target_is_topspin(target)) {
  1016. /*
  1017. * Topspin/Cisco SRP gateways incorrectly send
  1018. * reject reason code 25 when they mean 24
  1019. * (port redirect).
  1020. */
  1021. memcpy(target->path.dgid.raw,
  1022. event->param.rej_rcvd.ari, 16);
  1023. shost_printk(KERN_DEBUG, shost,
  1024. PFX "Topspin/Cisco redirect to target port GID %016llx%016llx\n",
  1025. (unsigned long long) be64_to_cpu(target->path.dgid.global.subnet_prefix),
  1026. (unsigned long long) be64_to_cpu(target->path.dgid.global.interface_id));
  1027. target->status = SRP_PORT_REDIRECT;
  1028. } else {
  1029. shost_printk(KERN_WARNING, shost,
  1030. " REJ reason: IB_CM_REJ_PORT_REDIRECT\n");
  1031. target->status = -ECONNRESET;
  1032. }
  1033. break;
  1034. case IB_CM_REJ_DUPLICATE_LOCAL_COMM_ID:
  1035. shost_printk(KERN_WARNING, shost,
  1036. " REJ reason: IB_CM_REJ_DUPLICATE_LOCAL_COMM_ID\n");
  1037. target->status = -ECONNRESET;
  1038. break;
  1039. case IB_CM_REJ_CONSUMER_DEFINED:
  1040. opcode = *(u8 *) event->private_data;
  1041. if (opcode == SRP_LOGIN_REJ) {
  1042. struct srp_login_rej *rej = event->private_data;
  1043. u32 reason = be32_to_cpu(rej->reason);
  1044. if (reason == SRP_LOGIN_REJ_REQ_IT_IU_LENGTH_TOO_LARGE)
  1045. shost_printk(KERN_WARNING, shost,
  1046. PFX "SRP_LOGIN_REJ: requested max_it_iu_len too large\n");
  1047. else
  1048. shost_printk(KERN_WARNING, shost,
  1049. PFX "SRP LOGIN REJECTED, reason 0x%08x\n", reason);
  1050. } else
  1051. shost_printk(KERN_WARNING, shost,
  1052. " REJ reason: IB_CM_REJ_CONSUMER_DEFINED,"
  1053. " opcode 0x%02x\n", opcode);
  1054. target->status = -ECONNRESET;
  1055. break;
  1056. case IB_CM_REJ_STALE_CONN:
  1057. shost_printk(KERN_WARNING, shost, " REJ reason: stale connection\n");
  1058. target->status = SRP_STALE_CONN;
  1059. break;
  1060. default:
  1061. shost_printk(KERN_WARNING, shost, " REJ reason 0x%x\n",
  1062. event->param.rej_rcvd.reason);
  1063. target->status = -ECONNRESET;
  1064. }
  1065. }
  1066. static int srp_cm_handler(struct ib_cm_id *cm_id, struct ib_cm_event *event)
  1067. {
  1068. struct srp_target_port *target = cm_id->context;
  1069. struct ib_qp_attr *qp_attr = NULL;
  1070. int attr_mask = 0;
  1071. int comp = 0;
  1072. int opcode = 0;
  1073. int i;
  1074. switch (event->event) {
  1075. case IB_CM_REQ_ERROR:
  1076. shost_printk(KERN_DEBUG, target->scsi_host,
  1077. PFX "Sending CM REQ failed\n");
  1078. comp = 1;
  1079. target->status = -ECONNRESET;
  1080. break;
  1081. case IB_CM_REP_RECEIVED:
  1082. comp = 1;
  1083. opcode = *(u8 *) event->private_data;
  1084. if (opcode == SRP_LOGIN_RSP) {
  1085. struct srp_login_rsp *rsp = event->private_data;
  1086. target->max_ti_iu_len = be32_to_cpu(rsp->max_ti_iu_len);
  1087. target->req_lim = be32_to_cpu(rsp->req_lim_delta);
  1088. /*
  1089. * Reserve credits for task management so we don't
  1090. * bounce requests back to the SCSI mid-layer.
  1091. */
  1092. target->scsi_host->can_queue
  1093. = min(target->req_lim - SRP_TSK_MGMT_SQ_SIZE,
  1094. target->scsi_host->can_queue);
  1095. } else {
  1096. shost_printk(KERN_WARNING, target->scsi_host,
  1097. PFX "Unhandled RSP opcode %#x\n", opcode);
  1098. target->status = -ECONNRESET;
  1099. break;
  1100. }
  1101. if (!target->rx_ring[0]) {
  1102. target->status = srp_alloc_iu_bufs(target);
  1103. if (target->status)
  1104. break;
  1105. }
  1106. qp_attr = kmalloc(sizeof *qp_attr, GFP_KERNEL);
  1107. if (!qp_attr) {
  1108. target->status = -ENOMEM;
  1109. break;
  1110. }
  1111. qp_attr->qp_state = IB_QPS_RTR;
  1112. target->status = ib_cm_init_qp_attr(cm_id, qp_attr, &attr_mask);
  1113. if (target->status)
  1114. break;
  1115. target->status = ib_modify_qp(target->qp, qp_attr, attr_mask);
  1116. if (target->status)
  1117. break;
  1118. for (i = 0; i < SRP_RQ_SIZE; i++) {
  1119. struct srp_iu *iu = target->rx_ring[i];
  1120. target->status = srp_post_recv(target, iu);
  1121. if (target->status)
  1122. break;
  1123. }
  1124. if (target->status)
  1125. break;
  1126. qp_attr->qp_state = IB_QPS_RTS;
  1127. target->status = ib_cm_init_qp_attr(cm_id, qp_attr, &attr_mask);
  1128. if (target->status)
  1129. break;
  1130. target->status = ib_modify_qp(target->qp, qp_attr, attr_mask);
  1131. if (target->status)
  1132. break;
  1133. target->status = ib_send_cm_rtu(cm_id, NULL, 0);
  1134. if (target->status)
  1135. break;
  1136. break;
  1137. case IB_CM_REJ_RECEIVED:
  1138. shost_printk(KERN_DEBUG, target->scsi_host, PFX "REJ received\n");
  1139. comp = 1;
  1140. srp_cm_rej_handler(cm_id, event, target);
  1141. break;
  1142. case IB_CM_DREQ_RECEIVED:
  1143. shost_printk(KERN_WARNING, target->scsi_host,
  1144. PFX "DREQ received - connection closed\n");
  1145. if (ib_send_cm_drep(cm_id, NULL, 0))
  1146. shost_printk(KERN_ERR, target->scsi_host,
  1147. PFX "Sending CM DREP failed\n");
  1148. break;
  1149. case IB_CM_TIMEWAIT_EXIT:
  1150. shost_printk(KERN_ERR, target->scsi_host,
  1151. PFX "connection closed\n");
  1152. comp = 1;
  1153. target->status = 0;
  1154. break;
  1155. case IB_CM_MRA_RECEIVED:
  1156. case IB_CM_DREQ_ERROR:
  1157. case IB_CM_DREP_RECEIVED:
  1158. break;
  1159. default:
  1160. shost_printk(KERN_WARNING, target->scsi_host,
  1161. PFX "Unhandled CM event %d\n", event->event);
  1162. break;
  1163. }
  1164. if (comp)
  1165. complete(&target->done);
  1166. kfree(qp_attr);
  1167. return 0;
  1168. }
  1169. static int srp_send_tsk_mgmt(struct srp_target_port *target,
  1170. u64 req_tag, unsigned int lun, u8 func)
  1171. {
  1172. struct ib_device *dev = target->srp_host->srp_dev->dev;
  1173. struct srp_iu *iu;
  1174. struct srp_tsk_mgmt *tsk_mgmt;
  1175. if (target->state == SRP_TARGET_DEAD ||
  1176. target->state == SRP_TARGET_REMOVED)
  1177. return -1;
  1178. init_completion(&target->tsk_mgmt_done);
  1179. spin_lock_irq(&target->lock);
  1180. iu = __srp_get_tx_iu(target, SRP_IU_TSK_MGMT);
  1181. spin_unlock_irq(&target->lock);
  1182. if (!iu)
  1183. return -1;
  1184. ib_dma_sync_single_for_cpu(dev, iu->dma, sizeof *tsk_mgmt,
  1185. DMA_TO_DEVICE);
  1186. tsk_mgmt = iu->buf;
  1187. memset(tsk_mgmt, 0, sizeof *tsk_mgmt);
  1188. tsk_mgmt->opcode = SRP_TSK_MGMT;
  1189. tsk_mgmt->lun = cpu_to_be64((u64) lun << 48);
  1190. tsk_mgmt->tag = req_tag | SRP_TAG_TSK_MGMT;
  1191. tsk_mgmt->tsk_mgmt_func = func;
  1192. tsk_mgmt->task_tag = req_tag;
  1193. ib_dma_sync_single_for_device(dev, iu->dma, sizeof *tsk_mgmt,
  1194. DMA_TO_DEVICE);
  1195. if (srp_post_send(target, iu, sizeof *tsk_mgmt)) {
  1196. srp_put_tx_iu(target, iu, SRP_IU_TSK_MGMT);
  1197. return -1;
  1198. }
  1199. if (!wait_for_completion_timeout(&target->tsk_mgmt_done,
  1200. msecs_to_jiffies(SRP_ABORT_TIMEOUT_MS)))
  1201. return -1;
  1202. return 0;
  1203. }
  1204. static int srp_abort(struct scsi_cmnd *scmnd)
  1205. {
  1206. struct srp_target_port *target = host_to_target(scmnd->device->host);
  1207. struct srp_request *req = (struct srp_request *) scmnd->host_scribble;
  1208. int ret = SUCCESS;
  1209. shost_printk(KERN_ERR, target->scsi_host, "SRP abort called\n");
  1210. if (!req || target->qp_in_error)
  1211. return FAILED;
  1212. if (srp_send_tsk_mgmt(target, req->index, scmnd->device->lun,
  1213. SRP_TSK_ABORT_TASK))
  1214. return FAILED;
  1215. if (req->scmnd) {
  1216. if (!target->tsk_mgmt_status) {
  1217. srp_remove_req(target, req, 0);
  1218. scmnd->result = DID_ABORT << 16;
  1219. } else
  1220. ret = FAILED;
  1221. }
  1222. return ret;
  1223. }
  1224. static int srp_reset_device(struct scsi_cmnd *scmnd)
  1225. {
  1226. struct srp_target_port *target = host_to_target(scmnd->device->host);
  1227. int i;
  1228. shost_printk(KERN_ERR, target->scsi_host, "SRP reset_device called\n");
  1229. if (target->qp_in_error)
  1230. return FAILED;
  1231. if (srp_send_tsk_mgmt(target, SRP_TAG_NO_REQ, scmnd->device->lun,
  1232. SRP_TSK_LUN_RESET))
  1233. return FAILED;
  1234. if (target->tsk_mgmt_status)
  1235. return FAILED;
  1236. for (i = 0; i < SRP_CMD_SQ_SIZE; ++i) {
  1237. struct srp_request *req = &target->req_ring[i];
  1238. if (req->scmnd && req->scmnd->device == scmnd->device)
  1239. srp_reset_req(target, req);
  1240. }
  1241. return SUCCESS;
  1242. }
  1243. static int srp_reset_host(struct scsi_cmnd *scmnd)
  1244. {
  1245. struct srp_target_port *target = host_to_target(scmnd->device->host);
  1246. int ret = FAILED;
  1247. shost_printk(KERN_ERR, target->scsi_host, PFX "SRP reset_host called\n");
  1248. if (!srp_reconnect_target(target))
  1249. ret = SUCCESS;
  1250. return ret;
  1251. }
  1252. static ssize_t show_id_ext(struct device *dev, struct device_attribute *attr,
  1253. char *buf)
  1254. {
  1255. struct srp_target_port *target = host_to_target(class_to_shost(dev));
  1256. if (target->state == SRP_TARGET_DEAD ||
  1257. target->state == SRP_TARGET_REMOVED)
  1258. return -ENODEV;
  1259. return sprintf(buf, "0x%016llx\n",
  1260. (unsigned long long) be64_to_cpu(target->id_ext));
  1261. }
  1262. static ssize_t show_ioc_guid(struct device *dev, struct device_attribute *attr,
  1263. char *buf)
  1264. {
  1265. struct srp_target_port *target = host_to_target(class_to_shost(dev));
  1266. if (target->state == SRP_TARGET_DEAD ||
  1267. target->state == SRP_TARGET_REMOVED)
  1268. return -ENODEV;
  1269. return sprintf(buf, "0x%016llx\n",
  1270. (unsigned long long) be64_to_cpu(target->ioc_guid));
  1271. }
  1272. static ssize_t show_service_id(struct device *dev,
  1273. struct device_attribute *attr, char *buf)
  1274. {
  1275. struct srp_target_port *target = host_to_target(class_to_shost(dev));
  1276. if (target->state == SRP_TARGET_DEAD ||
  1277. target->state == SRP_TARGET_REMOVED)
  1278. return -ENODEV;
  1279. return sprintf(buf, "0x%016llx\n",
  1280. (unsigned long long) be64_to_cpu(target->service_id));
  1281. }
  1282. static ssize_t show_pkey(struct device *dev, struct device_attribute *attr,
  1283. char *buf)
  1284. {
  1285. struct srp_target_port *target = host_to_target(class_to_shost(dev));
  1286. if (target->state == SRP_TARGET_DEAD ||
  1287. target->state == SRP_TARGET_REMOVED)
  1288. return -ENODEV;
  1289. return sprintf(buf, "0x%04x\n", be16_to_cpu(target->path.pkey));
  1290. }
  1291. static ssize_t show_dgid(struct device *dev, struct device_attribute *attr,
  1292. char *buf)
  1293. {
  1294. struct srp_target_port *target = host_to_target(class_to_shost(dev));
  1295. if (target->state == SRP_TARGET_DEAD ||
  1296. target->state == SRP_TARGET_REMOVED)
  1297. return -ENODEV;
  1298. return sprintf(buf, "%pI6\n", target->path.dgid.raw);
  1299. }
  1300. static ssize_t show_orig_dgid(struct device *dev,
  1301. struct device_attribute *attr, char *buf)
  1302. {
  1303. struct srp_target_port *target = host_to_target(class_to_shost(dev));
  1304. if (target->state == SRP_TARGET_DEAD ||
  1305. target->state == SRP_TARGET_REMOVED)
  1306. return -ENODEV;
  1307. return sprintf(buf, "%pI6\n", target->orig_dgid);
  1308. }
  1309. static ssize_t show_req_lim(struct device *dev,
  1310. struct device_attribute *attr, char *buf)
  1311. {
  1312. struct srp_target_port *target = host_to_target(class_to_shost(dev));
  1313. if (target->state == SRP_TARGET_DEAD ||
  1314. target->state == SRP_TARGET_REMOVED)
  1315. return -ENODEV;
  1316. return sprintf(buf, "%d\n", target->req_lim);
  1317. }
  1318. static ssize_t show_zero_req_lim(struct device *dev,
  1319. struct device_attribute *attr, char *buf)
  1320. {
  1321. struct srp_target_port *target = host_to_target(class_to_shost(dev));
  1322. if (target->state == SRP_TARGET_DEAD ||
  1323. target->state == SRP_TARGET_REMOVED)
  1324. return -ENODEV;
  1325. return sprintf(buf, "%d\n", target->zero_req_lim);
  1326. }
  1327. static ssize_t show_local_ib_port(struct device *dev,
  1328. struct device_attribute *attr, char *buf)
  1329. {
  1330. struct srp_target_port *target = host_to_target(class_to_shost(dev));
  1331. return sprintf(buf, "%d\n", target->srp_host->port);
  1332. }
  1333. static ssize_t show_local_ib_device(struct device *dev,
  1334. struct device_attribute *attr, char *buf)
  1335. {
  1336. struct srp_target_port *target = host_to_target(class_to_shost(dev));
  1337. return sprintf(buf, "%s\n", target->srp_host->srp_dev->dev->name);
  1338. }
  1339. static DEVICE_ATTR(id_ext, S_IRUGO, show_id_ext, NULL);
  1340. static DEVICE_ATTR(ioc_guid, S_IRUGO, show_ioc_guid, NULL);
  1341. static DEVICE_ATTR(service_id, S_IRUGO, show_service_id, NULL);
  1342. static DEVICE_ATTR(pkey, S_IRUGO, show_pkey, NULL);
  1343. static DEVICE_ATTR(dgid, S_IRUGO, show_dgid, NULL);
  1344. static DEVICE_ATTR(orig_dgid, S_IRUGO, show_orig_dgid, NULL);
  1345. static DEVICE_ATTR(req_lim, S_IRUGO, show_req_lim, NULL);
  1346. static DEVICE_ATTR(zero_req_lim, S_IRUGO, show_zero_req_lim, NULL);
  1347. static DEVICE_ATTR(local_ib_port, S_IRUGO, show_local_ib_port, NULL);
  1348. static DEVICE_ATTR(local_ib_device, S_IRUGO, show_local_ib_device, NULL);
  1349. static struct device_attribute *srp_host_attrs[] = {
  1350. &dev_attr_id_ext,
  1351. &dev_attr_ioc_guid,
  1352. &dev_attr_service_id,
  1353. &dev_attr_pkey,
  1354. &dev_attr_dgid,
  1355. &dev_attr_orig_dgid,
  1356. &dev_attr_req_lim,
  1357. &dev_attr_zero_req_lim,
  1358. &dev_attr_local_ib_port,
  1359. &dev_attr_local_ib_device,
  1360. NULL
  1361. };
  1362. static struct scsi_host_template srp_template = {
  1363. .module = THIS_MODULE,
  1364. .name = "InfiniBand SRP initiator",
  1365. .proc_name = DRV_NAME,
  1366. .info = srp_target_info,
  1367. .queuecommand = srp_queuecommand,
  1368. .eh_abort_handler = srp_abort,
  1369. .eh_device_reset_handler = srp_reset_device,
  1370. .eh_host_reset_handler = srp_reset_host,
  1371. .can_queue = SRP_CMD_SQ_SIZE,
  1372. .this_id = -1,
  1373. .cmd_per_lun = SRP_CMD_SQ_SIZE,
  1374. .use_clustering = ENABLE_CLUSTERING,
  1375. .shost_attrs = srp_host_attrs
  1376. };
  1377. static int srp_add_target(struct srp_host *host, struct srp_target_port *target)
  1378. {
  1379. struct srp_rport_identifiers ids;
  1380. struct srp_rport *rport;
  1381. sprintf(target->target_name, "SRP.T10:%016llX",
  1382. (unsigned long long) be64_to_cpu(target->id_ext));
  1383. if (scsi_add_host(target->scsi_host, host->srp_dev->dev->dma_device))
  1384. return -ENODEV;
  1385. memcpy(ids.port_id, &target->id_ext, 8);
  1386. memcpy(ids.port_id + 8, &target->ioc_guid, 8);
  1387. ids.roles = SRP_RPORT_ROLE_TARGET;
  1388. rport = srp_rport_add(target->scsi_host, &ids);
  1389. if (IS_ERR(rport)) {
  1390. scsi_remove_host(target->scsi_host);
  1391. return PTR_ERR(rport);
  1392. }
  1393. spin_lock(&host->target_lock);
  1394. list_add_tail(&target->list, &host->target_list);
  1395. spin_unlock(&host->target_lock);
  1396. target->state = SRP_TARGET_LIVE;
  1397. scsi_scan_target(&target->scsi_host->shost_gendev,
  1398. 0, target->scsi_id, SCAN_WILD_CARD, 0);
  1399. return 0;
  1400. }
  1401. static void srp_release_dev(struct device *dev)
  1402. {
  1403. struct srp_host *host =
  1404. container_of(dev, struct srp_host, dev);
  1405. complete(&host->released);
  1406. }
  1407. static struct class srp_class = {
  1408. .name = "infiniband_srp",
  1409. .dev_release = srp_release_dev
  1410. };
  1411. /*
  1412. * Target ports are added by writing
  1413. *
  1414. * id_ext=<SRP ID ext>,ioc_guid=<SRP IOC GUID>,dgid=<dest GID>,
  1415. * pkey=<P_Key>,service_id=<service ID>
  1416. *
  1417. * to the add_target sysfs attribute.
  1418. */
  1419. enum {
  1420. SRP_OPT_ERR = 0,
  1421. SRP_OPT_ID_EXT = 1 << 0,
  1422. SRP_OPT_IOC_GUID = 1 << 1,
  1423. SRP_OPT_DGID = 1 << 2,
  1424. SRP_OPT_PKEY = 1 << 3,
  1425. SRP_OPT_SERVICE_ID = 1 << 4,
  1426. SRP_OPT_MAX_SECT = 1 << 5,
  1427. SRP_OPT_MAX_CMD_PER_LUN = 1 << 6,
  1428. SRP_OPT_IO_CLASS = 1 << 7,
  1429. SRP_OPT_INITIATOR_EXT = 1 << 8,
  1430. SRP_OPT_ALL = (SRP_OPT_ID_EXT |
  1431. SRP_OPT_IOC_GUID |
  1432. SRP_OPT_DGID |
  1433. SRP_OPT_PKEY |
  1434. SRP_OPT_SERVICE_ID),
  1435. };
  1436. static const match_table_t srp_opt_tokens = {
  1437. { SRP_OPT_ID_EXT, "id_ext=%s" },
  1438. { SRP_OPT_IOC_GUID, "ioc_guid=%s" },
  1439. { SRP_OPT_DGID, "dgid=%s" },
  1440. { SRP_OPT_PKEY, "pkey=%x" },
  1441. { SRP_OPT_SERVICE_ID, "service_id=%s" },
  1442. { SRP_OPT_MAX_SECT, "max_sect=%d" },
  1443. { SRP_OPT_MAX_CMD_PER_LUN, "max_cmd_per_lun=%d" },
  1444. { SRP_OPT_IO_CLASS, "io_class=%x" },
  1445. { SRP_OPT_INITIATOR_EXT, "initiator_ext=%s" },
  1446. { SRP_OPT_ERR, NULL }
  1447. };
  1448. static int srp_parse_options(const char *buf, struct srp_target_port *target)
  1449. {
  1450. char *options, *sep_opt;
  1451. char *p;
  1452. char dgid[3];
  1453. substring_t args[MAX_OPT_ARGS];
  1454. int opt_mask = 0;
  1455. int token;
  1456. int ret = -EINVAL;
  1457. int i;
  1458. options = kstrdup(buf, GFP_KERNEL);
  1459. if (!options)
  1460. return -ENOMEM;
  1461. sep_opt = options;
  1462. while ((p = strsep(&sep_opt, ",")) != NULL) {
  1463. if (!*p)
  1464. continue;
  1465. token = match_token(p, srp_opt_tokens, args);
  1466. opt_mask |= token;
  1467. switch (token) {
  1468. case SRP_OPT_ID_EXT:
  1469. p = match_strdup(args);
  1470. if (!p) {
  1471. ret = -ENOMEM;
  1472. goto out;
  1473. }
  1474. target->id_ext = cpu_to_be64(simple_strtoull(p, NULL, 16));
  1475. kfree(p);
  1476. break;
  1477. case SRP_OPT_IOC_GUID:
  1478. p = match_strdup(args);
  1479. if (!p) {
  1480. ret = -ENOMEM;
  1481. goto out;
  1482. }
  1483. target->ioc_guid = cpu_to_be64(simple_strtoull(p, NULL, 16));
  1484. kfree(p);
  1485. break;
  1486. case SRP_OPT_DGID:
  1487. p = match_strdup(args);
  1488. if (!p) {
  1489. ret = -ENOMEM;
  1490. goto out;
  1491. }
  1492. if (strlen(p) != 32) {
  1493. printk(KERN_WARNING PFX "bad dest GID parameter '%s'\n", p);
  1494. kfree(p);
  1495. goto out;
  1496. }
  1497. for (i = 0; i < 16; ++i) {
  1498. strlcpy(dgid, p + i * 2, 3);
  1499. target->path.dgid.raw[i] = simple_strtoul(dgid, NULL, 16);
  1500. }
  1501. kfree(p);
  1502. memcpy(target->orig_dgid, target->path.dgid.raw, 16);
  1503. break;
  1504. case SRP_OPT_PKEY:
  1505. if (match_hex(args, &token)) {
  1506. printk(KERN_WARNING PFX "bad P_Key parameter '%s'\n", p);
  1507. goto out;
  1508. }
  1509. target->path.pkey = cpu_to_be16(token);
  1510. break;
  1511. case SRP_OPT_SERVICE_ID:
  1512. p = match_strdup(args);
  1513. if (!p) {
  1514. ret = -ENOMEM;
  1515. goto out;
  1516. }
  1517. target->service_id = cpu_to_be64(simple_strtoull(p, NULL, 16));
  1518. target->path.service_id = target->service_id;
  1519. kfree(p);
  1520. break;
  1521. case SRP_OPT_MAX_SECT:
  1522. if (match_int(args, &token)) {
  1523. printk(KERN_WARNING PFX "bad max sect parameter '%s'\n", p);
  1524. goto out;
  1525. }
  1526. target->scsi_host->max_sectors = token;
  1527. break;
  1528. case SRP_OPT_MAX_CMD_PER_LUN:
  1529. if (match_int(args, &token)) {
  1530. printk(KERN_WARNING PFX "bad max cmd_per_lun parameter '%s'\n", p);
  1531. goto out;
  1532. }
  1533. target->scsi_host->cmd_per_lun = min(token, SRP_CMD_SQ_SIZE);
  1534. break;
  1535. case SRP_OPT_IO_CLASS:
  1536. if (match_hex(args, &token)) {
  1537. printk(KERN_WARNING PFX "bad IO class parameter '%s' \n", p);
  1538. goto out;
  1539. }
  1540. if (token != SRP_REV10_IB_IO_CLASS &&
  1541. token != SRP_REV16A_IB_IO_CLASS) {
  1542. printk(KERN_WARNING PFX "unknown IO class parameter value"
  1543. " %x specified (use %x or %x).\n",
  1544. token, SRP_REV10_IB_IO_CLASS, SRP_REV16A_IB_IO_CLASS);
  1545. goto out;
  1546. }
  1547. target->io_class = token;
  1548. break;
  1549. case SRP_OPT_INITIATOR_EXT:
  1550. p = match_strdup(args);
  1551. if (!p) {
  1552. ret = -ENOMEM;
  1553. goto out;
  1554. }
  1555. target->initiator_ext = cpu_to_be64(simple_strtoull(p, NULL, 16));
  1556. kfree(p);
  1557. break;
  1558. default:
  1559. printk(KERN_WARNING PFX "unknown parameter or missing value "
  1560. "'%s' in target creation request\n", p);
  1561. goto out;
  1562. }
  1563. }
  1564. if ((opt_mask & SRP_OPT_ALL) == SRP_OPT_ALL)
  1565. ret = 0;
  1566. else
  1567. for (i = 0; i < ARRAY_SIZE(srp_opt_tokens); ++i)
  1568. if ((srp_opt_tokens[i].token & SRP_OPT_ALL) &&
  1569. !(srp_opt_tokens[i].token & opt_mask))
  1570. printk(KERN_WARNING PFX "target creation request is "
  1571. "missing parameter '%s'\n",
  1572. srp_opt_tokens[i].pattern);
  1573. out:
  1574. kfree(options);
  1575. return ret;
  1576. }
  1577. static ssize_t srp_create_target(struct device *dev,
  1578. struct device_attribute *attr,
  1579. const char *buf, size_t count)
  1580. {
  1581. struct srp_host *host =
  1582. container_of(dev, struct srp_host, dev);
  1583. struct Scsi_Host *target_host;
  1584. struct srp_target_port *target;
  1585. int ret;
  1586. int i;
  1587. target_host = scsi_host_alloc(&srp_template,
  1588. sizeof (struct srp_target_port));
  1589. if (!target_host)
  1590. return -ENOMEM;
  1591. target_host->transportt = ib_srp_transport_template;
  1592. target_host->max_lun = SRP_MAX_LUN;
  1593. target_host->max_cmd_len = sizeof ((struct srp_cmd *) (void *) 0L)->cdb;
  1594. target = host_to_target(target_host);
  1595. target->io_class = SRP_REV16A_IB_IO_CLASS;
  1596. target->scsi_host = target_host;
  1597. target->srp_host = host;
  1598. target->lkey = host->srp_dev->mr->lkey;
  1599. target->rkey = host->srp_dev->mr->rkey;
  1600. spin_lock_init(&target->lock);
  1601. INIT_LIST_HEAD(&target->free_tx);
  1602. INIT_LIST_HEAD(&target->free_reqs);
  1603. for (i = 0; i < SRP_CMD_SQ_SIZE; ++i) {
  1604. target->req_ring[i].index = i;
  1605. list_add_tail(&target->req_ring[i].list, &target->free_reqs);
  1606. }
  1607. ret = srp_parse_options(buf, target);
  1608. if (ret)
  1609. goto err;
  1610. ib_query_gid(host->srp_dev->dev, host->port, 0, &target->path.sgid);
  1611. shost_printk(KERN_DEBUG, target->scsi_host, PFX
  1612. "new target: id_ext %016llx ioc_guid %016llx pkey %04x "
  1613. "service_id %016llx dgid %pI6\n",
  1614. (unsigned long long) be64_to_cpu(target->id_ext),
  1615. (unsigned long long) be64_to_cpu(target->ioc_guid),
  1616. be16_to_cpu(target->path.pkey),
  1617. (unsigned long long) be64_to_cpu(target->service_id),
  1618. target->path.dgid.raw);
  1619. ret = srp_create_target_ib(target);
  1620. if (ret)
  1621. goto err;
  1622. ret = srp_new_cm_id(target);
  1623. if (ret)
  1624. goto err_free;
  1625. target->qp_in_error = 0;
  1626. ret = srp_connect_target(target);
  1627. if (ret) {
  1628. shost_printk(KERN_ERR, target->scsi_host,
  1629. PFX "Connection failed\n");
  1630. goto err_cm_id;
  1631. }
  1632. ret = srp_add_target(host, target);
  1633. if (ret)
  1634. goto err_disconnect;
  1635. return count;
  1636. err_disconnect:
  1637. srp_disconnect_target(target);
  1638. err_cm_id:
  1639. ib_destroy_cm_id(target->cm_id);
  1640. err_free:
  1641. srp_free_target_ib(target);
  1642. err:
  1643. scsi_host_put(target_host);
  1644. return ret;
  1645. }
  1646. static DEVICE_ATTR(add_target, S_IWUSR, NULL, srp_create_target);
  1647. static ssize_t show_ibdev(struct device *dev, struct device_attribute *attr,
  1648. char *buf)
  1649. {
  1650. struct srp_host *host = container_of(dev, struct srp_host, dev);
  1651. return sprintf(buf, "%s\n", host->srp_dev->dev->name);
  1652. }
  1653. static DEVICE_ATTR(ibdev, S_IRUGO, show_ibdev, NULL);
  1654. static ssize_t show_port(struct device *dev, struct device_attribute *attr,
  1655. char *buf)
  1656. {
  1657. struct srp_host *host = container_of(dev, struct srp_host, dev);
  1658. return sprintf(buf, "%d\n", host->port);
  1659. }
  1660. static DEVICE_ATTR(port, S_IRUGO, show_port, NULL);
  1661. static struct srp_host *srp_add_port(struct srp_device *device, u8 port)
  1662. {
  1663. struct srp_host *host;
  1664. host = kzalloc(sizeof *host, GFP_KERNEL);
  1665. if (!host)
  1666. return NULL;
  1667. INIT_LIST_HEAD(&host->target_list);
  1668. spin_lock_init(&host->target_lock);
  1669. init_completion(&host->released);
  1670. host->srp_dev = device;
  1671. host->port = port;
  1672. host->dev.class = &srp_class;
  1673. host->dev.parent = device->dev->dma_device;
  1674. dev_set_name(&host->dev, "srp-%s-%d", device->dev->name, port);
  1675. if (device_register(&host->dev))
  1676. goto free_host;
  1677. if (device_create_file(&host->dev, &dev_attr_add_target))
  1678. goto err_class;
  1679. if (device_create_file(&host->dev, &dev_attr_ibdev))
  1680. goto err_class;
  1681. if (device_create_file(&host->dev, &dev_attr_port))
  1682. goto err_class;
  1683. return host;
  1684. err_class:
  1685. device_unregister(&host->dev);
  1686. free_host:
  1687. kfree(host);
  1688. return NULL;
  1689. }
  1690. static void srp_add_one(struct ib_device *device)
  1691. {
  1692. struct srp_device *srp_dev;
  1693. struct ib_device_attr *dev_attr;
  1694. struct ib_fmr_pool_param fmr_param;
  1695. struct srp_host *host;
  1696. int s, e, p;
  1697. dev_attr = kmalloc(sizeof *dev_attr, GFP_KERNEL);
  1698. if (!dev_attr)
  1699. return;
  1700. if (ib_query_device(device, dev_attr)) {
  1701. printk(KERN_WARNING PFX "Query device failed for %s\n",
  1702. device->name);
  1703. goto free_attr;
  1704. }
  1705. srp_dev = kmalloc(sizeof *srp_dev, GFP_KERNEL);
  1706. if (!srp_dev)
  1707. goto free_attr;
  1708. /*
  1709. * Use the smallest page size supported by the HCA, down to a
  1710. * minimum of 512 bytes (which is the smallest sector that a
  1711. * SCSI command will ever carry).
  1712. */
  1713. srp_dev->fmr_page_shift = max(9, ffs(dev_attr->page_size_cap) - 1);
  1714. srp_dev->fmr_page_size = 1 << srp_dev->fmr_page_shift;
  1715. srp_dev->fmr_page_mask = ~((u64) srp_dev->fmr_page_size - 1);
  1716. INIT_LIST_HEAD(&srp_dev->dev_list);
  1717. srp_dev->dev = device;
  1718. srp_dev->pd = ib_alloc_pd(device);
  1719. if (IS_ERR(srp_dev->pd))
  1720. goto free_dev;
  1721. srp_dev->mr = ib_get_dma_mr(srp_dev->pd,
  1722. IB_ACCESS_LOCAL_WRITE |
  1723. IB_ACCESS_REMOTE_READ |
  1724. IB_ACCESS_REMOTE_WRITE);
  1725. if (IS_ERR(srp_dev->mr))
  1726. goto err_pd;
  1727. memset(&fmr_param, 0, sizeof fmr_param);
  1728. fmr_param.pool_size = SRP_FMR_POOL_SIZE;
  1729. fmr_param.dirty_watermark = SRP_FMR_DIRTY_SIZE;
  1730. fmr_param.cache = 1;
  1731. fmr_param.max_pages_per_fmr = SRP_FMR_SIZE;
  1732. fmr_param.page_shift = srp_dev->fmr_page_shift;
  1733. fmr_param.access = (IB_ACCESS_LOCAL_WRITE |
  1734. IB_ACCESS_REMOTE_WRITE |
  1735. IB_ACCESS_REMOTE_READ);
  1736. srp_dev->fmr_pool = ib_create_fmr_pool(srp_dev->pd, &fmr_param);
  1737. if (IS_ERR(srp_dev->fmr_pool))
  1738. srp_dev->fmr_pool = NULL;
  1739. if (device->node_type == RDMA_NODE_IB_SWITCH) {
  1740. s = 0;
  1741. e = 0;
  1742. } else {
  1743. s = 1;
  1744. e = device->phys_port_cnt;
  1745. }
  1746. for (p = s; p <= e; ++p) {
  1747. host = srp_add_port(srp_dev, p);
  1748. if (host)
  1749. list_add_tail(&host->list, &srp_dev->dev_list);
  1750. }
  1751. ib_set_client_data(device, &srp_client, srp_dev);
  1752. goto free_attr;
  1753. err_pd:
  1754. ib_dealloc_pd(srp_dev->pd);
  1755. free_dev:
  1756. kfree(srp_dev);
  1757. free_attr:
  1758. kfree(dev_attr);
  1759. }
  1760. static void srp_remove_one(struct ib_device *device)
  1761. {
  1762. struct srp_device *srp_dev;
  1763. struct srp_host *host, *tmp_host;
  1764. LIST_HEAD(target_list);
  1765. struct srp_target_port *target, *tmp_target;
  1766. srp_dev = ib_get_client_data(device, &srp_client);
  1767. list_for_each_entry_safe(host, tmp_host, &srp_dev->dev_list, list) {
  1768. device_unregister(&host->dev);
  1769. /*
  1770. * Wait for the sysfs entry to go away, so that no new
  1771. * target ports can be created.
  1772. */
  1773. wait_for_completion(&host->released);
  1774. /*
  1775. * Mark all target ports as removed, so we stop queueing
  1776. * commands and don't try to reconnect.
  1777. */
  1778. spin_lock(&host->target_lock);
  1779. list_for_each_entry(target, &host->target_list, list) {
  1780. spin_lock_irq(&target->lock);
  1781. target->state = SRP_TARGET_REMOVED;
  1782. spin_unlock_irq(&target->lock);
  1783. }
  1784. spin_unlock(&host->target_lock);
  1785. /*
  1786. * Wait for any reconnection tasks that may have
  1787. * started before we marked our target ports as
  1788. * removed, and any target port removal tasks.
  1789. */
  1790. flush_workqueue(ib_wq);
  1791. list_for_each_entry_safe(target, tmp_target,
  1792. &host->target_list, list) {
  1793. srp_remove_host(target->scsi_host);
  1794. scsi_remove_host(target->scsi_host);
  1795. srp_disconnect_target(target);
  1796. ib_destroy_cm_id(target->cm_id);
  1797. srp_free_target_ib(target);
  1798. scsi_host_put(target->scsi_host);
  1799. }
  1800. kfree(host);
  1801. }
  1802. if (srp_dev->fmr_pool)
  1803. ib_destroy_fmr_pool(srp_dev->fmr_pool);
  1804. ib_dereg_mr(srp_dev->mr);
  1805. ib_dealloc_pd(srp_dev->pd);
  1806. kfree(srp_dev);
  1807. }
  1808. static struct srp_function_template ib_srp_transport_functions = {
  1809. };
  1810. static int __init srp_init_module(void)
  1811. {
  1812. int ret;
  1813. BUILD_BUG_ON(FIELD_SIZEOF(struct ib_wc, wr_id) < sizeof(void *));
  1814. if (srp_sg_tablesize > 255) {
  1815. printk(KERN_WARNING PFX "Clamping srp_sg_tablesize to 255\n");
  1816. srp_sg_tablesize = 255;
  1817. }
  1818. ib_srp_transport_template =
  1819. srp_attach_transport(&ib_srp_transport_functions);
  1820. if (!ib_srp_transport_template)
  1821. return -ENOMEM;
  1822. srp_template.sg_tablesize = srp_sg_tablesize;
  1823. srp_max_iu_len = (sizeof (struct srp_cmd) +
  1824. sizeof (struct srp_indirect_buf) +
  1825. srp_sg_tablesize * 16);
  1826. ret = class_register(&srp_class);
  1827. if (ret) {
  1828. printk(KERN_ERR PFX "couldn't register class infiniband_srp\n");
  1829. srp_release_transport(ib_srp_transport_template);
  1830. return ret;
  1831. }
  1832. ib_sa_register_client(&srp_sa_client);
  1833. ret = ib_register_client(&srp_client);
  1834. if (ret) {
  1835. printk(KERN_ERR PFX "couldn't register IB client\n");
  1836. srp_release_transport(ib_srp_transport_template);
  1837. ib_sa_unregister_client(&srp_sa_client);
  1838. class_unregister(&srp_class);
  1839. return ret;
  1840. }
  1841. return 0;
  1842. }
  1843. static void __exit srp_cleanup_module(void)
  1844. {
  1845. ib_unregister_client(&srp_client);
  1846. ib_sa_unregister_client(&srp_sa_client);
  1847. class_unregister(&srp_class);
  1848. srp_release_transport(ib_srp_transport_template);
  1849. }
  1850. module_init(srp_init_module);
  1851. module_exit(srp_cleanup_module);