libcxgbi.c 67 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913191419151916191719181919192019211922192319241925192619271928192919301931193219331934193519361937193819391940194119421943194419451946194719481949195019511952195319541955195619571958195919601961196219631964196519661967196819691970197119721973197419751976197719781979198019811982198319841985198619871988198919901991199219931994199519961997199819992000200120022003200420052006200720082009201020112012201320142015201620172018201920202021202220232024202520262027202820292030203120322033203420352036203720382039204020412042204320442045204620472048204920502051205220532054205520562057205820592060206120622063206420652066206720682069207020712072207320742075207620772078207920802081208220832084208520862087208820892090209120922093209420952096209720982099210021012102210321042105210621072108210921102111211221132114211521162117211821192120212121222123212421252126212721282129213021312132213321342135213621372138213921402141214221432144214521462147214821492150215121522153215421552156215721582159216021612162216321642165216621672168216921702171217221732174217521762177217821792180218121822183218421852186218721882189219021912192219321942195219621972198219922002201220222032204220522062207220822092210221122122213221422152216221722182219222022212222222322242225222622272228222922302231223222332234223522362237223822392240224122422243224422452246224722482249225022512252225322542255225622572258225922602261226222632264226522662267226822692270227122722273227422752276227722782279228022812282228322842285228622872288228922902291229222932294229522962297229822992300230123022303230423052306230723082309231023112312231323142315231623172318231923202321232223232324232523262327232823292330233123322333233423352336233723382339234023412342234323442345234623472348234923502351235223532354235523562357235823592360236123622363236423652366236723682369237023712372237323742375237623772378237923802381238223832384238523862387238823892390239123922393239423952396239723982399240024012402240324042405240624072408240924102411241224132414241524162417241824192420242124222423242424252426242724282429243024312432243324342435243624372438243924402441244224432444244524462447244824492450245124522453245424552456245724582459246024612462246324642465246624672468246924702471247224732474247524762477247824792480248124822483248424852486248724882489249024912492249324942495249624972498249925002501250225032504250525062507250825092510251125122513251425152516251725182519252025212522252325242525252625272528252925302531253225332534253525362537253825392540254125422543254425452546254725482549255025512552255325542555255625572558255925602561256225632564256525662567256825692570257125722573257425752576257725782579258025812582258325842585258625872588258925902591259225932594259525962597259825992600260126022603260426052606260726082609261026112612261326142615261626172618261926202621262226232624262526262627262826292630263126322633
  1. /*
  2. * libcxgbi.c: Chelsio common library for T3/T4 iSCSI driver.
  3. *
  4. * Copyright (c) 2010 Chelsio Communications, Inc.
  5. *
  6. * This program is free software; you can redistribute it and/or modify
  7. * it under the terms of the GNU General Public License as published by
  8. * the Free Software Foundation.
  9. *
  10. * Written by: Karen Xie (kxie@chelsio.com)
  11. * Written by: Rakesh Ranjan (rranjan@chelsio.com)
  12. */
  13. #define pr_fmt(fmt) KBUILD_MODNAME ":%s: " fmt, __func__
  14. #include <linux/skbuff.h>
  15. #include <linux/crypto.h>
  16. #include <linux/scatterlist.h>
  17. #include <linux/pci.h>
  18. #include <scsi/scsi.h>
  19. #include <scsi/scsi_cmnd.h>
  20. #include <scsi/scsi_host.h>
  21. #include <linux/if_vlan.h>
  22. #include <linux/inet.h>
  23. #include <net/dst.h>
  24. #include <net/route.h>
  25. #include <linux/inetdevice.h> /* ip_dev_find */
  26. #include <net/tcp.h>
  27. static unsigned int dbg_level;
  28. #include "libcxgbi.h"
  29. #define DRV_MODULE_NAME "libcxgbi"
  30. #define DRV_MODULE_DESC "Chelsio iSCSI driver library"
  31. #define DRV_MODULE_VERSION "0.9.0"
  32. #define DRV_MODULE_RELDATE "Jun. 2010"
  33. MODULE_AUTHOR("Chelsio Communications, Inc.");
  34. MODULE_DESCRIPTION(DRV_MODULE_DESC);
  35. MODULE_VERSION(DRV_MODULE_VERSION);
  36. MODULE_LICENSE("GPL");
  37. module_param(dbg_level, uint, 0644);
  38. MODULE_PARM_DESC(dbg_level, "libiscsi debug level (default=0)");
  39. /*
  40. * cxgbi device management
  41. * maintains a list of the cxgbi devices
  42. */
  43. static LIST_HEAD(cdev_list);
  44. static DEFINE_MUTEX(cdev_mutex);
  45. int cxgbi_device_portmap_create(struct cxgbi_device *cdev, unsigned int base,
  46. unsigned int max_conn)
  47. {
  48. struct cxgbi_ports_map *pmap = &cdev->pmap;
  49. pmap->port_csk = cxgbi_alloc_big_mem(max_conn *
  50. sizeof(struct cxgbi_sock *),
  51. GFP_KERNEL);
  52. if (!pmap->port_csk) {
  53. pr_warn("cdev 0x%p, portmap OOM %u.\n", cdev, max_conn);
  54. return -ENOMEM;
  55. }
  56. pmap->max_connect = max_conn;
  57. pmap->sport_base = base;
  58. spin_lock_init(&pmap->lock);
  59. return 0;
  60. }
  61. EXPORT_SYMBOL_GPL(cxgbi_device_portmap_create);
  62. void cxgbi_device_portmap_cleanup(struct cxgbi_device *cdev)
  63. {
  64. struct cxgbi_ports_map *pmap = &cdev->pmap;
  65. struct cxgbi_sock *csk;
  66. int i;
  67. for (i = 0; i < pmap->max_connect; i++) {
  68. if (pmap->port_csk[i]) {
  69. csk = pmap->port_csk[i];
  70. pmap->port_csk[i] = NULL;
  71. log_debug(1 << CXGBI_DBG_SOCK,
  72. "csk 0x%p, cdev 0x%p, offload down.\n",
  73. csk, cdev);
  74. spin_lock_bh(&csk->lock);
  75. cxgbi_sock_set_flag(csk, CTPF_OFFLOAD_DOWN);
  76. cxgbi_sock_closed(csk);
  77. spin_unlock_bh(&csk->lock);
  78. cxgbi_sock_put(csk);
  79. }
  80. }
  81. }
  82. EXPORT_SYMBOL_GPL(cxgbi_device_portmap_cleanup);
  83. static inline void cxgbi_device_destroy(struct cxgbi_device *cdev)
  84. {
  85. log_debug(1 << CXGBI_DBG_DEV,
  86. "cdev 0x%p, p# %u.\n", cdev, cdev->nports);
  87. cxgbi_hbas_remove(cdev);
  88. cxgbi_device_portmap_cleanup(cdev);
  89. if (cdev->dev_ddp_cleanup)
  90. cdev->dev_ddp_cleanup(cdev);
  91. else
  92. cxgbi_ddp_cleanup(cdev);
  93. if (cdev->ddp)
  94. cxgbi_ddp_cleanup(cdev);
  95. if (cdev->pmap.max_connect)
  96. cxgbi_free_big_mem(cdev->pmap.port_csk);
  97. kfree(cdev);
  98. }
  99. struct cxgbi_device *cxgbi_device_register(unsigned int extra,
  100. unsigned int nports)
  101. {
  102. struct cxgbi_device *cdev;
  103. cdev = kzalloc(sizeof(*cdev) + extra + nports *
  104. (sizeof(struct cxgbi_hba *) +
  105. sizeof(struct net_device *)),
  106. GFP_KERNEL);
  107. if (!cdev) {
  108. pr_warn("nport %d, OOM.\n", nports);
  109. return NULL;
  110. }
  111. cdev->ports = (struct net_device **)(cdev + 1);
  112. cdev->hbas = (struct cxgbi_hba **)(((char*)cdev->ports) + nports *
  113. sizeof(struct net_device *));
  114. if (extra)
  115. cdev->dd_data = ((char *)cdev->hbas) +
  116. nports * sizeof(struct cxgbi_hba *);
  117. spin_lock_init(&cdev->pmap.lock);
  118. mutex_lock(&cdev_mutex);
  119. list_add_tail(&cdev->list_head, &cdev_list);
  120. mutex_unlock(&cdev_mutex);
  121. log_debug(1 << CXGBI_DBG_DEV,
  122. "cdev 0x%p, p# %u.\n", cdev, nports);
  123. return cdev;
  124. }
  125. EXPORT_SYMBOL_GPL(cxgbi_device_register);
  126. void cxgbi_device_unregister(struct cxgbi_device *cdev)
  127. {
  128. log_debug(1 << CXGBI_DBG_DEV,
  129. "cdev 0x%p, p# %u,%s.\n",
  130. cdev, cdev->nports, cdev->nports ? cdev->ports[0]->name : "");
  131. mutex_lock(&cdev_mutex);
  132. list_del(&cdev->list_head);
  133. mutex_unlock(&cdev_mutex);
  134. cxgbi_device_destroy(cdev);
  135. }
  136. EXPORT_SYMBOL_GPL(cxgbi_device_unregister);
  137. void cxgbi_device_unregister_all(unsigned int flag)
  138. {
  139. struct cxgbi_device *cdev, *tmp;
  140. mutex_lock(&cdev_mutex);
  141. list_for_each_entry_safe(cdev, tmp, &cdev_list, list_head) {
  142. if ((cdev->flags & flag) == flag) {
  143. log_debug(1 << CXGBI_DBG_DEV,
  144. "cdev 0x%p, p# %u,%s.\n",
  145. cdev, cdev->nports, cdev->nports ?
  146. cdev->ports[0]->name : "");
  147. list_del(&cdev->list_head);
  148. cxgbi_device_destroy(cdev);
  149. }
  150. }
  151. mutex_unlock(&cdev_mutex);
  152. }
  153. EXPORT_SYMBOL_GPL(cxgbi_device_unregister_all);
  154. struct cxgbi_device *cxgbi_device_find_by_lldev(void *lldev)
  155. {
  156. struct cxgbi_device *cdev, *tmp;
  157. mutex_lock(&cdev_mutex);
  158. list_for_each_entry_safe(cdev, tmp, &cdev_list, list_head) {
  159. if (cdev->lldev == lldev) {
  160. mutex_unlock(&cdev_mutex);
  161. return cdev;
  162. }
  163. }
  164. mutex_unlock(&cdev_mutex);
  165. log_debug(1 << CXGBI_DBG_DEV,
  166. "lldev 0x%p, NO match found.\n", lldev);
  167. return NULL;
  168. }
  169. EXPORT_SYMBOL_GPL(cxgbi_device_find_by_lldev);
  170. static struct cxgbi_device *cxgbi_device_find_by_netdev(struct net_device *ndev,
  171. int *port)
  172. {
  173. struct cxgbi_device *cdev, *tmp;
  174. int i;
  175. if (ndev->priv_flags & IFF_802_1Q_VLAN)
  176. ndev = vlan_dev_real_dev(ndev);
  177. mutex_lock(&cdev_mutex);
  178. list_for_each_entry_safe(cdev, tmp, &cdev_list, list_head) {
  179. for (i = 0; i < cdev->nports; i++) {
  180. if (ndev == cdev->ports[i]) {
  181. mutex_unlock(&cdev_mutex);
  182. if (port)
  183. *port = i;
  184. return cdev;
  185. }
  186. }
  187. }
  188. mutex_unlock(&cdev_mutex);
  189. log_debug(1 << CXGBI_DBG_DEV,
  190. "ndev 0x%p, %s, NO match found.\n", ndev, ndev->name);
  191. return NULL;
  192. }
  193. struct cxgbi_hba *cxgbi_hba_find_by_netdev(struct net_device *dev,
  194. struct cxgbi_device *cdev)
  195. {
  196. int i;
  197. if (dev->priv_flags & IFF_802_1Q_VLAN)
  198. dev = vlan_dev_real_dev(dev);
  199. for (i = 0; i < cdev->nports; i++) {
  200. if (cdev->hbas[i]->ndev == dev)
  201. return cdev->hbas[i];
  202. }
  203. log_debug(1 << CXGBI_DBG_DEV,
  204. "ndev 0x%p, %s, cdev 0x%p, NO match found.\n",
  205. dev, dev->name, cdev);
  206. return NULL;
  207. }
  208. void cxgbi_hbas_remove(struct cxgbi_device *cdev)
  209. {
  210. int i;
  211. struct cxgbi_hba *chba;
  212. log_debug(1 << CXGBI_DBG_DEV,
  213. "cdev 0x%p, p#%u.\n", cdev, cdev->nports);
  214. for (i = 0; i < cdev->nports; i++) {
  215. chba = cdev->hbas[i];
  216. if (chba) {
  217. cdev->hbas[i] = NULL;
  218. iscsi_host_remove(chba->shost);
  219. pci_dev_put(cdev->pdev);
  220. iscsi_host_free(chba->shost);
  221. }
  222. }
  223. }
  224. EXPORT_SYMBOL_GPL(cxgbi_hbas_remove);
  225. int cxgbi_hbas_add(struct cxgbi_device *cdev, unsigned int max_lun,
  226. unsigned int max_id, struct scsi_host_template *sht,
  227. struct scsi_transport_template *stt)
  228. {
  229. struct cxgbi_hba *chba;
  230. struct Scsi_Host *shost;
  231. int i, err;
  232. log_debug(1 << CXGBI_DBG_DEV, "cdev 0x%p, p#%u.\n", cdev, cdev->nports);
  233. for (i = 0; i < cdev->nports; i++) {
  234. shost = iscsi_host_alloc(sht, sizeof(*chba), 1);
  235. if (!shost) {
  236. pr_info("0x%p, p%d, %s, host alloc failed.\n",
  237. cdev, i, cdev->ports[i]->name);
  238. err = -ENOMEM;
  239. goto err_out;
  240. }
  241. shost->transportt = stt;
  242. shost->max_lun = max_lun;
  243. shost->max_id = max_id;
  244. shost->max_channel = 0;
  245. shost->max_cmd_len = 16;
  246. chba = iscsi_host_priv(shost);
  247. chba->cdev = cdev;
  248. chba->ndev = cdev->ports[i];
  249. chba->shost = shost;
  250. log_debug(1 << CXGBI_DBG_DEV,
  251. "cdev 0x%p, p#%d %s: chba 0x%p.\n",
  252. cdev, i, cdev->ports[i]->name, chba);
  253. pci_dev_get(cdev->pdev);
  254. err = iscsi_host_add(shost, &cdev->pdev->dev);
  255. if (err) {
  256. pr_info("cdev 0x%p, p#%d %s, host add failed.\n",
  257. cdev, i, cdev->ports[i]->name);
  258. pci_dev_put(cdev->pdev);
  259. scsi_host_put(shost);
  260. goto err_out;
  261. }
  262. cdev->hbas[i] = chba;
  263. }
  264. return 0;
  265. err_out:
  266. cxgbi_hbas_remove(cdev);
  267. return err;
  268. }
  269. EXPORT_SYMBOL_GPL(cxgbi_hbas_add);
  270. /*
  271. * iSCSI offload
  272. *
  273. * - source port management
  274. * To find a free source port in the port allocation map we use a very simple
  275. * rotor scheme to look for the next free port.
  276. *
  277. * If a source port has been specified make sure that it doesn't collide with
  278. * our normal source port allocation map. If it's outside the range of our
  279. * allocation/deallocation scheme just let them use it.
  280. *
  281. * If the source port is outside our allocation range, the caller is
  282. * responsible for keeping track of their port usage.
  283. */
  284. static int sock_get_port(struct cxgbi_sock *csk)
  285. {
  286. struct cxgbi_device *cdev = csk->cdev;
  287. struct cxgbi_ports_map *pmap = &cdev->pmap;
  288. unsigned int start;
  289. int idx;
  290. if (!pmap->max_connect) {
  291. pr_err("cdev 0x%p, p#%u %s, NO port map.\n",
  292. cdev, csk->port_id, cdev->ports[csk->port_id]->name);
  293. return -EADDRNOTAVAIL;
  294. }
  295. if (csk->saddr.sin_port) {
  296. pr_err("source port NON-ZERO %u.\n",
  297. ntohs(csk->saddr.sin_port));
  298. return -EADDRINUSE;
  299. }
  300. spin_lock_bh(&pmap->lock);
  301. if (pmap->used >= pmap->max_connect) {
  302. spin_unlock_bh(&pmap->lock);
  303. pr_info("cdev 0x%p, p#%u %s, ALL ports used.\n",
  304. cdev, csk->port_id, cdev->ports[csk->port_id]->name);
  305. return -EADDRNOTAVAIL;
  306. }
  307. start = idx = pmap->next;
  308. do {
  309. if (++idx >= pmap->max_connect)
  310. idx = 0;
  311. if (!pmap->port_csk[idx]) {
  312. pmap->used++;
  313. csk->saddr.sin_port =
  314. htons(pmap->sport_base + idx);
  315. pmap->next = idx;
  316. pmap->port_csk[idx] = csk;
  317. spin_unlock_bh(&pmap->lock);
  318. cxgbi_sock_get(csk);
  319. log_debug(1 << CXGBI_DBG_SOCK,
  320. "cdev 0x%p, p#%u %s, p %u, %u.\n",
  321. cdev, csk->port_id,
  322. cdev->ports[csk->port_id]->name,
  323. pmap->sport_base + idx, pmap->next);
  324. return 0;
  325. }
  326. } while (idx != start);
  327. spin_unlock_bh(&pmap->lock);
  328. /* should not happen */
  329. pr_warn("cdev 0x%p, p#%u %s, next %u?\n",
  330. cdev, csk->port_id, cdev->ports[csk->port_id]->name,
  331. pmap->next);
  332. return -EADDRNOTAVAIL;
  333. }
  334. static void sock_put_port(struct cxgbi_sock *csk)
  335. {
  336. struct cxgbi_device *cdev = csk->cdev;
  337. struct cxgbi_ports_map *pmap = &cdev->pmap;
  338. if (csk->saddr.sin_port) {
  339. int idx = ntohs(csk->saddr.sin_port) - pmap->sport_base;
  340. csk->saddr.sin_port = 0;
  341. if (idx < 0 || idx >= pmap->max_connect) {
  342. pr_err("cdev 0x%p, p#%u %s, port %u OOR.\n",
  343. cdev, csk->port_id,
  344. cdev->ports[csk->port_id]->name,
  345. ntohs(csk->saddr.sin_port));
  346. return;
  347. }
  348. spin_lock_bh(&pmap->lock);
  349. pmap->port_csk[idx] = NULL;
  350. pmap->used--;
  351. spin_unlock_bh(&pmap->lock);
  352. log_debug(1 << CXGBI_DBG_SOCK,
  353. "cdev 0x%p, p#%u %s, release %u.\n",
  354. cdev, csk->port_id, cdev->ports[csk->port_id]->name,
  355. pmap->sport_base + idx);
  356. cxgbi_sock_put(csk);
  357. }
  358. }
  359. /*
  360. * iscsi tcp connection
  361. */
  362. void cxgbi_sock_free_cpl_skbs(struct cxgbi_sock *csk)
  363. {
  364. if (csk->cpl_close) {
  365. kfree_skb(csk->cpl_close);
  366. csk->cpl_close = NULL;
  367. }
  368. if (csk->cpl_abort_req) {
  369. kfree_skb(csk->cpl_abort_req);
  370. csk->cpl_abort_req = NULL;
  371. }
  372. if (csk->cpl_abort_rpl) {
  373. kfree_skb(csk->cpl_abort_rpl);
  374. csk->cpl_abort_rpl = NULL;
  375. }
  376. }
  377. EXPORT_SYMBOL_GPL(cxgbi_sock_free_cpl_skbs);
  378. static struct cxgbi_sock *cxgbi_sock_create(struct cxgbi_device *cdev)
  379. {
  380. struct cxgbi_sock *csk = kzalloc(sizeof(*csk), GFP_NOIO);
  381. if (!csk) {
  382. pr_info("alloc csk %zu failed.\n", sizeof(*csk));
  383. return NULL;
  384. }
  385. if (cdev->csk_alloc_cpls(csk) < 0) {
  386. pr_info("csk 0x%p, alloc cpls failed.\n", csk);
  387. kfree(csk);
  388. return NULL;
  389. }
  390. spin_lock_init(&csk->lock);
  391. kref_init(&csk->refcnt);
  392. skb_queue_head_init(&csk->receive_queue);
  393. skb_queue_head_init(&csk->write_queue);
  394. setup_timer(&csk->retry_timer, NULL, (unsigned long)csk);
  395. rwlock_init(&csk->callback_lock);
  396. csk->cdev = cdev;
  397. csk->flags = 0;
  398. cxgbi_sock_set_state(csk, CTP_CLOSED);
  399. log_debug(1 << CXGBI_DBG_SOCK, "cdev 0x%p, new csk 0x%p.\n", cdev, csk);
  400. return csk;
  401. }
  402. static struct rtable *find_route_ipv4(__be32 saddr, __be32 daddr,
  403. __be16 sport, __be16 dport, u8 tos)
  404. {
  405. struct rtable *rt;
  406. struct flowi fl = {
  407. .oif = 0,
  408. .nl_u = {
  409. .ip4_u = {
  410. .daddr = daddr,
  411. .saddr = saddr,
  412. .tos = tos }
  413. },
  414. .proto = IPPROTO_TCP,
  415. .uli_u = {
  416. .ports = {
  417. .sport = sport,
  418. .dport = dport }
  419. }
  420. };
  421. if (ip_route_output_flow(&init_net, &rt, &fl, NULL, 0))
  422. return NULL;
  423. return rt;
  424. }
  425. static struct cxgbi_sock *cxgbi_check_route(struct sockaddr *dst_addr)
  426. {
  427. struct sockaddr_in *daddr = (struct sockaddr_in *)dst_addr;
  428. struct dst_entry *dst;
  429. struct net_device *ndev;
  430. struct cxgbi_device *cdev;
  431. struct rtable *rt = NULL;
  432. struct cxgbi_sock *csk = NULL;
  433. unsigned int mtu = 0;
  434. int port = 0xFFFF;
  435. int err = 0;
  436. if (daddr->sin_family != AF_INET) {
  437. pr_info("address family 0x%x NOT supported.\n",
  438. daddr->sin_family);
  439. err = -EAFNOSUPPORT;
  440. goto err_out;
  441. }
  442. rt = find_route_ipv4(0, daddr->sin_addr.s_addr, 0, daddr->sin_port, 0);
  443. if (!rt) {
  444. pr_info("no route to ipv4 0x%x, port %u.\n",
  445. daddr->sin_addr.s_addr, daddr->sin_port);
  446. err = -ENETUNREACH;
  447. goto err_out;
  448. }
  449. dst = &rt->dst;
  450. ndev = dst->neighbour->dev;
  451. if (rt->rt_flags & (RTCF_MULTICAST | RTCF_BROADCAST)) {
  452. pr_info("multi-cast route %pI4, port %u, dev %s.\n",
  453. &daddr->sin_addr.s_addr, ntohs(daddr->sin_port),
  454. ndev->name);
  455. err = -ENETUNREACH;
  456. goto rel_rt;
  457. }
  458. if (ndev->flags & IFF_LOOPBACK) {
  459. ndev = ip_dev_find(&init_net, daddr->sin_addr.s_addr);
  460. mtu = ndev->mtu;
  461. pr_info("rt dev %s, loopback -> %s, mtu %u.\n",
  462. dst->neighbour->dev->name, ndev->name, mtu);
  463. }
  464. if (ndev->priv_flags & IFF_802_1Q_VLAN) {
  465. ndev = vlan_dev_real_dev(ndev);
  466. pr_info("rt dev %s, vlan -> %s.\n",
  467. dst->neighbour->dev->name, ndev->name);
  468. }
  469. cdev = cxgbi_device_find_by_netdev(ndev, &port);
  470. if (!cdev) {
  471. pr_info("dst %pI4, %s, NOT cxgbi device.\n",
  472. &daddr->sin_addr.s_addr, ndev->name);
  473. err = -ENETUNREACH;
  474. goto rel_rt;
  475. }
  476. log_debug(1 << CXGBI_DBG_SOCK,
  477. "route to %pI4 :%u, ndev p#%d,%s, cdev 0x%p.\n",
  478. &daddr->sin_addr.s_addr, ntohs(daddr->sin_port),
  479. port, ndev->name, cdev);
  480. csk = cxgbi_sock_create(cdev);
  481. if (!csk) {
  482. err = -ENOMEM;
  483. goto rel_rt;
  484. }
  485. csk->cdev = cdev;
  486. csk->port_id = port;
  487. csk->mtu = mtu;
  488. csk->dst = dst;
  489. csk->daddr.sin_addr.s_addr = daddr->sin_addr.s_addr;
  490. csk->daddr.sin_port = daddr->sin_port;
  491. if (cdev->hbas[port]->ipv4addr)
  492. csk->saddr.sin_addr.s_addr = cdev->hbas[port]->ipv4addr;
  493. else
  494. csk->saddr.sin_addr.s_addr = rt->rt_src;
  495. return csk;
  496. rel_rt:
  497. ip_rt_put(rt);
  498. if (csk)
  499. cxgbi_sock_closed(csk);
  500. err_out:
  501. return ERR_PTR(err);
  502. }
  503. void cxgbi_sock_established(struct cxgbi_sock *csk, unsigned int snd_isn,
  504. unsigned int opt)
  505. {
  506. csk->write_seq = csk->snd_nxt = csk->snd_una = snd_isn;
  507. dst_confirm(csk->dst);
  508. smp_mb();
  509. cxgbi_sock_set_state(csk, CTP_ESTABLISHED);
  510. }
  511. EXPORT_SYMBOL_GPL(cxgbi_sock_established);
  512. static void cxgbi_inform_iscsi_conn_closing(struct cxgbi_sock *csk)
  513. {
  514. log_debug(1 << CXGBI_DBG_SOCK,
  515. "csk 0x%p, state %u, flags 0x%lx, conn 0x%p.\n",
  516. csk, csk->state, csk->flags, csk->user_data);
  517. if (csk->state != CTP_ESTABLISHED) {
  518. read_lock_bh(&csk->callback_lock);
  519. if (csk->user_data)
  520. iscsi_conn_failure(csk->user_data,
  521. ISCSI_ERR_CONN_FAILED);
  522. read_unlock_bh(&csk->callback_lock);
  523. }
  524. }
  525. void cxgbi_sock_closed(struct cxgbi_sock *csk)
  526. {
  527. log_debug(1 << CXGBI_DBG_SOCK, "csk 0x%p,%u,0x%lx,%u.\n",
  528. csk, (csk)->state, (csk)->flags, (csk)->tid);
  529. cxgbi_sock_set_flag(csk, CTPF_ACTIVE_CLOSE_NEEDED);
  530. if (csk->state == CTP_ACTIVE_OPEN || csk->state == CTP_CLOSED)
  531. return;
  532. if (csk->saddr.sin_port)
  533. sock_put_port(csk);
  534. if (csk->dst)
  535. dst_release(csk->dst);
  536. csk->cdev->csk_release_offload_resources(csk);
  537. cxgbi_sock_set_state(csk, CTP_CLOSED);
  538. cxgbi_inform_iscsi_conn_closing(csk);
  539. cxgbi_sock_put(csk);
  540. }
  541. EXPORT_SYMBOL_GPL(cxgbi_sock_closed);
  542. static void need_active_close(struct cxgbi_sock *csk)
  543. {
  544. int data_lost;
  545. int close_req = 0;
  546. log_debug(1 << CXGBI_DBG_SOCK, "csk 0x%p,%u,0x%lx,%u.\n",
  547. csk, (csk)->state, (csk)->flags, (csk)->tid);
  548. spin_lock_bh(&csk->lock);
  549. dst_confirm(csk->dst);
  550. data_lost = skb_queue_len(&csk->receive_queue);
  551. __skb_queue_purge(&csk->receive_queue);
  552. if (csk->state == CTP_ACTIVE_OPEN)
  553. cxgbi_sock_set_flag(csk, CTPF_ACTIVE_CLOSE_NEEDED);
  554. else if (csk->state == CTP_ESTABLISHED) {
  555. close_req = 1;
  556. cxgbi_sock_set_state(csk, CTP_ACTIVE_CLOSE);
  557. } else if (csk->state == CTP_PASSIVE_CLOSE) {
  558. close_req = 1;
  559. cxgbi_sock_set_state(csk, CTP_CLOSE_WAIT_2);
  560. }
  561. if (close_req) {
  562. if (data_lost)
  563. csk->cdev->csk_send_abort_req(csk);
  564. else
  565. csk->cdev->csk_send_close_req(csk);
  566. }
  567. spin_unlock_bh(&csk->lock);
  568. }
  569. void cxgbi_sock_fail_act_open(struct cxgbi_sock *csk, int errno)
  570. {
  571. pr_info("csk 0x%p,%u,%lx, %pI4:%u-%pI4:%u, err %d.\n",
  572. csk, csk->state, csk->flags,
  573. &csk->saddr.sin_addr.s_addr, csk->saddr.sin_port,
  574. &csk->daddr.sin_addr.s_addr, csk->daddr.sin_port,
  575. errno);
  576. cxgbi_sock_set_state(csk, CTP_CONNECTING);
  577. csk->err = errno;
  578. cxgbi_sock_closed(csk);
  579. }
  580. EXPORT_SYMBOL_GPL(cxgbi_sock_fail_act_open);
  581. void cxgbi_sock_act_open_req_arp_failure(void *handle, struct sk_buff *skb)
  582. {
  583. struct cxgbi_sock *csk = (struct cxgbi_sock *)skb->sk;
  584. log_debug(1 << CXGBI_DBG_SOCK, "csk 0x%p,%u,0x%lx,%u.\n",
  585. csk, (csk)->state, (csk)->flags, (csk)->tid);
  586. cxgbi_sock_get(csk);
  587. spin_lock_bh(&csk->lock);
  588. if (csk->state == CTP_ACTIVE_OPEN)
  589. cxgbi_sock_fail_act_open(csk, -EHOSTUNREACH);
  590. spin_unlock_bh(&csk->lock);
  591. cxgbi_sock_put(csk);
  592. __kfree_skb(skb);
  593. }
  594. EXPORT_SYMBOL_GPL(cxgbi_sock_act_open_req_arp_failure);
  595. void cxgbi_sock_rcv_abort_rpl(struct cxgbi_sock *csk)
  596. {
  597. cxgbi_sock_get(csk);
  598. spin_lock_bh(&csk->lock);
  599. if (cxgbi_sock_flag(csk, CTPF_ABORT_RPL_PENDING)) {
  600. if (!cxgbi_sock_flag(csk, CTPF_ABORT_RPL_RCVD))
  601. cxgbi_sock_set_flag(csk, CTPF_ABORT_RPL_RCVD);
  602. else {
  603. cxgbi_sock_clear_flag(csk, CTPF_ABORT_RPL_RCVD);
  604. cxgbi_sock_clear_flag(csk, CTPF_ABORT_RPL_PENDING);
  605. if (cxgbi_sock_flag(csk, CTPF_ABORT_REQ_RCVD))
  606. pr_err("csk 0x%p,%u,0x%lx,%u,ABT_RPL_RSS.\n",
  607. csk, csk->state, csk->flags, csk->tid);
  608. cxgbi_sock_closed(csk);
  609. }
  610. }
  611. spin_unlock_bh(&csk->lock);
  612. cxgbi_sock_put(csk);
  613. }
  614. EXPORT_SYMBOL_GPL(cxgbi_sock_rcv_abort_rpl);
  615. void cxgbi_sock_rcv_peer_close(struct cxgbi_sock *csk)
  616. {
  617. log_debug(1 << CXGBI_DBG_SOCK, "csk 0x%p,%u,0x%lx,%u.\n",
  618. csk, (csk)->state, (csk)->flags, (csk)->tid);
  619. cxgbi_sock_get(csk);
  620. spin_lock_bh(&csk->lock);
  621. if (cxgbi_sock_flag(csk, CTPF_ABORT_RPL_PENDING))
  622. goto done;
  623. switch (csk->state) {
  624. case CTP_ESTABLISHED:
  625. cxgbi_sock_set_state(csk, CTP_PASSIVE_CLOSE);
  626. break;
  627. case CTP_ACTIVE_CLOSE:
  628. cxgbi_sock_set_state(csk, CTP_CLOSE_WAIT_2);
  629. break;
  630. case CTP_CLOSE_WAIT_1:
  631. cxgbi_sock_closed(csk);
  632. break;
  633. case CTP_ABORTING:
  634. break;
  635. default:
  636. pr_err("csk 0x%p,%u,0x%lx,%u, bad state.\n",
  637. csk, csk->state, csk->flags, csk->tid);
  638. }
  639. cxgbi_inform_iscsi_conn_closing(csk);
  640. done:
  641. spin_unlock_bh(&csk->lock);
  642. cxgbi_sock_put(csk);
  643. }
  644. EXPORT_SYMBOL_GPL(cxgbi_sock_rcv_peer_close);
  645. void cxgbi_sock_rcv_close_conn_rpl(struct cxgbi_sock *csk, u32 snd_nxt)
  646. {
  647. log_debug(1 << CXGBI_DBG_SOCK, "csk 0x%p,%u,0x%lx,%u.\n",
  648. csk, (csk)->state, (csk)->flags, (csk)->tid);
  649. cxgbi_sock_get(csk);
  650. spin_lock_bh(&csk->lock);
  651. csk->snd_una = snd_nxt - 1;
  652. if (cxgbi_sock_flag(csk, CTPF_ABORT_RPL_PENDING))
  653. goto done;
  654. switch (csk->state) {
  655. case CTP_ACTIVE_CLOSE:
  656. cxgbi_sock_set_state(csk, CTP_CLOSE_WAIT_1);
  657. break;
  658. case CTP_CLOSE_WAIT_1:
  659. case CTP_CLOSE_WAIT_2:
  660. cxgbi_sock_closed(csk);
  661. break;
  662. case CTP_ABORTING:
  663. break;
  664. default:
  665. pr_err("csk 0x%p,%u,0x%lx,%u, bad state.\n",
  666. csk, csk->state, csk->flags, csk->tid);
  667. }
  668. done:
  669. spin_unlock_bh(&csk->lock);
  670. cxgbi_sock_put(csk);
  671. }
  672. EXPORT_SYMBOL_GPL(cxgbi_sock_rcv_close_conn_rpl);
  673. void cxgbi_sock_rcv_wr_ack(struct cxgbi_sock *csk, unsigned int credits,
  674. unsigned int snd_una, int seq_chk)
  675. {
  676. log_debug(1 << CXGBI_DBG_TOE | 1 << CXGBI_DBG_SOCK,
  677. "csk 0x%p,%u,0x%lx,%u, cr %u,%u+%u, snd_una %u,%d.\n",
  678. csk, csk->state, csk->flags, csk->tid, credits,
  679. csk->wr_cred, csk->wr_una_cred, snd_una, seq_chk);
  680. spin_lock_bh(&csk->lock);
  681. csk->wr_cred += credits;
  682. if (csk->wr_una_cred > csk->wr_max_cred - csk->wr_cred)
  683. csk->wr_una_cred = csk->wr_max_cred - csk->wr_cred;
  684. while (credits) {
  685. struct sk_buff *p = cxgbi_sock_peek_wr(csk);
  686. if (unlikely(!p)) {
  687. pr_err("csk 0x%p,%u,0x%lx,%u, cr %u,%u+%u, empty.\n",
  688. csk, csk->state, csk->flags, csk->tid, credits,
  689. csk->wr_cred, csk->wr_una_cred);
  690. break;
  691. }
  692. if (unlikely(credits < p->csum)) {
  693. pr_warn("csk 0x%p,%u,0x%lx,%u, cr %u,%u+%u, < %u.\n",
  694. csk, csk->state, csk->flags, csk->tid,
  695. credits, csk->wr_cred, csk->wr_una_cred,
  696. p->csum);
  697. p->csum -= credits;
  698. break;
  699. } else {
  700. cxgbi_sock_dequeue_wr(csk);
  701. credits -= p->csum;
  702. kfree_skb(p);
  703. }
  704. }
  705. cxgbi_sock_check_wr_invariants(csk);
  706. if (seq_chk) {
  707. if (unlikely(before(snd_una, csk->snd_una))) {
  708. pr_warn("csk 0x%p,%u,0x%lx,%u, snd_una %u/%u.",
  709. csk, csk->state, csk->flags, csk->tid, snd_una,
  710. csk->snd_una);
  711. goto done;
  712. }
  713. if (csk->snd_una != snd_una) {
  714. csk->snd_una = snd_una;
  715. dst_confirm(csk->dst);
  716. }
  717. }
  718. if (skb_queue_len(&csk->write_queue)) {
  719. if (csk->cdev->csk_push_tx_frames(csk, 0))
  720. cxgbi_conn_tx_open(csk);
  721. } else
  722. cxgbi_conn_tx_open(csk);
  723. done:
  724. spin_unlock_bh(&csk->lock);
  725. }
  726. EXPORT_SYMBOL_GPL(cxgbi_sock_rcv_wr_ack);
  727. static unsigned int cxgbi_sock_find_best_mtu(struct cxgbi_sock *csk,
  728. unsigned short mtu)
  729. {
  730. int i = 0;
  731. while (i < csk->cdev->nmtus - 1 && csk->cdev->mtus[i + 1] <= mtu)
  732. ++i;
  733. return i;
  734. }
  735. unsigned int cxgbi_sock_select_mss(struct cxgbi_sock *csk, unsigned int pmtu)
  736. {
  737. unsigned int idx;
  738. struct dst_entry *dst = csk->dst;
  739. csk->advmss = dst_metric(dst, RTAX_ADVMSS);
  740. if (csk->advmss > pmtu - 40)
  741. csk->advmss = pmtu - 40;
  742. if (csk->advmss < csk->cdev->mtus[0] - 40)
  743. csk->advmss = csk->cdev->mtus[0] - 40;
  744. idx = cxgbi_sock_find_best_mtu(csk, csk->advmss + 40);
  745. return idx;
  746. }
  747. EXPORT_SYMBOL_GPL(cxgbi_sock_select_mss);
  748. void cxgbi_sock_skb_entail(struct cxgbi_sock *csk, struct sk_buff *skb)
  749. {
  750. cxgbi_skcb_tcp_seq(skb) = csk->write_seq;
  751. __skb_queue_tail(&csk->write_queue, skb);
  752. }
  753. EXPORT_SYMBOL_GPL(cxgbi_sock_skb_entail);
  754. void cxgbi_sock_purge_wr_queue(struct cxgbi_sock *csk)
  755. {
  756. struct sk_buff *skb;
  757. while ((skb = cxgbi_sock_dequeue_wr(csk)) != NULL)
  758. kfree_skb(skb);
  759. }
  760. EXPORT_SYMBOL_GPL(cxgbi_sock_purge_wr_queue);
  761. void cxgbi_sock_check_wr_invariants(const struct cxgbi_sock *csk)
  762. {
  763. int pending = cxgbi_sock_count_pending_wrs(csk);
  764. if (unlikely(csk->wr_cred + pending != csk->wr_max_cred))
  765. pr_err("csk 0x%p, tid %u, credit %u + %u != %u.\n",
  766. csk, csk->tid, csk->wr_cred, pending, csk->wr_max_cred);
  767. }
  768. EXPORT_SYMBOL_GPL(cxgbi_sock_check_wr_invariants);
  769. static int cxgbi_sock_send_pdus(struct cxgbi_sock *csk, struct sk_buff *skb)
  770. {
  771. struct cxgbi_device *cdev = csk->cdev;
  772. struct sk_buff *next;
  773. int err, copied = 0;
  774. spin_lock_bh(&csk->lock);
  775. if (csk->state != CTP_ESTABLISHED) {
  776. log_debug(1 << CXGBI_DBG_PDU_TX,
  777. "csk 0x%p,%u,0x%lx,%u, EAGAIN.\n",
  778. csk, csk->state, csk->flags, csk->tid);
  779. err = -EAGAIN;
  780. goto out_err;
  781. }
  782. if (csk->err) {
  783. log_debug(1 << CXGBI_DBG_PDU_TX,
  784. "csk 0x%p,%u,0x%lx,%u, EPIPE %d.\n",
  785. csk, csk->state, csk->flags, csk->tid, csk->err);
  786. err = -EPIPE;
  787. goto out_err;
  788. }
  789. if (csk->write_seq - csk->snd_una >= cdev->snd_win) {
  790. log_debug(1 << CXGBI_DBG_PDU_TX,
  791. "csk 0x%p,%u,0x%lx,%u, FULL %u-%u >= %u.\n",
  792. csk, csk->state, csk->flags, csk->tid, csk->write_seq,
  793. csk->snd_una, cdev->snd_win);
  794. err = -ENOBUFS;
  795. goto out_err;
  796. }
  797. while (skb) {
  798. int frags = skb_shinfo(skb)->nr_frags +
  799. (skb->len != skb->data_len);
  800. if (unlikely(skb_headroom(skb) < cdev->skb_tx_rsvd)) {
  801. pr_err("csk 0x%p, skb head %u < %u.\n",
  802. csk, skb_headroom(skb), cdev->skb_tx_rsvd);
  803. err = -EINVAL;
  804. goto out_err;
  805. }
  806. if (frags >= SKB_WR_LIST_SIZE) {
  807. pr_err("csk 0x%p, frags %d, %u,%u >%u.\n",
  808. csk, skb_shinfo(skb)->nr_frags, skb->len,
  809. skb->data_len, (uint)(SKB_WR_LIST_SIZE));
  810. err = -EINVAL;
  811. goto out_err;
  812. }
  813. next = skb->next;
  814. skb->next = NULL;
  815. cxgbi_skcb_set_flag(skb, SKCBF_TX_NEED_HDR);
  816. cxgbi_sock_skb_entail(csk, skb);
  817. copied += skb->len;
  818. csk->write_seq += skb->len +
  819. cxgbi_ulp_extra_len(cxgbi_skcb_ulp_mode(skb));
  820. skb = next;
  821. }
  822. done:
  823. if (likely(skb_queue_len(&csk->write_queue)))
  824. cdev->csk_push_tx_frames(csk, 1);
  825. spin_unlock_bh(&csk->lock);
  826. return copied;
  827. out_err:
  828. if (copied == 0 && err == -EPIPE)
  829. copied = csk->err ? csk->err : -EPIPE;
  830. else
  831. copied = err;
  832. goto done;
  833. }
  834. /*
  835. * Direct Data Placement -
  836. * Directly place the iSCSI Data-In or Data-Out PDU's payload into pre-posted
  837. * final destination host-memory buffers based on the Initiator Task Tag (ITT)
  838. * in Data-In or Target Task Tag (TTT) in Data-Out PDUs.
  839. * The host memory address is programmed into h/w in the format of pagepod
  840. * entries.
  841. * The location of the pagepod entry is encoded into ddp tag which is used as
  842. * the base for ITT/TTT.
  843. */
  844. static unsigned char ddp_page_order[DDP_PGIDX_MAX] = {0, 1, 2, 4};
  845. static unsigned char ddp_page_shift[DDP_PGIDX_MAX] = {12, 13, 14, 16};
  846. static unsigned char page_idx = DDP_PGIDX_MAX;
  847. static unsigned char sw_tag_idx_bits;
  848. static unsigned char sw_tag_age_bits;
  849. /*
  850. * Direct-Data Placement page size adjustment
  851. */
  852. static int ddp_adjust_page_table(void)
  853. {
  854. int i;
  855. unsigned int base_order, order;
  856. if (PAGE_SIZE < (1UL << ddp_page_shift[0])) {
  857. pr_info("PAGE_SIZE 0x%lx too small, min 0x%lx\n",
  858. PAGE_SIZE, 1UL << ddp_page_shift[0]);
  859. return -EINVAL;
  860. }
  861. base_order = get_order(1UL << ddp_page_shift[0]);
  862. order = get_order(1UL << PAGE_SHIFT);
  863. for (i = 0; i < DDP_PGIDX_MAX; i++) {
  864. /* first is the kernel page size, then just doubling */
  865. ddp_page_order[i] = order - base_order + i;
  866. ddp_page_shift[i] = PAGE_SHIFT + i;
  867. }
  868. return 0;
  869. }
  870. static int ddp_find_page_index(unsigned long pgsz)
  871. {
  872. int i;
  873. for (i = 0; i < DDP_PGIDX_MAX; i++) {
  874. if (pgsz == (1UL << ddp_page_shift[i]))
  875. return i;
  876. }
  877. pr_info("ddp page size %lu not supported.\n", pgsz);
  878. return DDP_PGIDX_MAX;
  879. }
  880. static void ddp_setup_host_page_size(void)
  881. {
  882. if (page_idx == DDP_PGIDX_MAX) {
  883. page_idx = ddp_find_page_index(PAGE_SIZE);
  884. if (page_idx == DDP_PGIDX_MAX) {
  885. pr_info("system PAGE %lu, update hw.\n", PAGE_SIZE);
  886. if (ddp_adjust_page_table() < 0) {
  887. pr_info("PAGE %lu, disable ddp.\n", PAGE_SIZE);
  888. return;
  889. }
  890. page_idx = ddp_find_page_index(PAGE_SIZE);
  891. }
  892. pr_info("system PAGE %lu, ddp idx %u.\n", PAGE_SIZE, page_idx);
  893. }
  894. }
  895. void cxgbi_ddp_page_size_factor(int *pgsz_factor)
  896. {
  897. int i;
  898. for (i = 0; i < DDP_PGIDX_MAX; i++)
  899. pgsz_factor[i] = ddp_page_order[i];
  900. }
  901. EXPORT_SYMBOL_GPL(cxgbi_ddp_page_size_factor);
  902. /*
  903. * DDP setup & teardown
  904. */
  905. void cxgbi_ddp_ppod_set(struct cxgbi_pagepod *ppod,
  906. struct cxgbi_pagepod_hdr *hdr,
  907. struct cxgbi_gather_list *gl, unsigned int gidx)
  908. {
  909. int i;
  910. memcpy(ppod, hdr, sizeof(*hdr));
  911. for (i = 0; i < (PPOD_PAGES_MAX + 1); i++, gidx++) {
  912. ppod->addr[i] = gidx < gl->nelem ?
  913. cpu_to_be64(gl->phys_addr[gidx]) : 0ULL;
  914. }
  915. }
  916. EXPORT_SYMBOL_GPL(cxgbi_ddp_ppod_set);
  917. void cxgbi_ddp_ppod_clear(struct cxgbi_pagepod *ppod)
  918. {
  919. memset(ppod, 0, sizeof(*ppod));
  920. }
  921. EXPORT_SYMBOL_GPL(cxgbi_ddp_ppod_clear);
  922. static inline int ddp_find_unused_entries(struct cxgbi_ddp_info *ddp,
  923. unsigned int start, unsigned int max,
  924. unsigned int count,
  925. struct cxgbi_gather_list *gl)
  926. {
  927. unsigned int i, j, k;
  928. /* not enough entries */
  929. if ((max - start) < count) {
  930. log_debug(1 << CXGBI_DBG_DDP,
  931. "NOT enough entries %u+%u < %u.\n", start, count, max);
  932. return -EBUSY;
  933. }
  934. max -= count;
  935. spin_lock(&ddp->map_lock);
  936. for (i = start; i < max;) {
  937. for (j = 0, k = i; j < count; j++, k++) {
  938. if (ddp->gl_map[k])
  939. break;
  940. }
  941. if (j == count) {
  942. for (j = 0, k = i; j < count; j++, k++)
  943. ddp->gl_map[k] = gl;
  944. spin_unlock(&ddp->map_lock);
  945. return i;
  946. }
  947. i += j + 1;
  948. }
  949. spin_unlock(&ddp->map_lock);
  950. log_debug(1 << CXGBI_DBG_DDP,
  951. "NO suitable entries %u available.\n", count);
  952. return -EBUSY;
  953. }
  954. static inline void ddp_unmark_entries(struct cxgbi_ddp_info *ddp,
  955. int start, int count)
  956. {
  957. spin_lock(&ddp->map_lock);
  958. memset(&ddp->gl_map[start], 0,
  959. count * sizeof(struct cxgbi_gather_list *));
  960. spin_unlock(&ddp->map_lock);
  961. }
  962. static inline void ddp_gl_unmap(struct pci_dev *pdev,
  963. struct cxgbi_gather_list *gl)
  964. {
  965. int i;
  966. for (i = 0; i < gl->nelem; i++)
  967. dma_unmap_page(&pdev->dev, gl->phys_addr[i], PAGE_SIZE,
  968. PCI_DMA_FROMDEVICE);
  969. }
  970. static inline int ddp_gl_map(struct pci_dev *pdev,
  971. struct cxgbi_gather_list *gl)
  972. {
  973. int i;
  974. for (i = 0; i < gl->nelem; i++) {
  975. gl->phys_addr[i] = dma_map_page(&pdev->dev, gl->pages[i], 0,
  976. PAGE_SIZE,
  977. PCI_DMA_FROMDEVICE);
  978. if (unlikely(dma_mapping_error(&pdev->dev, gl->phys_addr[i]))) {
  979. log_debug(1 << CXGBI_DBG_DDP,
  980. "page %d 0x%p, 0x%p dma mapping err.\n",
  981. i, gl->pages[i], pdev);
  982. goto unmap;
  983. }
  984. }
  985. return i;
  986. unmap:
  987. if (i) {
  988. unsigned int nelem = gl->nelem;
  989. gl->nelem = i;
  990. ddp_gl_unmap(pdev, gl);
  991. gl->nelem = nelem;
  992. }
  993. return -EINVAL;
  994. }
  995. static void ddp_release_gl(struct cxgbi_gather_list *gl,
  996. struct pci_dev *pdev)
  997. {
  998. ddp_gl_unmap(pdev, gl);
  999. kfree(gl);
  1000. }
  1001. static struct cxgbi_gather_list *ddp_make_gl(unsigned int xferlen,
  1002. struct scatterlist *sgl,
  1003. unsigned int sgcnt,
  1004. struct pci_dev *pdev,
  1005. gfp_t gfp)
  1006. {
  1007. struct cxgbi_gather_list *gl;
  1008. struct scatterlist *sg = sgl;
  1009. struct page *sgpage = sg_page(sg);
  1010. unsigned int sglen = sg->length;
  1011. unsigned int sgoffset = sg->offset;
  1012. unsigned int npages = (xferlen + sgoffset + PAGE_SIZE - 1) >>
  1013. PAGE_SHIFT;
  1014. int i = 1, j = 0;
  1015. if (xferlen < DDP_THRESHOLD) {
  1016. log_debug(1 << CXGBI_DBG_DDP,
  1017. "xfer %u < threshold %u, no ddp.\n",
  1018. xferlen, DDP_THRESHOLD);
  1019. return NULL;
  1020. }
  1021. gl = kzalloc(sizeof(struct cxgbi_gather_list) +
  1022. npages * (sizeof(dma_addr_t) +
  1023. sizeof(struct page *)), gfp);
  1024. if (!gl) {
  1025. log_debug(1 << CXGBI_DBG_DDP,
  1026. "xfer %u, %u pages, OOM.\n", xferlen, npages);
  1027. return NULL;
  1028. }
  1029. log_debug(1 << CXGBI_DBG_DDP,
  1030. "xfer %u, sgl %u, gl max %u.\n", xferlen, sgcnt, npages);
  1031. gl->pages = (struct page **)&gl->phys_addr[npages];
  1032. gl->nelem = npages;
  1033. gl->length = xferlen;
  1034. gl->offset = sgoffset;
  1035. gl->pages[0] = sgpage;
  1036. for (i = 1, sg = sg_next(sgl), j = 0; i < sgcnt;
  1037. i++, sg = sg_next(sg)) {
  1038. struct page *page = sg_page(sg);
  1039. if (sgpage == page && sg->offset == sgoffset + sglen)
  1040. sglen += sg->length;
  1041. else {
  1042. /* make sure the sgl is fit for ddp:
  1043. * each has the same page size, and
  1044. * all of the middle pages are used completely
  1045. */
  1046. if ((j && sgoffset) || ((i != sgcnt - 1) &&
  1047. ((sglen + sgoffset) & ~PAGE_MASK))) {
  1048. log_debug(1 << CXGBI_DBG_DDP,
  1049. "page %d/%u, %u + %u.\n",
  1050. i, sgcnt, sgoffset, sglen);
  1051. goto error_out;
  1052. }
  1053. j++;
  1054. if (j == gl->nelem || sg->offset) {
  1055. log_debug(1 << CXGBI_DBG_DDP,
  1056. "page %d/%u, offset %u.\n",
  1057. j, gl->nelem, sg->offset);
  1058. goto error_out;
  1059. }
  1060. gl->pages[j] = page;
  1061. sglen = sg->length;
  1062. sgoffset = sg->offset;
  1063. sgpage = page;
  1064. }
  1065. }
  1066. gl->nelem = ++j;
  1067. if (ddp_gl_map(pdev, gl) < 0)
  1068. goto error_out;
  1069. return gl;
  1070. error_out:
  1071. kfree(gl);
  1072. return NULL;
  1073. }
  1074. static void ddp_tag_release(struct cxgbi_hba *chba, u32 tag)
  1075. {
  1076. struct cxgbi_device *cdev = chba->cdev;
  1077. struct cxgbi_ddp_info *ddp = cdev->ddp;
  1078. u32 idx;
  1079. idx = (tag >> PPOD_IDX_SHIFT) & ddp->idx_mask;
  1080. if (idx < ddp->nppods) {
  1081. struct cxgbi_gather_list *gl = ddp->gl_map[idx];
  1082. unsigned int npods;
  1083. if (!gl || !gl->nelem) {
  1084. pr_warn("tag 0x%x, idx %u, gl 0x%p, %u.\n",
  1085. tag, idx, gl, gl ? gl->nelem : 0);
  1086. return;
  1087. }
  1088. npods = (gl->nelem + PPOD_PAGES_MAX - 1) >> PPOD_PAGES_SHIFT;
  1089. log_debug(1 << CXGBI_DBG_DDP,
  1090. "tag 0x%x, release idx %u, npods %u.\n",
  1091. tag, idx, npods);
  1092. cdev->csk_ddp_clear(chba, tag, idx, npods);
  1093. ddp_unmark_entries(ddp, idx, npods);
  1094. ddp_release_gl(gl, ddp->pdev);
  1095. } else
  1096. pr_warn("tag 0x%x, idx %u > max %u.\n", tag, idx, ddp->nppods);
  1097. }
  1098. static int ddp_tag_reserve(struct cxgbi_sock *csk, unsigned int tid,
  1099. u32 sw_tag, u32 *tagp, struct cxgbi_gather_list *gl,
  1100. gfp_t gfp)
  1101. {
  1102. struct cxgbi_device *cdev = csk->cdev;
  1103. struct cxgbi_ddp_info *ddp = cdev->ddp;
  1104. struct cxgbi_tag_format *tformat = &cdev->tag_format;
  1105. struct cxgbi_pagepod_hdr hdr;
  1106. unsigned int npods;
  1107. int idx = -1;
  1108. int err = -ENOMEM;
  1109. u32 tag;
  1110. npods = (gl->nelem + PPOD_PAGES_MAX - 1) >> PPOD_PAGES_SHIFT;
  1111. if (ddp->idx_last == ddp->nppods)
  1112. idx = ddp_find_unused_entries(ddp, 0, ddp->nppods,
  1113. npods, gl);
  1114. else {
  1115. idx = ddp_find_unused_entries(ddp, ddp->idx_last + 1,
  1116. ddp->nppods, npods,
  1117. gl);
  1118. if (idx < 0 && ddp->idx_last >= npods) {
  1119. idx = ddp_find_unused_entries(ddp, 0,
  1120. min(ddp->idx_last + npods, ddp->nppods),
  1121. npods, gl);
  1122. }
  1123. }
  1124. if (idx < 0) {
  1125. log_debug(1 << CXGBI_DBG_DDP,
  1126. "xferlen %u, gl %u, npods %u NO DDP.\n",
  1127. gl->length, gl->nelem, npods);
  1128. return idx;
  1129. }
  1130. if (cdev->csk_ddp_alloc_gl_skb) {
  1131. err = cdev->csk_ddp_alloc_gl_skb(ddp, idx, npods, gfp);
  1132. if (err < 0)
  1133. goto unmark_entries;
  1134. }
  1135. tag = cxgbi_ddp_tag_base(tformat, sw_tag);
  1136. tag |= idx << PPOD_IDX_SHIFT;
  1137. hdr.rsvd = 0;
  1138. hdr.vld_tid = htonl(PPOD_VALID_FLAG | PPOD_TID(tid));
  1139. hdr.pgsz_tag_clr = htonl(tag & ddp->rsvd_tag_mask);
  1140. hdr.max_offset = htonl(gl->length);
  1141. hdr.page_offset = htonl(gl->offset);
  1142. err = cdev->csk_ddp_set(csk, &hdr, idx, npods, gl);
  1143. if (err < 0) {
  1144. if (cdev->csk_ddp_free_gl_skb)
  1145. cdev->csk_ddp_free_gl_skb(ddp, idx, npods);
  1146. goto unmark_entries;
  1147. }
  1148. ddp->idx_last = idx;
  1149. log_debug(1 << CXGBI_DBG_DDP,
  1150. "xfer %u, gl %u,%u, tid 0x%x, tag 0x%x->0x%x(%u,%u).\n",
  1151. gl->length, gl->nelem, gl->offset, tid, sw_tag, tag, idx,
  1152. npods);
  1153. *tagp = tag;
  1154. return 0;
  1155. unmark_entries:
  1156. ddp_unmark_entries(ddp, idx, npods);
  1157. return err;
  1158. }
  1159. int cxgbi_ddp_reserve(struct cxgbi_sock *csk, unsigned int *tagp,
  1160. unsigned int sw_tag, unsigned int xferlen,
  1161. struct scatterlist *sgl, unsigned int sgcnt, gfp_t gfp)
  1162. {
  1163. struct cxgbi_device *cdev = csk->cdev;
  1164. struct cxgbi_tag_format *tformat = &cdev->tag_format;
  1165. struct cxgbi_gather_list *gl;
  1166. int err;
  1167. if (page_idx >= DDP_PGIDX_MAX || !cdev->ddp ||
  1168. xferlen < DDP_THRESHOLD) {
  1169. log_debug(1 << CXGBI_DBG_DDP,
  1170. "pgidx %u, xfer %u, NO ddp.\n", page_idx, xferlen);
  1171. return -EINVAL;
  1172. }
  1173. if (!cxgbi_sw_tag_usable(tformat, sw_tag)) {
  1174. log_debug(1 << CXGBI_DBG_DDP,
  1175. "sw_tag 0x%x NOT usable.\n", sw_tag);
  1176. return -EINVAL;
  1177. }
  1178. gl = ddp_make_gl(xferlen, sgl, sgcnt, cdev->pdev, gfp);
  1179. if (!gl)
  1180. return -ENOMEM;
  1181. err = ddp_tag_reserve(csk, csk->tid, sw_tag, tagp, gl, gfp);
  1182. if (err < 0)
  1183. ddp_release_gl(gl, cdev->pdev);
  1184. return err;
  1185. }
  1186. static void ddp_destroy(struct kref *kref)
  1187. {
  1188. struct cxgbi_ddp_info *ddp = container_of(kref,
  1189. struct cxgbi_ddp_info,
  1190. refcnt);
  1191. struct cxgbi_device *cdev = ddp->cdev;
  1192. int i = 0;
  1193. pr_info("kref 0, destroy ddp 0x%p, cdev 0x%p.\n", ddp, cdev);
  1194. while (i < ddp->nppods) {
  1195. struct cxgbi_gather_list *gl = ddp->gl_map[i];
  1196. if (gl) {
  1197. int npods = (gl->nelem + PPOD_PAGES_MAX - 1)
  1198. >> PPOD_PAGES_SHIFT;
  1199. pr_info("cdev 0x%p, ddp %d + %d.\n", cdev, i, npods);
  1200. kfree(gl);
  1201. if (cdev->csk_ddp_free_gl_skb)
  1202. cdev->csk_ddp_free_gl_skb(ddp, i, npods);
  1203. i += npods;
  1204. } else
  1205. i++;
  1206. }
  1207. cxgbi_free_big_mem(ddp);
  1208. }
  1209. int cxgbi_ddp_cleanup(struct cxgbi_device *cdev)
  1210. {
  1211. struct cxgbi_ddp_info *ddp = cdev->ddp;
  1212. log_debug(1 << CXGBI_DBG_DDP,
  1213. "cdev 0x%p, release ddp 0x%p.\n", cdev, ddp);
  1214. cdev->ddp = NULL;
  1215. if (ddp)
  1216. return kref_put(&ddp->refcnt, ddp_destroy);
  1217. return 0;
  1218. }
  1219. EXPORT_SYMBOL_GPL(cxgbi_ddp_cleanup);
  1220. int cxgbi_ddp_init(struct cxgbi_device *cdev,
  1221. unsigned int llimit, unsigned int ulimit,
  1222. unsigned int max_txsz, unsigned int max_rxsz)
  1223. {
  1224. struct cxgbi_ddp_info *ddp;
  1225. unsigned int ppmax, bits;
  1226. ppmax = (ulimit - llimit + 1) >> PPOD_SIZE_SHIFT;
  1227. bits = __ilog2_u32(ppmax) + 1;
  1228. if (bits > PPOD_IDX_MAX_SIZE)
  1229. bits = PPOD_IDX_MAX_SIZE;
  1230. ppmax = (1 << (bits - 1)) - 1;
  1231. ddp = cxgbi_alloc_big_mem(sizeof(struct cxgbi_ddp_info) +
  1232. ppmax * (sizeof(struct cxgbi_gather_list *) +
  1233. sizeof(struct sk_buff *)),
  1234. GFP_KERNEL);
  1235. if (!ddp) {
  1236. pr_warn("cdev 0x%p, ddp ppmax %u OOM.\n", cdev, ppmax);
  1237. return -ENOMEM;
  1238. }
  1239. ddp->gl_map = (struct cxgbi_gather_list **)(ddp + 1);
  1240. ddp->gl_skb = (struct sk_buff **)(((char *)ddp->gl_map) +
  1241. ppmax * sizeof(struct cxgbi_gather_list *));
  1242. cdev->ddp = ddp;
  1243. spin_lock_init(&ddp->map_lock);
  1244. kref_init(&ddp->refcnt);
  1245. ddp->cdev = cdev;
  1246. ddp->pdev = cdev->pdev;
  1247. ddp->llimit = llimit;
  1248. ddp->ulimit = ulimit;
  1249. ddp->max_txsz = min_t(unsigned int, max_txsz, ULP2_MAX_PKT_SIZE);
  1250. ddp->max_rxsz = min_t(unsigned int, max_rxsz, ULP2_MAX_PKT_SIZE);
  1251. ddp->nppods = ppmax;
  1252. ddp->idx_last = ppmax;
  1253. ddp->idx_bits = bits;
  1254. ddp->idx_mask = (1 << bits) - 1;
  1255. ddp->rsvd_tag_mask = (1 << (bits + PPOD_IDX_SHIFT)) - 1;
  1256. cdev->tag_format.sw_bits = sw_tag_idx_bits + sw_tag_age_bits;
  1257. cdev->tag_format.rsvd_bits = ddp->idx_bits;
  1258. cdev->tag_format.rsvd_shift = PPOD_IDX_SHIFT;
  1259. cdev->tag_format.rsvd_mask = (1 << cdev->tag_format.rsvd_bits) - 1;
  1260. pr_info("%s tag format, sw %u, rsvd %u,%u, mask 0x%x.\n",
  1261. cdev->ports[0]->name, cdev->tag_format.sw_bits,
  1262. cdev->tag_format.rsvd_bits, cdev->tag_format.rsvd_shift,
  1263. cdev->tag_format.rsvd_mask);
  1264. cdev->tx_max_size = min_t(unsigned int, ULP2_MAX_PDU_PAYLOAD,
  1265. ddp->max_txsz - ISCSI_PDU_NONPAYLOAD_LEN);
  1266. cdev->rx_max_size = min_t(unsigned int, ULP2_MAX_PDU_PAYLOAD,
  1267. ddp->max_rxsz - ISCSI_PDU_NONPAYLOAD_LEN);
  1268. log_debug(1 << CXGBI_DBG_DDP,
  1269. "%s max payload size: %u/%u, %u/%u.\n",
  1270. cdev->ports[0]->name, cdev->tx_max_size, ddp->max_txsz,
  1271. cdev->rx_max_size, ddp->max_rxsz);
  1272. return 0;
  1273. }
  1274. EXPORT_SYMBOL_GPL(cxgbi_ddp_init);
  1275. /*
  1276. * APIs interacting with open-iscsi libraries
  1277. */
  1278. static unsigned char padding[4];
  1279. static void task_release_itt(struct iscsi_task *task, itt_t hdr_itt)
  1280. {
  1281. struct scsi_cmnd *sc = task->sc;
  1282. struct iscsi_tcp_conn *tcp_conn = task->conn->dd_data;
  1283. struct cxgbi_conn *cconn = tcp_conn->dd_data;
  1284. struct cxgbi_hba *chba = cconn->chba;
  1285. struct cxgbi_tag_format *tformat = &chba->cdev->tag_format;
  1286. u32 tag = ntohl((__force u32)hdr_itt);
  1287. log_debug(1 << CXGBI_DBG_DDP,
  1288. "cdev 0x%p, release tag 0x%x.\n", chba->cdev, tag);
  1289. if (sc &&
  1290. (scsi_bidi_cmnd(sc) || sc->sc_data_direction == DMA_FROM_DEVICE) &&
  1291. cxgbi_is_ddp_tag(tformat, tag))
  1292. ddp_tag_release(chba, tag);
  1293. }
  1294. static int task_reserve_itt(struct iscsi_task *task, itt_t *hdr_itt)
  1295. {
  1296. struct scsi_cmnd *sc = task->sc;
  1297. struct iscsi_conn *conn = task->conn;
  1298. struct iscsi_session *sess = conn->session;
  1299. struct iscsi_tcp_conn *tcp_conn = conn->dd_data;
  1300. struct cxgbi_conn *cconn = tcp_conn->dd_data;
  1301. struct cxgbi_hba *chba = cconn->chba;
  1302. struct cxgbi_tag_format *tformat = &chba->cdev->tag_format;
  1303. u32 sw_tag = (sess->age << cconn->task_idx_bits) | task->itt;
  1304. u32 tag = 0;
  1305. int err = -EINVAL;
  1306. if (sc &&
  1307. (scsi_bidi_cmnd(sc) || sc->sc_data_direction == DMA_FROM_DEVICE)) {
  1308. err = cxgbi_ddp_reserve(cconn->cep->csk, &tag, sw_tag,
  1309. scsi_in(sc)->length,
  1310. scsi_in(sc)->table.sgl,
  1311. scsi_in(sc)->table.nents,
  1312. GFP_ATOMIC);
  1313. if (err < 0)
  1314. log_debug(1 << CXGBI_DBG_DDP,
  1315. "csk 0x%p, R task 0x%p, %u,%u, no ddp.\n",
  1316. cconn->cep->csk, task, scsi_in(sc)->length,
  1317. scsi_in(sc)->table.nents);
  1318. }
  1319. if (err < 0)
  1320. tag = cxgbi_set_non_ddp_tag(tformat, sw_tag);
  1321. /* the itt need to sent in big-endian order */
  1322. *hdr_itt = (__force itt_t)htonl(tag);
  1323. log_debug(1 << CXGBI_DBG_DDP,
  1324. "cdev 0x%p, task 0x%p, 0x%x(0x%x,0x%x)->0x%x/0x%x.\n",
  1325. chba->cdev, task, sw_tag, task->itt, sess->age, tag, *hdr_itt);
  1326. return 0;
  1327. }
  1328. void cxgbi_parse_pdu_itt(struct iscsi_conn *conn, itt_t itt, int *idx, int *age)
  1329. {
  1330. struct iscsi_tcp_conn *tcp_conn = conn->dd_data;
  1331. struct cxgbi_conn *cconn = tcp_conn->dd_data;
  1332. struct cxgbi_device *cdev = cconn->chba->cdev;
  1333. u32 tag = ntohl((__force u32) itt);
  1334. u32 sw_bits;
  1335. sw_bits = cxgbi_tag_nonrsvd_bits(&cdev->tag_format, tag);
  1336. if (idx)
  1337. *idx = sw_bits & ((1 << cconn->task_idx_bits) - 1);
  1338. if (age)
  1339. *age = (sw_bits >> cconn->task_idx_bits) & ISCSI_AGE_MASK;
  1340. log_debug(1 << CXGBI_DBG_DDP,
  1341. "cdev 0x%p, tag 0x%x/0x%x, -> 0x%x(0x%x,0x%x).\n",
  1342. cdev, tag, itt, sw_bits, idx ? *idx : 0xFFFFF,
  1343. age ? *age : 0xFF);
  1344. }
  1345. EXPORT_SYMBOL_GPL(cxgbi_parse_pdu_itt);
  1346. void cxgbi_conn_tx_open(struct cxgbi_sock *csk)
  1347. {
  1348. struct iscsi_conn *conn = csk->user_data;
  1349. if (conn) {
  1350. log_debug(1 << CXGBI_DBG_SOCK,
  1351. "csk 0x%p, cid %d.\n", csk, conn->id);
  1352. iscsi_conn_queue_work(conn);
  1353. }
  1354. }
  1355. EXPORT_SYMBOL_GPL(cxgbi_conn_tx_open);
  1356. /*
  1357. * pdu receive, interact with libiscsi_tcp
  1358. */
  1359. static inline int read_pdu_skb(struct iscsi_conn *conn,
  1360. struct sk_buff *skb,
  1361. unsigned int offset,
  1362. int offloaded)
  1363. {
  1364. int status = 0;
  1365. int bytes_read;
  1366. bytes_read = iscsi_tcp_recv_skb(conn, skb, offset, offloaded, &status);
  1367. switch (status) {
  1368. case ISCSI_TCP_CONN_ERR:
  1369. pr_info("skb 0x%p, off %u, %d, TCP_ERR.\n",
  1370. skb, offset, offloaded);
  1371. return -EIO;
  1372. case ISCSI_TCP_SUSPENDED:
  1373. log_debug(1 << CXGBI_DBG_PDU_RX,
  1374. "skb 0x%p, off %u, %d, TCP_SUSPEND, rc %d.\n",
  1375. skb, offset, offloaded, bytes_read);
  1376. /* no transfer - just have caller flush queue */
  1377. return bytes_read;
  1378. case ISCSI_TCP_SKB_DONE:
  1379. pr_info("skb 0x%p, off %u, %d, TCP_SKB_DONE.\n",
  1380. skb, offset, offloaded);
  1381. /*
  1382. * pdus should always fit in the skb and we should get
  1383. * segment done notifcation.
  1384. */
  1385. iscsi_conn_printk(KERN_ERR, conn, "Invalid pdu or skb.");
  1386. return -EFAULT;
  1387. case ISCSI_TCP_SEGMENT_DONE:
  1388. log_debug(1 << CXGBI_DBG_PDU_RX,
  1389. "skb 0x%p, off %u, %d, TCP_SEG_DONE, rc %d.\n",
  1390. skb, offset, offloaded, bytes_read);
  1391. return bytes_read;
  1392. default:
  1393. pr_info("skb 0x%p, off %u, %d, invalid status %d.\n",
  1394. skb, offset, offloaded, status);
  1395. return -EINVAL;
  1396. }
  1397. }
  1398. static int skb_read_pdu_bhs(struct iscsi_conn *conn, struct sk_buff *skb)
  1399. {
  1400. struct iscsi_tcp_conn *tcp_conn = conn->dd_data;
  1401. log_debug(1 << CXGBI_DBG_PDU_RX,
  1402. "conn 0x%p, skb 0x%p, len %u, flag 0x%lx.\n",
  1403. conn, skb, skb->len, cxgbi_skcb_flags(skb));
  1404. if (!iscsi_tcp_recv_segment_is_hdr(tcp_conn)) {
  1405. pr_info("conn 0x%p, skb 0x%p, not hdr.\n", conn, skb);
  1406. iscsi_conn_failure(conn, ISCSI_ERR_PROTO);
  1407. return -EIO;
  1408. }
  1409. if (conn->hdrdgst_en &&
  1410. cxgbi_skcb_test_flag(skb, SKCBF_RX_HCRC_ERR)) {
  1411. pr_info("conn 0x%p, skb 0x%p, hcrc.\n", conn, skb);
  1412. iscsi_conn_failure(conn, ISCSI_ERR_HDR_DGST);
  1413. return -EIO;
  1414. }
  1415. return read_pdu_skb(conn, skb, 0, 0);
  1416. }
  1417. static int skb_read_pdu_data(struct iscsi_conn *conn, struct sk_buff *lskb,
  1418. struct sk_buff *skb, unsigned int offset)
  1419. {
  1420. struct iscsi_tcp_conn *tcp_conn = conn->dd_data;
  1421. bool offloaded = 0;
  1422. int opcode = tcp_conn->in.hdr->opcode & ISCSI_OPCODE_MASK;
  1423. log_debug(1 << CXGBI_DBG_PDU_RX,
  1424. "conn 0x%p, skb 0x%p, len %u, flag 0x%lx.\n",
  1425. conn, skb, skb->len, cxgbi_skcb_flags(skb));
  1426. if (conn->datadgst_en &&
  1427. cxgbi_skcb_test_flag(lskb, SKCBF_RX_DCRC_ERR)) {
  1428. pr_info("conn 0x%p, skb 0x%p, dcrc 0x%lx.\n",
  1429. conn, lskb, cxgbi_skcb_flags(lskb));
  1430. iscsi_conn_failure(conn, ISCSI_ERR_DATA_DGST);
  1431. return -EIO;
  1432. }
  1433. if (iscsi_tcp_recv_segment_is_hdr(tcp_conn))
  1434. return 0;
  1435. /* coalesced, add header digest length */
  1436. if (lskb == skb && conn->hdrdgst_en)
  1437. offset += ISCSI_DIGEST_SIZE;
  1438. if (cxgbi_skcb_test_flag(lskb, SKCBF_RX_DATA_DDPD))
  1439. offloaded = 1;
  1440. if (opcode == ISCSI_OP_SCSI_DATA_IN)
  1441. log_debug(1 << CXGBI_DBG_PDU_RX,
  1442. "skb 0x%p, op 0x%x, itt 0x%x, %u %s ddp'ed.\n",
  1443. skb, opcode, ntohl(tcp_conn->in.hdr->itt),
  1444. tcp_conn->in.datalen, offloaded ? "is" : "not");
  1445. return read_pdu_skb(conn, skb, offset, offloaded);
  1446. }
  1447. static void csk_return_rx_credits(struct cxgbi_sock *csk, int copied)
  1448. {
  1449. struct cxgbi_device *cdev = csk->cdev;
  1450. int must_send;
  1451. u32 credits;
  1452. log_debug(1 << CXGBI_DBG_PDU_RX,
  1453. "csk 0x%p,%u,0x%lu,%u, seq %u, wup %u, thre %u, %u.\n",
  1454. csk, csk->state, csk->flags, csk->tid, csk->copied_seq,
  1455. csk->rcv_wup, cdev->rx_credit_thres,
  1456. cdev->rcv_win);
  1457. if (csk->state != CTP_ESTABLISHED)
  1458. return;
  1459. credits = csk->copied_seq - csk->rcv_wup;
  1460. if (unlikely(!credits))
  1461. return;
  1462. if (unlikely(cdev->rx_credit_thres == 0))
  1463. return;
  1464. must_send = credits + 16384 >= cdev->rcv_win;
  1465. if (must_send || credits >= cdev->rx_credit_thres)
  1466. csk->rcv_wup += cdev->csk_send_rx_credits(csk, credits);
  1467. }
  1468. void cxgbi_conn_pdu_ready(struct cxgbi_sock *csk)
  1469. {
  1470. struct cxgbi_device *cdev = csk->cdev;
  1471. struct iscsi_conn *conn = csk->user_data;
  1472. struct sk_buff *skb;
  1473. unsigned int read = 0;
  1474. int err = 0;
  1475. log_debug(1 << CXGBI_DBG_PDU_RX,
  1476. "csk 0x%p, conn 0x%p.\n", csk, conn);
  1477. if (unlikely(!conn || conn->suspend_rx)) {
  1478. log_debug(1 << CXGBI_DBG_PDU_RX,
  1479. "csk 0x%p, conn 0x%p, id %d, suspend_rx %lu!\n",
  1480. csk, conn, conn ? conn->id : 0xFF,
  1481. conn ? conn->suspend_rx : 0xFF);
  1482. return;
  1483. }
  1484. while (!err) {
  1485. skb = skb_peek(&csk->receive_queue);
  1486. if (!skb ||
  1487. !(cxgbi_skcb_test_flag(skb, SKCBF_RX_STATUS))) {
  1488. if (skb)
  1489. log_debug(1 << CXGBI_DBG_PDU_RX,
  1490. "skb 0x%p, NOT ready 0x%lx.\n",
  1491. skb, cxgbi_skcb_flags(skb));
  1492. break;
  1493. }
  1494. __skb_unlink(skb, &csk->receive_queue);
  1495. read += cxgbi_skcb_rx_pdulen(skb);
  1496. log_debug(1 << CXGBI_DBG_PDU_RX,
  1497. "csk 0x%p, skb 0x%p,%u,f 0x%lx, pdu len %u.\n",
  1498. csk, skb, skb->len, cxgbi_skcb_flags(skb),
  1499. cxgbi_skcb_rx_pdulen(skb));
  1500. if (cxgbi_skcb_test_flag(skb, SKCBF_RX_COALESCED)) {
  1501. err = skb_read_pdu_bhs(conn, skb);
  1502. if (err < 0) {
  1503. pr_err("coalesced bhs, csk 0x%p, skb 0x%p,%u, "
  1504. "f 0x%lx, plen %u.\n",
  1505. csk, skb, skb->len,
  1506. cxgbi_skcb_flags(skb),
  1507. cxgbi_skcb_rx_pdulen(skb));
  1508. goto skb_done;
  1509. }
  1510. err = skb_read_pdu_data(conn, skb, skb,
  1511. err + cdev->skb_rx_extra);
  1512. if (err < 0)
  1513. pr_err("coalesced data, csk 0x%p, skb 0x%p,%u, "
  1514. "f 0x%lx, plen %u.\n",
  1515. csk, skb, skb->len,
  1516. cxgbi_skcb_flags(skb),
  1517. cxgbi_skcb_rx_pdulen(skb));
  1518. } else {
  1519. err = skb_read_pdu_bhs(conn, skb);
  1520. if (err < 0) {
  1521. pr_err("bhs, csk 0x%p, skb 0x%p,%u, "
  1522. "f 0x%lx, plen %u.\n",
  1523. csk, skb, skb->len,
  1524. cxgbi_skcb_flags(skb),
  1525. cxgbi_skcb_rx_pdulen(skb));
  1526. goto skb_done;
  1527. }
  1528. if (cxgbi_skcb_test_flag(skb, SKCBF_RX_DATA)) {
  1529. struct sk_buff *dskb;
  1530. dskb = skb_peek(&csk->receive_queue);
  1531. if (!dskb) {
  1532. pr_err("csk 0x%p, skb 0x%p,%u, f 0x%lx,"
  1533. " plen %u, NO data.\n",
  1534. csk, skb, skb->len,
  1535. cxgbi_skcb_flags(skb),
  1536. cxgbi_skcb_rx_pdulen(skb));
  1537. err = -EIO;
  1538. goto skb_done;
  1539. }
  1540. __skb_unlink(dskb, &csk->receive_queue);
  1541. err = skb_read_pdu_data(conn, skb, dskb, 0);
  1542. if (err < 0)
  1543. pr_err("data, csk 0x%p, skb 0x%p,%u, "
  1544. "f 0x%lx, plen %u, dskb 0x%p,"
  1545. "%u.\n",
  1546. csk, skb, skb->len,
  1547. cxgbi_skcb_flags(skb),
  1548. cxgbi_skcb_rx_pdulen(skb),
  1549. dskb, dskb->len);
  1550. __kfree_skb(dskb);
  1551. } else
  1552. err = skb_read_pdu_data(conn, skb, skb, 0);
  1553. }
  1554. skb_done:
  1555. __kfree_skb(skb);
  1556. if (err < 0)
  1557. break;
  1558. }
  1559. log_debug(1 << CXGBI_DBG_PDU_RX, "csk 0x%p, read %u.\n", csk, read);
  1560. if (read) {
  1561. csk->copied_seq += read;
  1562. csk_return_rx_credits(csk, read);
  1563. conn->rxdata_octets += read;
  1564. }
  1565. if (err < 0) {
  1566. pr_info("csk 0x%p, 0x%p, rx failed %d, read %u.\n",
  1567. csk, conn, err, read);
  1568. iscsi_conn_failure(conn, ISCSI_ERR_CONN_FAILED);
  1569. }
  1570. }
  1571. EXPORT_SYMBOL_GPL(cxgbi_conn_pdu_ready);
  1572. static int sgl_seek_offset(struct scatterlist *sgl, unsigned int sgcnt,
  1573. unsigned int offset, unsigned int *off,
  1574. struct scatterlist **sgp)
  1575. {
  1576. int i;
  1577. struct scatterlist *sg;
  1578. for_each_sg(sgl, sg, sgcnt, i) {
  1579. if (offset < sg->length) {
  1580. *off = offset;
  1581. *sgp = sg;
  1582. return 0;
  1583. }
  1584. offset -= sg->length;
  1585. }
  1586. return -EFAULT;
  1587. }
  1588. static int sgl_read_to_frags(struct scatterlist *sg, unsigned int sgoffset,
  1589. unsigned int dlen, skb_frag_t *frags,
  1590. int frag_max)
  1591. {
  1592. unsigned int datalen = dlen;
  1593. unsigned int sglen = sg->length - sgoffset;
  1594. struct page *page = sg_page(sg);
  1595. int i;
  1596. i = 0;
  1597. do {
  1598. unsigned int copy;
  1599. if (!sglen) {
  1600. sg = sg_next(sg);
  1601. if (!sg) {
  1602. pr_warn("sg %d NULL, len %u/%u.\n",
  1603. i, datalen, dlen);
  1604. return -EINVAL;
  1605. }
  1606. sgoffset = 0;
  1607. sglen = sg->length;
  1608. page = sg_page(sg);
  1609. }
  1610. copy = min(datalen, sglen);
  1611. if (i && page == frags[i - 1].page &&
  1612. sgoffset + sg->offset ==
  1613. frags[i - 1].page_offset + frags[i - 1].size) {
  1614. frags[i - 1].size += copy;
  1615. } else {
  1616. if (i >= frag_max) {
  1617. pr_warn("too many pages %u, dlen %u.\n",
  1618. frag_max, dlen);
  1619. return -EINVAL;
  1620. }
  1621. frags[i].page = page;
  1622. frags[i].page_offset = sg->offset + sgoffset;
  1623. frags[i].size = copy;
  1624. i++;
  1625. }
  1626. datalen -= copy;
  1627. sgoffset += copy;
  1628. sglen -= copy;
  1629. } while (datalen);
  1630. return i;
  1631. }
  1632. int cxgbi_conn_alloc_pdu(struct iscsi_task *task, u8 opcode)
  1633. {
  1634. struct iscsi_tcp_conn *tcp_conn = task->conn->dd_data;
  1635. struct cxgbi_conn *cconn = tcp_conn->dd_data;
  1636. struct cxgbi_device *cdev = cconn->chba->cdev;
  1637. struct iscsi_conn *conn = task->conn;
  1638. struct iscsi_tcp_task *tcp_task = task->dd_data;
  1639. struct cxgbi_task_data *tdata = iscsi_task_cxgbi_data(task);
  1640. struct scsi_cmnd *sc = task->sc;
  1641. int headroom = SKB_TX_ISCSI_PDU_HEADER_MAX;
  1642. tcp_task->dd_data = tdata;
  1643. task->hdr = NULL;
  1644. if (SKB_MAX_HEAD(cdev->skb_tx_rsvd) > (512 * MAX_SKB_FRAGS) &&
  1645. (opcode == ISCSI_OP_SCSI_DATA_OUT ||
  1646. (opcode == ISCSI_OP_SCSI_CMD &&
  1647. (scsi_bidi_cmnd(sc) || sc->sc_data_direction == DMA_TO_DEVICE))))
  1648. /* data could goes into skb head */
  1649. headroom += min_t(unsigned int,
  1650. SKB_MAX_HEAD(cdev->skb_tx_rsvd),
  1651. conn->max_xmit_dlength);
  1652. tdata->skb = alloc_skb(cdev->skb_tx_rsvd + headroom, GFP_ATOMIC);
  1653. if (!tdata->skb) {
  1654. pr_warn("alloc skb %u+%u, opcode 0x%x failed.\n",
  1655. cdev->skb_tx_rsvd, headroom, opcode);
  1656. return -ENOMEM;
  1657. }
  1658. skb_reserve(tdata->skb, cdev->skb_tx_rsvd);
  1659. task->hdr = (struct iscsi_hdr *)tdata->skb->data;
  1660. task->hdr_max = SKB_TX_ISCSI_PDU_HEADER_MAX; /* BHS + AHS */
  1661. /* data_out uses scsi_cmd's itt */
  1662. if (opcode != ISCSI_OP_SCSI_DATA_OUT)
  1663. task_reserve_itt(task, &task->hdr->itt);
  1664. log_debug(1 << CXGBI_DBG_ISCSI | 1 << CXGBI_DBG_PDU_TX,
  1665. "task 0x%p, op 0x%x, skb 0x%p,%u+%u/%u, itt 0x%x.\n",
  1666. task, opcode, tdata->skb, cdev->skb_tx_rsvd, headroom,
  1667. conn->max_xmit_dlength, ntohl(task->hdr->itt));
  1668. return 0;
  1669. }
  1670. EXPORT_SYMBOL_GPL(cxgbi_conn_alloc_pdu);
  1671. static inline void tx_skb_setmode(struct sk_buff *skb, int hcrc, int dcrc)
  1672. {
  1673. u8 submode = 0;
  1674. if (hcrc)
  1675. submode |= 1;
  1676. if (dcrc)
  1677. submode |= 2;
  1678. cxgbi_skcb_ulp_mode(skb) = (ULP2_MODE_ISCSI << 4) | submode;
  1679. }
  1680. int cxgbi_conn_init_pdu(struct iscsi_task *task, unsigned int offset,
  1681. unsigned int count)
  1682. {
  1683. struct iscsi_conn *conn = task->conn;
  1684. struct cxgbi_task_data *tdata = iscsi_task_cxgbi_data(task);
  1685. struct sk_buff *skb = tdata->skb;
  1686. unsigned int datalen = count;
  1687. int i, padlen = iscsi_padding(count);
  1688. struct page *pg;
  1689. log_debug(1 << CXGBI_DBG_ISCSI | 1 << CXGBI_DBG_PDU_TX,
  1690. "task 0x%p,0x%p, skb 0x%p, 0x%x,0x%x,0x%x, %u+%u.\n",
  1691. task, task->sc, skb, (*skb->data) & ISCSI_OPCODE_MASK,
  1692. ntohl(task->cmdsn), ntohl(task->hdr->itt), offset, count);
  1693. skb_put(skb, task->hdr_len);
  1694. tx_skb_setmode(skb, conn->hdrdgst_en, datalen ? conn->datadgst_en : 0);
  1695. if (!count)
  1696. return 0;
  1697. if (task->sc) {
  1698. struct scsi_data_buffer *sdb = scsi_out(task->sc);
  1699. struct scatterlist *sg = NULL;
  1700. int err;
  1701. tdata->offset = offset;
  1702. tdata->count = count;
  1703. err = sgl_seek_offset(
  1704. sdb->table.sgl, sdb->table.nents,
  1705. tdata->offset, &tdata->sgoffset, &sg);
  1706. if (err < 0) {
  1707. pr_warn("tpdu, sgl %u, bad offset %u/%u.\n",
  1708. sdb->table.nents, tdata->offset, sdb->length);
  1709. return err;
  1710. }
  1711. err = sgl_read_to_frags(sg, tdata->sgoffset, tdata->count,
  1712. tdata->frags, MAX_PDU_FRAGS);
  1713. if (err < 0) {
  1714. pr_warn("tpdu, sgl %u, bad offset %u + %u.\n",
  1715. sdb->table.nents, tdata->offset, tdata->count);
  1716. return err;
  1717. }
  1718. tdata->nr_frags = err;
  1719. if (tdata->nr_frags > MAX_SKB_FRAGS ||
  1720. (padlen && tdata->nr_frags == MAX_SKB_FRAGS)) {
  1721. char *dst = skb->data + task->hdr_len;
  1722. skb_frag_t *frag = tdata->frags;
  1723. /* data fits in the skb's headroom */
  1724. for (i = 0; i < tdata->nr_frags; i++, frag++) {
  1725. char *src = kmap_atomic(frag->page,
  1726. KM_SOFTIRQ0);
  1727. memcpy(dst, src+frag->page_offset, frag->size);
  1728. dst += frag->size;
  1729. kunmap_atomic(src, KM_SOFTIRQ0);
  1730. }
  1731. if (padlen) {
  1732. memset(dst, 0, padlen);
  1733. padlen = 0;
  1734. }
  1735. skb_put(skb, count + padlen);
  1736. } else {
  1737. /* data fit into frag_list */
  1738. for (i = 0; i < tdata->nr_frags; i++)
  1739. get_page(tdata->frags[i].page);
  1740. memcpy(skb_shinfo(skb)->frags, tdata->frags,
  1741. sizeof(skb_frag_t) * tdata->nr_frags);
  1742. skb_shinfo(skb)->nr_frags = tdata->nr_frags;
  1743. skb->len += count;
  1744. skb->data_len += count;
  1745. skb->truesize += count;
  1746. }
  1747. } else {
  1748. pg = virt_to_page(task->data);
  1749. get_page(pg);
  1750. skb_fill_page_desc(skb, 0, pg, offset_in_page(task->data),
  1751. count);
  1752. skb->len += count;
  1753. skb->data_len += count;
  1754. skb->truesize += count;
  1755. }
  1756. if (padlen) {
  1757. i = skb_shinfo(skb)->nr_frags;
  1758. skb_fill_page_desc(skb, skb_shinfo(skb)->nr_frags,
  1759. virt_to_page(padding), offset_in_page(padding),
  1760. padlen);
  1761. skb->data_len += padlen;
  1762. skb->truesize += padlen;
  1763. skb->len += padlen;
  1764. }
  1765. return 0;
  1766. }
  1767. EXPORT_SYMBOL_GPL(cxgbi_conn_init_pdu);
  1768. int cxgbi_conn_xmit_pdu(struct iscsi_task *task)
  1769. {
  1770. struct iscsi_tcp_conn *tcp_conn = task->conn->dd_data;
  1771. struct cxgbi_conn *cconn = tcp_conn->dd_data;
  1772. struct cxgbi_task_data *tdata = iscsi_task_cxgbi_data(task);
  1773. struct sk_buff *skb = tdata->skb;
  1774. unsigned int datalen;
  1775. int err;
  1776. if (!skb) {
  1777. log_debug(1 << CXGBI_DBG_ISCSI | 1 << CXGBI_DBG_PDU_TX,
  1778. "task 0x%p, skb NULL.\n", task);
  1779. return 0;
  1780. }
  1781. datalen = skb->data_len;
  1782. tdata->skb = NULL;
  1783. err = cxgbi_sock_send_pdus(cconn->cep->csk, skb);
  1784. if (err > 0) {
  1785. int pdulen = err;
  1786. log_debug(1 << CXGBI_DBG_PDU_TX,
  1787. "task 0x%p,0x%p, skb 0x%p, len %u/%u, rv %d.\n",
  1788. task, task->sc, skb, skb->len, skb->data_len, err);
  1789. if (task->conn->hdrdgst_en)
  1790. pdulen += ISCSI_DIGEST_SIZE;
  1791. if (datalen && task->conn->datadgst_en)
  1792. pdulen += ISCSI_DIGEST_SIZE;
  1793. task->conn->txdata_octets += pdulen;
  1794. return 0;
  1795. }
  1796. if (err == -EAGAIN || err == -ENOBUFS) {
  1797. log_debug(1 << CXGBI_DBG_PDU_TX,
  1798. "task 0x%p, skb 0x%p, len %u/%u, %d EAGAIN.\n",
  1799. task, skb, skb->len, skb->data_len, err);
  1800. /* reset skb to send when we are called again */
  1801. tdata->skb = skb;
  1802. return err;
  1803. }
  1804. kfree_skb(skb);
  1805. log_debug(1 << CXGBI_DBG_ISCSI | 1 << CXGBI_DBG_PDU_TX,
  1806. "itt 0x%x, skb 0x%p, len %u/%u, xmit err %d.\n",
  1807. task->itt, skb, skb->len, skb->data_len, err);
  1808. iscsi_conn_printk(KERN_ERR, task->conn, "xmit err %d.\n", err);
  1809. iscsi_conn_failure(task->conn, ISCSI_ERR_XMIT_FAILED);
  1810. return err;
  1811. }
  1812. EXPORT_SYMBOL_GPL(cxgbi_conn_xmit_pdu);
  1813. void cxgbi_cleanup_task(struct iscsi_task *task)
  1814. {
  1815. struct cxgbi_task_data *tdata = iscsi_task_cxgbi_data(task);
  1816. log_debug(1 << CXGBI_DBG_ISCSI,
  1817. "task 0x%p, skb 0x%p, itt 0x%x.\n",
  1818. task, tdata->skb, task->hdr_itt);
  1819. /* never reached the xmit task callout */
  1820. if (tdata->skb)
  1821. __kfree_skb(tdata->skb);
  1822. memset(tdata, 0, sizeof(*tdata));
  1823. task_release_itt(task, task->hdr_itt);
  1824. iscsi_tcp_cleanup_task(task);
  1825. }
  1826. EXPORT_SYMBOL_GPL(cxgbi_cleanup_task);
  1827. void cxgbi_get_conn_stats(struct iscsi_cls_conn *cls_conn,
  1828. struct iscsi_stats *stats)
  1829. {
  1830. struct iscsi_conn *conn = cls_conn->dd_data;
  1831. stats->txdata_octets = conn->txdata_octets;
  1832. stats->rxdata_octets = conn->rxdata_octets;
  1833. stats->scsicmd_pdus = conn->scsicmd_pdus_cnt;
  1834. stats->dataout_pdus = conn->dataout_pdus_cnt;
  1835. stats->scsirsp_pdus = conn->scsirsp_pdus_cnt;
  1836. stats->datain_pdus = conn->datain_pdus_cnt;
  1837. stats->r2t_pdus = conn->r2t_pdus_cnt;
  1838. stats->tmfcmd_pdus = conn->tmfcmd_pdus_cnt;
  1839. stats->tmfrsp_pdus = conn->tmfrsp_pdus_cnt;
  1840. stats->digest_err = 0;
  1841. stats->timeout_err = 0;
  1842. stats->custom_length = 1;
  1843. strcpy(stats->custom[0].desc, "eh_abort_cnt");
  1844. stats->custom[0].value = conn->eh_abort_cnt;
  1845. }
  1846. EXPORT_SYMBOL_GPL(cxgbi_get_conn_stats);
  1847. static int cxgbi_conn_max_xmit_dlength(struct iscsi_conn *conn)
  1848. {
  1849. struct iscsi_tcp_conn *tcp_conn = conn->dd_data;
  1850. struct cxgbi_conn *cconn = tcp_conn->dd_data;
  1851. struct cxgbi_device *cdev = cconn->chba->cdev;
  1852. unsigned int headroom = SKB_MAX_HEAD(cdev->skb_tx_rsvd);
  1853. unsigned int max_def = 512 * MAX_SKB_FRAGS;
  1854. unsigned int max = max(max_def, headroom);
  1855. max = min(cconn->chba->cdev->tx_max_size, max);
  1856. if (conn->max_xmit_dlength)
  1857. conn->max_xmit_dlength = min(conn->max_xmit_dlength, max);
  1858. else
  1859. conn->max_xmit_dlength = max;
  1860. cxgbi_align_pdu_size(conn->max_xmit_dlength);
  1861. return 0;
  1862. }
  1863. static int cxgbi_conn_max_recv_dlength(struct iscsi_conn *conn)
  1864. {
  1865. struct iscsi_tcp_conn *tcp_conn = conn->dd_data;
  1866. struct cxgbi_conn *cconn = tcp_conn->dd_data;
  1867. unsigned int max = cconn->chba->cdev->rx_max_size;
  1868. cxgbi_align_pdu_size(max);
  1869. if (conn->max_recv_dlength) {
  1870. if (conn->max_recv_dlength > max) {
  1871. pr_err("MaxRecvDataSegmentLength %u > %u.\n",
  1872. conn->max_recv_dlength, max);
  1873. return -EINVAL;
  1874. }
  1875. conn->max_recv_dlength = min(conn->max_recv_dlength, max);
  1876. cxgbi_align_pdu_size(conn->max_recv_dlength);
  1877. } else
  1878. conn->max_recv_dlength = max;
  1879. return 0;
  1880. }
  1881. int cxgbi_set_conn_param(struct iscsi_cls_conn *cls_conn,
  1882. enum iscsi_param param, char *buf, int buflen)
  1883. {
  1884. struct iscsi_conn *conn = cls_conn->dd_data;
  1885. struct iscsi_session *session = conn->session;
  1886. struct iscsi_tcp_conn *tcp_conn = conn->dd_data;
  1887. struct cxgbi_conn *cconn = tcp_conn->dd_data;
  1888. struct cxgbi_sock *csk = cconn->cep->csk;
  1889. int value, err = 0;
  1890. log_debug(1 << CXGBI_DBG_ISCSI,
  1891. "cls_conn 0x%p, param %d, buf(%d) %s.\n",
  1892. cls_conn, param, buflen, buf);
  1893. switch (param) {
  1894. case ISCSI_PARAM_HDRDGST_EN:
  1895. err = iscsi_set_param(cls_conn, param, buf, buflen);
  1896. if (!err && conn->hdrdgst_en)
  1897. err = csk->cdev->csk_ddp_setup_digest(csk, csk->tid,
  1898. conn->hdrdgst_en,
  1899. conn->datadgst_en, 0);
  1900. break;
  1901. case ISCSI_PARAM_DATADGST_EN:
  1902. err = iscsi_set_param(cls_conn, param, buf, buflen);
  1903. if (!err && conn->datadgst_en)
  1904. err = csk->cdev->csk_ddp_setup_digest(csk, csk->tid,
  1905. conn->hdrdgst_en,
  1906. conn->datadgst_en, 0);
  1907. break;
  1908. case ISCSI_PARAM_MAX_R2T:
  1909. sscanf(buf, "%d", &value);
  1910. if (value <= 0 || !is_power_of_2(value))
  1911. return -EINVAL;
  1912. if (session->max_r2t == value)
  1913. break;
  1914. iscsi_tcp_r2tpool_free(session);
  1915. err = iscsi_set_param(cls_conn, param, buf, buflen);
  1916. if (!err && iscsi_tcp_r2tpool_alloc(session))
  1917. return -ENOMEM;
  1918. case ISCSI_PARAM_MAX_RECV_DLENGTH:
  1919. err = iscsi_set_param(cls_conn, param, buf, buflen);
  1920. if (!err)
  1921. err = cxgbi_conn_max_recv_dlength(conn);
  1922. break;
  1923. case ISCSI_PARAM_MAX_XMIT_DLENGTH:
  1924. err = iscsi_set_param(cls_conn, param, buf, buflen);
  1925. if (!err)
  1926. err = cxgbi_conn_max_xmit_dlength(conn);
  1927. break;
  1928. default:
  1929. return iscsi_set_param(cls_conn, param, buf, buflen);
  1930. }
  1931. return err;
  1932. }
  1933. EXPORT_SYMBOL_GPL(cxgbi_set_conn_param);
  1934. int cxgbi_get_conn_param(struct iscsi_cls_conn *cls_conn,
  1935. enum iscsi_param param, char *buf)
  1936. {
  1937. struct iscsi_conn *iconn = cls_conn->dd_data;
  1938. int len;
  1939. log_debug(1 << CXGBI_DBG_ISCSI,
  1940. "cls_conn 0x%p, param %d.\n", cls_conn, param);
  1941. switch (param) {
  1942. case ISCSI_PARAM_CONN_PORT:
  1943. spin_lock_bh(&iconn->session->lock);
  1944. len = sprintf(buf, "%hu\n", iconn->portal_port);
  1945. spin_unlock_bh(&iconn->session->lock);
  1946. break;
  1947. case ISCSI_PARAM_CONN_ADDRESS:
  1948. spin_lock_bh(&iconn->session->lock);
  1949. len = sprintf(buf, "%s\n", iconn->portal_address);
  1950. spin_unlock_bh(&iconn->session->lock);
  1951. break;
  1952. default:
  1953. return iscsi_conn_get_param(cls_conn, param, buf);
  1954. }
  1955. return len;
  1956. }
  1957. EXPORT_SYMBOL_GPL(cxgbi_get_conn_param);
  1958. struct iscsi_cls_conn *
  1959. cxgbi_create_conn(struct iscsi_cls_session *cls_session, u32 cid)
  1960. {
  1961. struct iscsi_cls_conn *cls_conn;
  1962. struct iscsi_conn *conn;
  1963. struct iscsi_tcp_conn *tcp_conn;
  1964. struct cxgbi_conn *cconn;
  1965. cls_conn = iscsi_tcp_conn_setup(cls_session, sizeof(*cconn), cid);
  1966. if (!cls_conn)
  1967. return NULL;
  1968. conn = cls_conn->dd_data;
  1969. tcp_conn = conn->dd_data;
  1970. cconn = tcp_conn->dd_data;
  1971. cconn->iconn = conn;
  1972. log_debug(1 << CXGBI_DBG_ISCSI,
  1973. "cid %u(0x%x), cls 0x%p,0x%p, conn 0x%p,0x%p,0x%p.\n",
  1974. cid, cid, cls_session, cls_conn, conn, tcp_conn, cconn);
  1975. return cls_conn;
  1976. }
  1977. EXPORT_SYMBOL_GPL(cxgbi_create_conn);
  1978. int cxgbi_bind_conn(struct iscsi_cls_session *cls_session,
  1979. struct iscsi_cls_conn *cls_conn,
  1980. u64 transport_eph, int is_leading)
  1981. {
  1982. struct iscsi_conn *conn = cls_conn->dd_data;
  1983. struct iscsi_tcp_conn *tcp_conn = conn->dd_data;
  1984. struct cxgbi_conn *cconn = tcp_conn->dd_data;
  1985. struct iscsi_endpoint *ep;
  1986. struct cxgbi_endpoint *cep;
  1987. struct cxgbi_sock *csk;
  1988. int err;
  1989. ep = iscsi_lookup_endpoint(transport_eph);
  1990. if (!ep)
  1991. return -EINVAL;
  1992. /* setup ddp pagesize */
  1993. cep = ep->dd_data;
  1994. csk = cep->csk;
  1995. err = csk->cdev->csk_ddp_setup_pgidx(csk, csk->tid, page_idx, 0);
  1996. if (err < 0)
  1997. return err;
  1998. err = iscsi_conn_bind(cls_session, cls_conn, is_leading);
  1999. if (err)
  2000. return -EINVAL;
  2001. /* calculate the tag idx bits needed for this conn based on cmds_max */
  2002. cconn->task_idx_bits = (__ilog2_u32(conn->session->cmds_max - 1)) + 1;
  2003. write_lock_bh(&csk->callback_lock);
  2004. csk->user_data = conn;
  2005. cconn->chba = cep->chba;
  2006. cconn->cep = cep;
  2007. cep->cconn = cconn;
  2008. write_unlock_bh(&csk->callback_lock);
  2009. cxgbi_conn_max_xmit_dlength(conn);
  2010. cxgbi_conn_max_recv_dlength(conn);
  2011. spin_lock_bh(&conn->session->lock);
  2012. sprintf(conn->portal_address, "%pI4", &csk->daddr.sin_addr.s_addr);
  2013. conn->portal_port = ntohs(csk->daddr.sin_port);
  2014. spin_unlock_bh(&conn->session->lock);
  2015. log_debug(1 << CXGBI_DBG_ISCSI,
  2016. "cls 0x%p,0x%p, ep 0x%p, cconn 0x%p, csk 0x%p.\n",
  2017. cls_session, cls_conn, ep, cconn, csk);
  2018. /* init recv engine */
  2019. iscsi_tcp_hdr_recv_prep(tcp_conn);
  2020. return 0;
  2021. }
  2022. EXPORT_SYMBOL_GPL(cxgbi_bind_conn);
  2023. struct iscsi_cls_session *cxgbi_create_session(struct iscsi_endpoint *ep,
  2024. u16 cmds_max, u16 qdepth,
  2025. u32 initial_cmdsn)
  2026. {
  2027. struct cxgbi_endpoint *cep;
  2028. struct cxgbi_hba *chba;
  2029. struct Scsi_Host *shost;
  2030. struct iscsi_cls_session *cls_session;
  2031. struct iscsi_session *session;
  2032. if (!ep) {
  2033. pr_err("missing endpoint.\n");
  2034. return NULL;
  2035. }
  2036. cep = ep->dd_data;
  2037. chba = cep->chba;
  2038. shost = chba->shost;
  2039. BUG_ON(chba != iscsi_host_priv(shost));
  2040. cls_session = iscsi_session_setup(chba->cdev->itp, shost,
  2041. cmds_max, 0,
  2042. sizeof(struct iscsi_tcp_task) +
  2043. sizeof(struct cxgbi_task_data),
  2044. initial_cmdsn, ISCSI_MAX_TARGET);
  2045. if (!cls_session)
  2046. return NULL;
  2047. session = cls_session->dd_data;
  2048. if (iscsi_tcp_r2tpool_alloc(session))
  2049. goto remove_session;
  2050. log_debug(1 << CXGBI_DBG_ISCSI,
  2051. "ep 0x%p, cls sess 0x%p.\n", ep, cls_session);
  2052. return cls_session;
  2053. remove_session:
  2054. iscsi_session_teardown(cls_session);
  2055. return NULL;
  2056. }
  2057. EXPORT_SYMBOL_GPL(cxgbi_create_session);
  2058. void cxgbi_destroy_session(struct iscsi_cls_session *cls_session)
  2059. {
  2060. log_debug(1 << CXGBI_DBG_ISCSI,
  2061. "cls sess 0x%p.\n", cls_session);
  2062. iscsi_tcp_r2tpool_free(cls_session->dd_data);
  2063. iscsi_session_teardown(cls_session);
  2064. }
  2065. EXPORT_SYMBOL_GPL(cxgbi_destroy_session);
  2066. int cxgbi_set_host_param(struct Scsi_Host *shost, enum iscsi_host_param param,
  2067. char *buf, int buflen)
  2068. {
  2069. struct cxgbi_hba *chba = iscsi_host_priv(shost);
  2070. if (!chba->ndev) {
  2071. shost_printk(KERN_ERR, shost, "Could not get host param. "
  2072. "netdev for host not set.\n");
  2073. return -ENODEV;
  2074. }
  2075. log_debug(1 << CXGBI_DBG_ISCSI,
  2076. "shost 0x%p, hba 0x%p,%s, param %d, buf(%d) %s.\n",
  2077. shost, chba, chba->ndev->name, param, buflen, buf);
  2078. switch (param) {
  2079. case ISCSI_HOST_PARAM_IPADDRESS:
  2080. {
  2081. __be32 addr = in_aton(buf);
  2082. log_debug(1 << CXGBI_DBG_ISCSI,
  2083. "hba %s, req. ipv4 %pI4.\n", chba->ndev->name, &addr);
  2084. cxgbi_set_iscsi_ipv4(chba, addr);
  2085. return 0;
  2086. }
  2087. case ISCSI_HOST_PARAM_HWADDRESS:
  2088. case ISCSI_HOST_PARAM_NETDEV_NAME:
  2089. return 0;
  2090. default:
  2091. return iscsi_host_set_param(shost, param, buf, buflen);
  2092. }
  2093. }
  2094. EXPORT_SYMBOL_GPL(cxgbi_set_host_param);
  2095. int cxgbi_get_host_param(struct Scsi_Host *shost, enum iscsi_host_param param,
  2096. char *buf)
  2097. {
  2098. struct cxgbi_hba *chba = iscsi_host_priv(shost);
  2099. int len = 0;
  2100. if (!chba->ndev) {
  2101. shost_printk(KERN_ERR, shost, "Could not get host param. "
  2102. "netdev for host not set.\n");
  2103. return -ENODEV;
  2104. }
  2105. log_debug(1 << CXGBI_DBG_ISCSI,
  2106. "shost 0x%p, hba 0x%p,%s, param %d.\n",
  2107. shost, chba, chba->ndev->name, param);
  2108. switch (param) {
  2109. case ISCSI_HOST_PARAM_HWADDRESS:
  2110. len = sysfs_format_mac(buf, chba->ndev->dev_addr, 6);
  2111. break;
  2112. case ISCSI_HOST_PARAM_NETDEV_NAME:
  2113. len = sprintf(buf, "%s\n", chba->ndev->name);
  2114. break;
  2115. case ISCSI_HOST_PARAM_IPADDRESS:
  2116. {
  2117. __be32 addr;
  2118. addr = cxgbi_get_iscsi_ipv4(chba);
  2119. len = sprintf(buf, "%pI4", &addr);
  2120. log_debug(1 << CXGBI_DBG_ISCSI,
  2121. "hba %s, ipv4 %pI4.\n", chba->ndev->name, &addr);
  2122. break;
  2123. }
  2124. default:
  2125. return iscsi_host_get_param(shost, param, buf);
  2126. }
  2127. return len;
  2128. }
  2129. EXPORT_SYMBOL_GPL(cxgbi_get_host_param);
  2130. struct iscsi_endpoint *cxgbi_ep_connect(struct Scsi_Host *shost,
  2131. struct sockaddr *dst_addr,
  2132. int non_blocking)
  2133. {
  2134. struct iscsi_endpoint *ep;
  2135. struct cxgbi_endpoint *cep;
  2136. struct cxgbi_hba *hba = NULL;
  2137. struct cxgbi_sock *csk;
  2138. int err = -EINVAL;
  2139. log_debug(1 << CXGBI_DBG_ISCSI | 1 << CXGBI_DBG_SOCK,
  2140. "shost 0x%p, non_blocking %d, dst_addr 0x%p.\n",
  2141. shost, non_blocking, dst_addr);
  2142. if (shost) {
  2143. hba = iscsi_host_priv(shost);
  2144. if (!hba) {
  2145. pr_info("shost 0x%p, priv NULL.\n", shost);
  2146. goto err_out;
  2147. }
  2148. }
  2149. csk = cxgbi_check_route(dst_addr);
  2150. if (IS_ERR(csk))
  2151. return (struct iscsi_endpoint *)csk;
  2152. cxgbi_sock_get(csk);
  2153. if (!hba)
  2154. hba = csk->cdev->hbas[csk->port_id];
  2155. else if (hba != csk->cdev->hbas[csk->port_id]) {
  2156. pr_info("Could not connect through requested host %u"
  2157. "hba 0x%p != 0x%p (%u).\n",
  2158. shost->host_no, hba,
  2159. csk->cdev->hbas[csk->port_id], csk->port_id);
  2160. err = -ENOSPC;
  2161. goto release_conn;
  2162. }
  2163. err = sock_get_port(csk);
  2164. if (err)
  2165. goto release_conn;
  2166. cxgbi_sock_set_state(csk, CTP_CONNECTING);
  2167. err = csk->cdev->csk_init_act_open(csk);
  2168. if (err)
  2169. goto release_conn;
  2170. if (cxgbi_sock_is_closing(csk)) {
  2171. err = -ENOSPC;
  2172. pr_info("csk 0x%p is closing.\n", csk);
  2173. goto release_conn;
  2174. }
  2175. ep = iscsi_create_endpoint(sizeof(*cep));
  2176. if (!ep) {
  2177. err = -ENOMEM;
  2178. pr_info("iscsi alloc ep, OOM.\n");
  2179. goto release_conn;
  2180. }
  2181. cep = ep->dd_data;
  2182. cep->csk = csk;
  2183. cep->chba = hba;
  2184. log_debug(1 << CXGBI_DBG_ISCSI | 1 << CXGBI_DBG_SOCK,
  2185. "ep 0x%p, cep 0x%p, csk 0x%p, hba 0x%p,%s.\n",
  2186. ep, cep, csk, hba, hba->ndev->name);
  2187. return ep;
  2188. release_conn:
  2189. cxgbi_sock_put(csk);
  2190. cxgbi_sock_closed(csk);
  2191. err_out:
  2192. return ERR_PTR(err);
  2193. }
  2194. EXPORT_SYMBOL_GPL(cxgbi_ep_connect);
  2195. int cxgbi_ep_poll(struct iscsi_endpoint *ep, int timeout_ms)
  2196. {
  2197. struct cxgbi_endpoint *cep = ep->dd_data;
  2198. struct cxgbi_sock *csk = cep->csk;
  2199. if (!cxgbi_sock_is_established(csk))
  2200. return 0;
  2201. return 1;
  2202. }
  2203. EXPORT_SYMBOL_GPL(cxgbi_ep_poll);
  2204. void cxgbi_ep_disconnect(struct iscsi_endpoint *ep)
  2205. {
  2206. struct cxgbi_endpoint *cep = ep->dd_data;
  2207. struct cxgbi_conn *cconn = cep->cconn;
  2208. struct cxgbi_sock *csk = cep->csk;
  2209. log_debug(1 << CXGBI_DBG_ISCSI | 1 << CXGBI_DBG_SOCK,
  2210. "ep 0x%p, cep 0x%p, cconn 0x%p, csk 0x%p,%u,0x%lx.\n",
  2211. ep, cep, cconn, csk, csk->state, csk->flags);
  2212. if (cconn && cconn->iconn) {
  2213. iscsi_suspend_tx(cconn->iconn);
  2214. write_lock_bh(&csk->callback_lock);
  2215. cep->csk->user_data = NULL;
  2216. cconn->cep = NULL;
  2217. write_unlock_bh(&csk->callback_lock);
  2218. }
  2219. iscsi_destroy_endpoint(ep);
  2220. if (likely(csk->state >= CTP_ESTABLISHED))
  2221. need_active_close(csk);
  2222. else
  2223. cxgbi_sock_closed(csk);
  2224. cxgbi_sock_put(csk);
  2225. }
  2226. EXPORT_SYMBOL_GPL(cxgbi_ep_disconnect);
  2227. int cxgbi_iscsi_init(struct iscsi_transport *itp,
  2228. struct scsi_transport_template **stt)
  2229. {
  2230. *stt = iscsi_register_transport(itp);
  2231. if (*stt == NULL) {
  2232. pr_err("unable to register %s transport 0x%p.\n",
  2233. itp->name, itp);
  2234. return -ENODEV;
  2235. }
  2236. log_debug(1 << CXGBI_DBG_ISCSI,
  2237. "%s, registered iscsi transport 0x%p.\n",
  2238. itp->name, stt);
  2239. return 0;
  2240. }
  2241. EXPORT_SYMBOL_GPL(cxgbi_iscsi_init);
  2242. void cxgbi_iscsi_cleanup(struct iscsi_transport *itp,
  2243. struct scsi_transport_template **stt)
  2244. {
  2245. if (*stt) {
  2246. log_debug(1 << CXGBI_DBG_ISCSI,
  2247. "de-register transport 0x%p, %s, stt 0x%p.\n",
  2248. itp, itp->name, *stt);
  2249. *stt = NULL;
  2250. iscsi_unregister_transport(itp);
  2251. }
  2252. }
  2253. EXPORT_SYMBOL_GPL(cxgbi_iscsi_cleanup);
  2254. static int __init libcxgbi_init_module(void)
  2255. {
  2256. sw_tag_idx_bits = (__ilog2_u32(ISCSI_ITT_MASK)) + 1;
  2257. sw_tag_age_bits = (__ilog2_u32(ISCSI_AGE_MASK)) + 1;
  2258. pr_info("tag itt 0x%x, %u bits, age 0x%x, %u bits.\n",
  2259. ISCSI_ITT_MASK, sw_tag_idx_bits,
  2260. ISCSI_AGE_MASK, sw_tag_age_bits);
  2261. ddp_setup_host_page_size();
  2262. return 0;
  2263. }
  2264. static void __exit libcxgbi_exit_module(void)
  2265. {
  2266. cxgbi_device_unregister_all(0xFF);
  2267. return;
  2268. }
  2269. module_init(libcxgbi_init_module);
  2270. module_exit(libcxgbi_exit_module);