libcxgbi.c 67 KB

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