iwch_provider.c 39 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499
  1. /*
  2. * Copyright (c) 2006 Chelsio, Inc. All rights reserved.
  3. *
  4. * This software is available to you under a choice of one of two
  5. * licenses. You may choose to be licensed under the terms of the GNU
  6. * General Public License (GPL) Version 2, available from the file
  7. * COPYING in the main directory of this source tree, or the
  8. * OpenIB.org BSD license below:
  9. *
  10. * Redistribution and use in source and binary forms, with or
  11. * without modification, are permitted provided that the following
  12. * conditions are met:
  13. *
  14. * - Redistributions of source code must retain the above
  15. * copyright notice, this list of conditions and the following
  16. * disclaimer.
  17. *
  18. * - Redistributions in binary form must reproduce the above
  19. * copyright notice, this list of conditions and the following
  20. * disclaimer in the documentation and/or other materials
  21. * provided with the distribution.
  22. *
  23. * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
  24. * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
  25. * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
  26. * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
  27. * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
  28. * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
  29. * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
  30. * SOFTWARE.
  31. */
  32. #include <linux/module.h>
  33. #include <linux/moduleparam.h>
  34. #include <linux/device.h>
  35. #include <linux/netdevice.h>
  36. #include <linux/etherdevice.h>
  37. #include <linux/delay.h>
  38. #include <linux/errno.h>
  39. #include <linux/list.h>
  40. #include <linux/sched.h>
  41. #include <linux/spinlock.h>
  42. #include <linux/ethtool.h>
  43. #include <linux/rtnetlink.h>
  44. #include <linux/inetdevice.h>
  45. #include <linux/slab.h>
  46. #include <asm/io.h>
  47. #include <asm/irq.h>
  48. #include <asm/byteorder.h>
  49. #include <rdma/iw_cm.h>
  50. #include <rdma/ib_verbs.h>
  51. #include <rdma/ib_smi.h>
  52. #include <rdma/ib_umem.h>
  53. #include <rdma/ib_user_verbs.h>
  54. #include "cxio_hal.h"
  55. #include "iwch.h"
  56. #include "iwch_provider.h"
  57. #include "iwch_cm.h"
  58. #include "iwch_user.h"
  59. #include "common.h"
  60. static struct ib_ah *iwch_ah_create(struct ib_pd *pd,
  61. struct ib_ah_attr *ah_attr)
  62. {
  63. return ERR_PTR(-ENOSYS);
  64. }
  65. static int iwch_ah_destroy(struct ib_ah *ah)
  66. {
  67. return -ENOSYS;
  68. }
  69. static int iwch_multicast_attach(struct ib_qp *ibqp, union ib_gid *gid, u16 lid)
  70. {
  71. return -ENOSYS;
  72. }
  73. static int iwch_multicast_detach(struct ib_qp *ibqp, union ib_gid *gid, u16 lid)
  74. {
  75. return -ENOSYS;
  76. }
  77. static int iwch_process_mad(struct ib_device *ibdev,
  78. int mad_flags,
  79. u8 port_num,
  80. const struct ib_wc *in_wc,
  81. const struct ib_grh *in_grh,
  82. const struct ib_mad_hdr *in_mad,
  83. size_t in_mad_size,
  84. struct ib_mad_hdr *out_mad,
  85. size_t *out_mad_size,
  86. u16 *out_mad_pkey_index)
  87. {
  88. return -ENOSYS;
  89. }
  90. static int iwch_dealloc_ucontext(struct ib_ucontext *context)
  91. {
  92. struct iwch_dev *rhp = to_iwch_dev(context->device);
  93. struct iwch_ucontext *ucontext = to_iwch_ucontext(context);
  94. struct iwch_mm_entry *mm, *tmp;
  95. PDBG("%s context %p\n", __func__, context);
  96. list_for_each_entry_safe(mm, tmp, &ucontext->mmaps, entry)
  97. kfree(mm);
  98. cxio_release_ucontext(&rhp->rdev, &ucontext->uctx);
  99. kfree(ucontext);
  100. return 0;
  101. }
  102. static struct ib_ucontext *iwch_alloc_ucontext(struct ib_device *ibdev,
  103. struct ib_udata *udata)
  104. {
  105. struct iwch_ucontext *context;
  106. struct iwch_dev *rhp = to_iwch_dev(ibdev);
  107. PDBG("%s ibdev %p\n", __func__, ibdev);
  108. context = kzalloc(sizeof(*context), GFP_KERNEL);
  109. if (!context)
  110. return ERR_PTR(-ENOMEM);
  111. cxio_init_ucontext(&rhp->rdev, &context->uctx);
  112. INIT_LIST_HEAD(&context->mmaps);
  113. spin_lock_init(&context->mmap_lock);
  114. return &context->ibucontext;
  115. }
  116. static int iwch_destroy_cq(struct ib_cq *ib_cq)
  117. {
  118. struct iwch_cq *chp;
  119. PDBG("%s ib_cq %p\n", __func__, ib_cq);
  120. chp = to_iwch_cq(ib_cq);
  121. remove_handle(chp->rhp, &chp->rhp->cqidr, chp->cq.cqid);
  122. atomic_dec(&chp->refcnt);
  123. wait_event(chp->wait, !atomic_read(&chp->refcnt));
  124. cxio_destroy_cq(&chp->rhp->rdev, &chp->cq);
  125. kfree(chp);
  126. return 0;
  127. }
  128. static struct ib_cq *iwch_create_cq(struct ib_device *ibdev,
  129. const struct ib_cq_init_attr *attr,
  130. struct ib_ucontext *ib_context,
  131. struct ib_udata *udata)
  132. {
  133. int entries = attr->cqe;
  134. struct iwch_dev *rhp;
  135. struct iwch_cq *chp;
  136. struct iwch_create_cq_resp uresp;
  137. struct iwch_create_cq_req ureq;
  138. struct iwch_ucontext *ucontext = NULL;
  139. static int warned;
  140. size_t resplen;
  141. PDBG("%s ib_dev %p entries %d\n", __func__, ibdev, entries);
  142. if (attr->flags)
  143. return ERR_PTR(-EINVAL);
  144. rhp = to_iwch_dev(ibdev);
  145. chp = kzalloc(sizeof(*chp), GFP_KERNEL);
  146. if (!chp)
  147. return ERR_PTR(-ENOMEM);
  148. if (ib_context) {
  149. ucontext = to_iwch_ucontext(ib_context);
  150. if (!t3a_device(rhp)) {
  151. if (ib_copy_from_udata(&ureq, udata, sizeof (ureq))) {
  152. kfree(chp);
  153. return ERR_PTR(-EFAULT);
  154. }
  155. chp->user_rptr_addr = (u32 __user *)(unsigned long)ureq.user_rptr_addr;
  156. }
  157. }
  158. if (t3a_device(rhp)) {
  159. /*
  160. * T3A: Add some fluff to handle extra CQEs inserted
  161. * for various errors.
  162. * Additional CQE possibilities:
  163. * TERMINATE,
  164. * incoming RDMA WRITE Failures
  165. * incoming RDMA READ REQUEST FAILUREs
  166. * NOTE: We cannot ensure the CQ won't overflow.
  167. */
  168. entries += 16;
  169. }
  170. entries = roundup_pow_of_two(entries);
  171. chp->cq.size_log2 = ilog2(entries);
  172. if (cxio_create_cq(&rhp->rdev, &chp->cq, !ucontext)) {
  173. kfree(chp);
  174. return ERR_PTR(-ENOMEM);
  175. }
  176. chp->rhp = rhp;
  177. chp->ibcq.cqe = 1 << chp->cq.size_log2;
  178. spin_lock_init(&chp->lock);
  179. spin_lock_init(&chp->comp_handler_lock);
  180. atomic_set(&chp->refcnt, 1);
  181. init_waitqueue_head(&chp->wait);
  182. if (insert_handle(rhp, &rhp->cqidr, chp, chp->cq.cqid)) {
  183. cxio_destroy_cq(&chp->rhp->rdev, &chp->cq);
  184. kfree(chp);
  185. return ERR_PTR(-ENOMEM);
  186. }
  187. if (ucontext) {
  188. struct iwch_mm_entry *mm;
  189. mm = kmalloc(sizeof *mm, GFP_KERNEL);
  190. if (!mm) {
  191. iwch_destroy_cq(&chp->ibcq);
  192. return ERR_PTR(-ENOMEM);
  193. }
  194. uresp.cqid = chp->cq.cqid;
  195. uresp.size_log2 = chp->cq.size_log2;
  196. spin_lock(&ucontext->mmap_lock);
  197. uresp.key = ucontext->key;
  198. ucontext->key += PAGE_SIZE;
  199. spin_unlock(&ucontext->mmap_lock);
  200. mm->key = uresp.key;
  201. mm->addr = virt_to_phys(chp->cq.queue);
  202. if (udata->outlen < sizeof uresp) {
  203. if (!warned++)
  204. printk(KERN_WARNING MOD "Warning - "
  205. "downlevel libcxgb3 (non-fatal).\n");
  206. mm->len = PAGE_ALIGN((1UL << uresp.size_log2) *
  207. sizeof(struct t3_cqe));
  208. resplen = sizeof(struct iwch_create_cq_resp_v0);
  209. } else {
  210. mm->len = PAGE_ALIGN(((1UL << uresp.size_log2) + 1) *
  211. sizeof(struct t3_cqe));
  212. uresp.memsize = mm->len;
  213. uresp.reserved = 0;
  214. resplen = sizeof uresp;
  215. }
  216. if (ib_copy_to_udata(udata, &uresp, resplen)) {
  217. kfree(mm);
  218. iwch_destroy_cq(&chp->ibcq);
  219. return ERR_PTR(-EFAULT);
  220. }
  221. insert_mmap(ucontext, mm);
  222. }
  223. PDBG("created cqid 0x%0x chp %p size 0x%0x, dma_addr 0x%0llx\n",
  224. chp->cq.cqid, chp, (1 << chp->cq.size_log2),
  225. (unsigned long long) chp->cq.dma_addr);
  226. return &chp->ibcq;
  227. }
  228. static int iwch_resize_cq(struct ib_cq *cq, int cqe, struct ib_udata *udata)
  229. {
  230. #ifdef notyet
  231. struct iwch_cq *chp = to_iwch_cq(cq);
  232. struct t3_cq oldcq, newcq;
  233. int ret;
  234. PDBG("%s ib_cq %p cqe %d\n", __func__, cq, cqe);
  235. /* We don't downsize... */
  236. if (cqe <= cq->cqe)
  237. return 0;
  238. /* create new t3_cq with new size */
  239. cqe = roundup_pow_of_two(cqe+1);
  240. newcq.size_log2 = ilog2(cqe);
  241. /* Dont allow resize to less than the current wce count */
  242. if (cqe < Q_COUNT(chp->cq.rptr, chp->cq.wptr)) {
  243. return -ENOMEM;
  244. }
  245. /* Quiesce all QPs using this CQ */
  246. ret = iwch_quiesce_qps(chp);
  247. if (ret) {
  248. return ret;
  249. }
  250. ret = cxio_create_cq(&chp->rhp->rdev, &newcq);
  251. if (ret) {
  252. return ret;
  253. }
  254. /* copy CQEs */
  255. memcpy(newcq.queue, chp->cq.queue, (1 << chp->cq.size_log2) *
  256. sizeof(struct t3_cqe));
  257. /* old iwch_qp gets new t3_cq but keeps old cqid */
  258. oldcq = chp->cq;
  259. chp->cq = newcq;
  260. chp->cq.cqid = oldcq.cqid;
  261. /* resize new t3_cq to update the HW context */
  262. ret = cxio_resize_cq(&chp->rhp->rdev, &chp->cq);
  263. if (ret) {
  264. chp->cq = oldcq;
  265. return ret;
  266. }
  267. chp->ibcq.cqe = (1<<chp->cq.size_log2) - 1;
  268. /* destroy old t3_cq */
  269. oldcq.cqid = newcq.cqid;
  270. ret = cxio_destroy_cq(&chp->rhp->rdev, &oldcq);
  271. if (ret) {
  272. printk(KERN_ERR MOD "%s - cxio_destroy_cq failed %d\n",
  273. __func__, ret);
  274. }
  275. /* add user hooks here */
  276. /* resume qps */
  277. ret = iwch_resume_qps(chp);
  278. return ret;
  279. #else
  280. return -ENOSYS;
  281. #endif
  282. }
  283. static int iwch_arm_cq(struct ib_cq *ibcq, enum ib_cq_notify_flags flags)
  284. {
  285. struct iwch_dev *rhp;
  286. struct iwch_cq *chp;
  287. enum t3_cq_opcode cq_op;
  288. int err;
  289. unsigned long flag;
  290. u32 rptr;
  291. chp = to_iwch_cq(ibcq);
  292. rhp = chp->rhp;
  293. if ((flags & IB_CQ_SOLICITED_MASK) == IB_CQ_SOLICITED)
  294. cq_op = CQ_ARM_SE;
  295. else
  296. cq_op = CQ_ARM_AN;
  297. if (chp->user_rptr_addr) {
  298. if (get_user(rptr, chp->user_rptr_addr))
  299. return -EFAULT;
  300. spin_lock_irqsave(&chp->lock, flag);
  301. chp->cq.rptr = rptr;
  302. } else
  303. spin_lock_irqsave(&chp->lock, flag);
  304. PDBG("%s rptr 0x%x\n", __func__, chp->cq.rptr);
  305. err = cxio_hal_cq_op(&rhp->rdev, &chp->cq, cq_op, 0);
  306. spin_unlock_irqrestore(&chp->lock, flag);
  307. if (err < 0)
  308. printk(KERN_ERR MOD "Error %d rearming CQID 0x%x\n", err,
  309. chp->cq.cqid);
  310. if (err > 0 && !(flags & IB_CQ_REPORT_MISSED_EVENTS))
  311. err = 0;
  312. return err;
  313. }
  314. static int iwch_mmap(struct ib_ucontext *context, struct vm_area_struct *vma)
  315. {
  316. int len = vma->vm_end - vma->vm_start;
  317. u32 key = vma->vm_pgoff << PAGE_SHIFT;
  318. struct cxio_rdev *rdev_p;
  319. int ret = 0;
  320. struct iwch_mm_entry *mm;
  321. struct iwch_ucontext *ucontext;
  322. u64 addr;
  323. PDBG("%s pgoff 0x%lx key 0x%x len %d\n", __func__, vma->vm_pgoff,
  324. key, len);
  325. if (vma->vm_start & (PAGE_SIZE-1)) {
  326. return -EINVAL;
  327. }
  328. rdev_p = &(to_iwch_dev(context->device)->rdev);
  329. ucontext = to_iwch_ucontext(context);
  330. mm = remove_mmap(ucontext, key, len);
  331. if (!mm)
  332. return -EINVAL;
  333. addr = mm->addr;
  334. kfree(mm);
  335. if ((addr >= rdev_p->rnic_info.udbell_physbase) &&
  336. (addr < (rdev_p->rnic_info.udbell_physbase +
  337. rdev_p->rnic_info.udbell_len))) {
  338. /*
  339. * Map T3 DB register.
  340. */
  341. if (vma->vm_flags & VM_READ) {
  342. return -EPERM;
  343. }
  344. vma->vm_page_prot = pgprot_noncached(vma->vm_page_prot);
  345. vma->vm_flags |= VM_DONTCOPY | VM_DONTEXPAND;
  346. vma->vm_flags &= ~VM_MAYREAD;
  347. ret = io_remap_pfn_range(vma, vma->vm_start,
  348. addr >> PAGE_SHIFT,
  349. len, vma->vm_page_prot);
  350. } else {
  351. /*
  352. * Map WQ or CQ contig dma memory...
  353. */
  354. ret = remap_pfn_range(vma, vma->vm_start,
  355. addr >> PAGE_SHIFT,
  356. len, vma->vm_page_prot);
  357. }
  358. return ret;
  359. }
  360. static int iwch_deallocate_pd(struct ib_pd *pd)
  361. {
  362. struct iwch_dev *rhp;
  363. struct iwch_pd *php;
  364. php = to_iwch_pd(pd);
  365. rhp = php->rhp;
  366. PDBG("%s ibpd %p pdid 0x%x\n", __func__, pd, php->pdid);
  367. cxio_hal_put_pdid(rhp->rdev.rscp, php->pdid);
  368. kfree(php);
  369. return 0;
  370. }
  371. static struct ib_pd *iwch_allocate_pd(struct ib_device *ibdev,
  372. struct ib_ucontext *context,
  373. struct ib_udata *udata)
  374. {
  375. struct iwch_pd *php;
  376. u32 pdid;
  377. struct iwch_dev *rhp;
  378. PDBG("%s ibdev %p\n", __func__, ibdev);
  379. rhp = (struct iwch_dev *) ibdev;
  380. pdid = cxio_hal_get_pdid(rhp->rdev.rscp);
  381. if (!pdid)
  382. return ERR_PTR(-EINVAL);
  383. php = kzalloc(sizeof(*php), GFP_KERNEL);
  384. if (!php) {
  385. cxio_hal_put_pdid(rhp->rdev.rscp, pdid);
  386. return ERR_PTR(-ENOMEM);
  387. }
  388. php->pdid = pdid;
  389. php->rhp = rhp;
  390. if (context) {
  391. if (ib_copy_to_udata(udata, &php->pdid, sizeof (__u32))) {
  392. iwch_deallocate_pd(&php->ibpd);
  393. return ERR_PTR(-EFAULT);
  394. }
  395. }
  396. PDBG("%s pdid 0x%0x ptr 0x%p\n", __func__, pdid, php);
  397. return &php->ibpd;
  398. }
  399. static int iwch_dereg_mr(struct ib_mr *ib_mr)
  400. {
  401. struct iwch_dev *rhp;
  402. struct iwch_mr *mhp;
  403. u32 mmid;
  404. PDBG("%s ib_mr %p\n", __func__, ib_mr);
  405. /* There can be no memory windows */
  406. if (atomic_read(&ib_mr->usecnt))
  407. return -EINVAL;
  408. mhp = to_iwch_mr(ib_mr);
  409. rhp = mhp->rhp;
  410. mmid = mhp->attr.stag >> 8;
  411. cxio_dereg_mem(&rhp->rdev, mhp->attr.stag, mhp->attr.pbl_size,
  412. mhp->attr.pbl_addr);
  413. iwch_free_pbl(mhp);
  414. remove_handle(rhp, &rhp->mmidr, mmid);
  415. if (mhp->kva)
  416. kfree((void *) (unsigned long) mhp->kva);
  417. if (mhp->umem)
  418. ib_umem_release(mhp->umem);
  419. PDBG("%s mmid 0x%x ptr %p\n", __func__, mmid, mhp);
  420. kfree(mhp);
  421. return 0;
  422. }
  423. static struct ib_mr *iwch_register_phys_mem(struct ib_pd *pd,
  424. struct ib_phys_buf *buffer_list,
  425. int num_phys_buf,
  426. int acc,
  427. u64 *iova_start)
  428. {
  429. __be64 *page_list;
  430. int shift;
  431. u64 total_size;
  432. int npages;
  433. struct iwch_dev *rhp;
  434. struct iwch_pd *php;
  435. struct iwch_mr *mhp;
  436. int ret;
  437. PDBG("%s ib_pd %p\n", __func__, pd);
  438. php = to_iwch_pd(pd);
  439. rhp = php->rhp;
  440. mhp = kzalloc(sizeof(*mhp), GFP_KERNEL);
  441. if (!mhp)
  442. return ERR_PTR(-ENOMEM);
  443. mhp->rhp = rhp;
  444. /* First check that we have enough alignment */
  445. if ((*iova_start & ~PAGE_MASK) != (buffer_list[0].addr & ~PAGE_MASK)) {
  446. ret = -EINVAL;
  447. goto err;
  448. }
  449. if (num_phys_buf > 1 &&
  450. ((buffer_list[0].addr + buffer_list[0].size) & ~PAGE_MASK)) {
  451. ret = -EINVAL;
  452. goto err;
  453. }
  454. ret = build_phys_page_list(buffer_list, num_phys_buf, iova_start,
  455. &total_size, &npages, &shift, &page_list);
  456. if (ret)
  457. goto err;
  458. ret = iwch_alloc_pbl(mhp, npages);
  459. if (ret) {
  460. kfree(page_list);
  461. goto err_pbl;
  462. }
  463. ret = iwch_write_pbl(mhp, page_list, npages, 0);
  464. kfree(page_list);
  465. if (ret)
  466. goto err_pbl;
  467. mhp->attr.pdid = php->pdid;
  468. mhp->attr.zbva = 0;
  469. mhp->attr.perms = iwch_ib_to_tpt_access(acc);
  470. mhp->attr.va_fbo = *iova_start;
  471. mhp->attr.page_size = shift - 12;
  472. mhp->attr.len = (u32) total_size;
  473. mhp->attr.pbl_size = npages;
  474. ret = iwch_register_mem(rhp, php, mhp, shift);
  475. if (ret)
  476. goto err_pbl;
  477. return &mhp->ibmr;
  478. err_pbl:
  479. iwch_free_pbl(mhp);
  480. err:
  481. kfree(mhp);
  482. return ERR_PTR(ret);
  483. }
  484. static int iwch_reregister_phys_mem(struct ib_mr *mr,
  485. int mr_rereg_mask,
  486. struct ib_pd *pd,
  487. struct ib_phys_buf *buffer_list,
  488. int num_phys_buf,
  489. int acc, u64 * iova_start)
  490. {
  491. struct iwch_mr mh, *mhp;
  492. struct iwch_pd *php;
  493. struct iwch_dev *rhp;
  494. __be64 *page_list = NULL;
  495. int shift = 0;
  496. u64 total_size;
  497. int npages = 0;
  498. int ret;
  499. PDBG("%s ib_mr %p ib_pd %p\n", __func__, mr, pd);
  500. /* There can be no memory windows */
  501. if (atomic_read(&mr->usecnt))
  502. return -EINVAL;
  503. mhp = to_iwch_mr(mr);
  504. rhp = mhp->rhp;
  505. php = to_iwch_pd(mr->pd);
  506. /* make sure we are on the same adapter */
  507. if (rhp != php->rhp)
  508. return -EINVAL;
  509. memcpy(&mh, mhp, sizeof *mhp);
  510. if (mr_rereg_mask & IB_MR_REREG_PD)
  511. php = to_iwch_pd(pd);
  512. if (mr_rereg_mask & IB_MR_REREG_ACCESS)
  513. mh.attr.perms = iwch_ib_to_tpt_access(acc);
  514. if (mr_rereg_mask & IB_MR_REREG_TRANS) {
  515. ret = build_phys_page_list(buffer_list, num_phys_buf,
  516. iova_start,
  517. &total_size, &npages,
  518. &shift, &page_list);
  519. if (ret)
  520. return ret;
  521. }
  522. ret = iwch_reregister_mem(rhp, php, &mh, shift, npages);
  523. kfree(page_list);
  524. if (ret) {
  525. return ret;
  526. }
  527. if (mr_rereg_mask & IB_MR_REREG_PD)
  528. mhp->attr.pdid = php->pdid;
  529. if (mr_rereg_mask & IB_MR_REREG_ACCESS)
  530. mhp->attr.perms = iwch_ib_to_tpt_access(acc);
  531. if (mr_rereg_mask & IB_MR_REREG_TRANS) {
  532. mhp->attr.zbva = 0;
  533. mhp->attr.va_fbo = *iova_start;
  534. mhp->attr.page_size = shift - 12;
  535. mhp->attr.len = (u32) total_size;
  536. mhp->attr.pbl_size = npages;
  537. }
  538. return 0;
  539. }
  540. static struct ib_mr *iwch_reg_user_mr(struct ib_pd *pd, u64 start, u64 length,
  541. u64 virt, int acc, struct ib_udata *udata)
  542. {
  543. __be64 *pages;
  544. int shift, n, len;
  545. int i, k, entry;
  546. int err = 0;
  547. struct iwch_dev *rhp;
  548. struct iwch_pd *php;
  549. struct iwch_mr *mhp;
  550. struct iwch_reg_user_mr_resp uresp;
  551. struct scatterlist *sg;
  552. PDBG("%s ib_pd %p\n", __func__, pd);
  553. php = to_iwch_pd(pd);
  554. rhp = php->rhp;
  555. mhp = kzalloc(sizeof(*mhp), GFP_KERNEL);
  556. if (!mhp)
  557. return ERR_PTR(-ENOMEM);
  558. mhp->rhp = rhp;
  559. mhp->umem = ib_umem_get(pd->uobject->context, start, length, acc, 0);
  560. if (IS_ERR(mhp->umem)) {
  561. err = PTR_ERR(mhp->umem);
  562. kfree(mhp);
  563. return ERR_PTR(err);
  564. }
  565. shift = ffs(mhp->umem->page_size) - 1;
  566. n = mhp->umem->nmap;
  567. err = iwch_alloc_pbl(mhp, n);
  568. if (err)
  569. goto err;
  570. pages = (__be64 *) __get_free_page(GFP_KERNEL);
  571. if (!pages) {
  572. err = -ENOMEM;
  573. goto err_pbl;
  574. }
  575. i = n = 0;
  576. for_each_sg(mhp->umem->sg_head.sgl, sg, mhp->umem->nmap, entry) {
  577. len = sg_dma_len(sg) >> shift;
  578. for (k = 0; k < len; ++k) {
  579. pages[i++] = cpu_to_be64(sg_dma_address(sg) +
  580. mhp->umem->page_size * k);
  581. if (i == PAGE_SIZE / sizeof *pages) {
  582. err = iwch_write_pbl(mhp, pages, i, n);
  583. if (err)
  584. goto pbl_done;
  585. n += i;
  586. i = 0;
  587. }
  588. }
  589. }
  590. if (i)
  591. err = iwch_write_pbl(mhp, pages, i, n);
  592. pbl_done:
  593. free_page((unsigned long) pages);
  594. if (err)
  595. goto err_pbl;
  596. mhp->attr.pdid = php->pdid;
  597. mhp->attr.zbva = 0;
  598. mhp->attr.perms = iwch_ib_to_tpt_access(acc);
  599. mhp->attr.va_fbo = virt;
  600. mhp->attr.page_size = shift - 12;
  601. mhp->attr.len = (u32) length;
  602. err = iwch_register_mem(rhp, php, mhp, shift);
  603. if (err)
  604. goto err_pbl;
  605. if (udata && !t3a_device(rhp)) {
  606. uresp.pbl_addr = (mhp->attr.pbl_addr -
  607. rhp->rdev.rnic_info.pbl_base) >> 3;
  608. PDBG("%s user resp pbl_addr 0x%x\n", __func__,
  609. uresp.pbl_addr);
  610. if (ib_copy_to_udata(udata, &uresp, sizeof (uresp))) {
  611. iwch_dereg_mr(&mhp->ibmr);
  612. err = -EFAULT;
  613. goto err;
  614. }
  615. }
  616. return &mhp->ibmr;
  617. err_pbl:
  618. iwch_free_pbl(mhp);
  619. err:
  620. ib_umem_release(mhp->umem);
  621. kfree(mhp);
  622. return ERR_PTR(err);
  623. }
  624. static struct ib_mr *iwch_get_dma_mr(struct ib_pd *pd, int acc)
  625. {
  626. struct ib_phys_buf bl;
  627. u64 kva;
  628. struct ib_mr *ibmr;
  629. PDBG("%s ib_pd %p\n", __func__, pd);
  630. /*
  631. * T3 only supports 32 bits of size.
  632. */
  633. bl.size = 0xffffffff;
  634. bl.addr = 0;
  635. kva = 0;
  636. ibmr = iwch_register_phys_mem(pd, &bl, 1, acc, &kva);
  637. return ibmr;
  638. }
  639. static struct ib_mw *iwch_alloc_mw(struct ib_pd *pd, enum ib_mw_type type)
  640. {
  641. struct iwch_dev *rhp;
  642. struct iwch_pd *php;
  643. struct iwch_mw *mhp;
  644. u32 mmid;
  645. u32 stag = 0;
  646. int ret;
  647. if (type != IB_MW_TYPE_1)
  648. return ERR_PTR(-EINVAL);
  649. php = to_iwch_pd(pd);
  650. rhp = php->rhp;
  651. mhp = kzalloc(sizeof(*mhp), GFP_KERNEL);
  652. if (!mhp)
  653. return ERR_PTR(-ENOMEM);
  654. ret = cxio_allocate_window(&rhp->rdev, &stag, php->pdid);
  655. if (ret) {
  656. kfree(mhp);
  657. return ERR_PTR(ret);
  658. }
  659. mhp->rhp = rhp;
  660. mhp->attr.pdid = php->pdid;
  661. mhp->attr.type = TPT_MW;
  662. mhp->attr.stag = stag;
  663. mmid = (stag) >> 8;
  664. mhp->ibmw.rkey = stag;
  665. if (insert_handle(rhp, &rhp->mmidr, mhp, mmid)) {
  666. cxio_deallocate_window(&rhp->rdev, mhp->attr.stag);
  667. kfree(mhp);
  668. return ERR_PTR(-ENOMEM);
  669. }
  670. PDBG("%s mmid 0x%x mhp %p stag 0x%x\n", __func__, mmid, mhp, stag);
  671. return &(mhp->ibmw);
  672. }
  673. static int iwch_dealloc_mw(struct ib_mw *mw)
  674. {
  675. struct iwch_dev *rhp;
  676. struct iwch_mw *mhp;
  677. u32 mmid;
  678. mhp = to_iwch_mw(mw);
  679. rhp = mhp->rhp;
  680. mmid = (mw->rkey) >> 8;
  681. cxio_deallocate_window(&rhp->rdev, mhp->attr.stag);
  682. remove_handle(rhp, &rhp->mmidr, mmid);
  683. PDBG("%s ib_mw %p mmid 0x%x ptr %p\n", __func__, mw, mmid, mhp);
  684. kfree(mhp);
  685. return 0;
  686. }
  687. static struct ib_mr *iwch_alloc_fast_reg_mr(struct ib_pd *pd, int pbl_depth)
  688. {
  689. struct iwch_dev *rhp;
  690. struct iwch_pd *php;
  691. struct iwch_mr *mhp;
  692. u32 mmid;
  693. u32 stag = 0;
  694. int ret = 0;
  695. php = to_iwch_pd(pd);
  696. rhp = php->rhp;
  697. mhp = kzalloc(sizeof(*mhp), GFP_KERNEL);
  698. if (!mhp)
  699. goto err;
  700. mhp->rhp = rhp;
  701. ret = iwch_alloc_pbl(mhp, pbl_depth);
  702. if (ret)
  703. goto err1;
  704. mhp->attr.pbl_size = pbl_depth;
  705. ret = cxio_allocate_stag(&rhp->rdev, &stag, php->pdid,
  706. mhp->attr.pbl_size, mhp->attr.pbl_addr);
  707. if (ret)
  708. goto err2;
  709. mhp->attr.pdid = php->pdid;
  710. mhp->attr.type = TPT_NON_SHARED_MR;
  711. mhp->attr.stag = stag;
  712. mhp->attr.state = 1;
  713. mmid = (stag) >> 8;
  714. mhp->ibmr.rkey = mhp->ibmr.lkey = stag;
  715. if (insert_handle(rhp, &rhp->mmidr, mhp, mmid))
  716. goto err3;
  717. PDBG("%s mmid 0x%x mhp %p stag 0x%x\n", __func__, mmid, mhp, stag);
  718. return &(mhp->ibmr);
  719. err3:
  720. cxio_dereg_mem(&rhp->rdev, stag, mhp->attr.pbl_size,
  721. mhp->attr.pbl_addr);
  722. err2:
  723. iwch_free_pbl(mhp);
  724. err1:
  725. kfree(mhp);
  726. err:
  727. return ERR_PTR(ret);
  728. }
  729. static struct ib_fast_reg_page_list *iwch_alloc_fastreg_pbl(
  730. struct ib_device *device,
  731. int page_list_len)
  732. {
  733. struct ib_fast_reg_page_list *page_list;
  734. page_list = kmalloc(sizeof *page_list + page_list_len * sizeof(u64),
  735. GFP_KERNEL);
  736. if (!page_list)
  737. return ERR_PTR(-ENOMEM);
  738. page_list->page_list = (u64 *)(page_list + 1);
  739. page_list->max_page_list_len = page_list_len;
  740. return page_list;
  741. }
  742. static void iwch_free_fastreg_pbl(struct ib_fast_reg_page_list *page_list)
  743. {
  744. kfree(page_list);
  745. }
  746. static int iwch_destroy_qp(struct ib_qp *ib_qp)
  747. {
  748. struct iwch_dev *rhp;
  749. struct iwch_qp *qhp;
  750. struct iwch_qp_attributes attrs;
  751. struct iwch_ucontext *ucontext;
  752. qhp = to_iwch_qp(ib_qp);
  753. rhp = qhp->rhp;
  754. attrs.next_state = IWCH_QP_STATE_ERROR;
  755. iwch_modify_qp(rhp, qhp, IWCH_QP_ATTR_NEXT_STATE, &attrs, 0);
  756. wait_event(qhp->wait, !qhp->ep);
  757. remove_handle(rhp, &rhp->qpidr, qhp->wq.qpid);
  758. atomic_dec(&qhp->refcnt);
  759. wait_event(qhp->wait, !atomic_read(&qhp->refcnt));
  760. ucontext = ib_qp->uobject ? to_iwch_ucontext(ib_qp->uobject->context)
  761. : NULL;
  762. cxio_destroy_qp(&rhp->rdev, &qhp->wq,
  763. ucontext ? &ucontext->uctx : &rhp->rdev.uctx);
  764. PDBG("%s ib_qp %p qpid 0x%0x qhp %p\n", __func__,
  765. ib_qp, qhp->wq.qpid, qhp);
  766. kfree(qhp);
  767. return 0;
  768. }
  769. static struct ib_qp *iwch_create_qp(struct ib_pd *pd,
  770. struct ib_qp_init_attr *attrs,
  771. struct ib_udata *udata)
  772. {
  773. struct iwch_dev *rhp;
  774. struct iwch_qp *qhp;
  775. struct iwch_pd *php;
  776. struct iwch_cq *schp;
  777. struct iwch_cq *rchp;
  778. struct iwch_create_qp_resp uresp;
  779. int wqsize, sqsize, rqsize;
  780. struct iwch_ucontext *ucontext;
  781. PDBG("%s ib_pd %p\n", __func__, pd);
  782. if (attrs->qp_type != IB_QPT_RC)
  783. return ERR_PTR(-EINVAL);
  784. php = to_iwch_pd(pd);
  785. rhp = php->rhp;
  786. schp = get_chp(rhp, ((struct iwch_cq *) attrs->send_cq)->cq.cqid);
  787. rchp = get_chp(rhp, ((struct iwch_cq *) attrs->recv_cq)->cq.cqid);
  788. if (!schp || !rchp)
  789. return ERR_PTR(-EINVAL);
  790. /* The RQT size must be # of entries + 1 rounded up to a power of two */
  791. rqsize = roundup_pow_of_two(attrs->cap.max_recv_wr);
  792. if (rqsize == attrs->cap.max_recv_wr)
  793. rqsize = roundup_pow_of_two(attrs->cap.max_recv_wr+1);
  794. /* T3 doesn't support RQT depth < 16 */
  795. if (rqsize < 16)
  796. rqsize = 16;
  797. if (rqsize > T3_MAX_RQ_SIZE)
  798. return ERR_PTR(-EINVAL);
  799. if (attrs->cap.max_inline_data > T3_MAX_INLINE)
  800. return ERR_PTR(-EINVAL);
  801. /*
  802. * NOTE: The SQ and total WQ sizes don't need to be
  803. * a power of two. However, all the code assumes
  804. * they are. EG: Q_FREECNT() and friends.
  805. */
  806. sqsize = roundup_pow_of_two(attrs->cap.max_send_wr);
  807. wqsize = roundup_pow_of_two(rqsize + sqsize);
  808. /*
  809. * Kernel users need more wq space for fastreg WRs which can take
  810. * 2 WR fragments.
  811. */
  812. ucontext = pd->uobject ? to_iwch_ucontext(pd->uobject->context) : NULL;
  813. if (!ucontext && wqsize < (rqsize + (2 * sqsize)))
  814. wqsize = roundup_pow_of_two(rqsize +
  815. roundup_pow_of_two(attrs->cap.max_send_wr * 2));
  816. PDBG("%s wqsize %d sqsize %d rqsize %d\n", __func__,
  817. wqsize, sqsize, rqsize);
  818. qhp = kzalloc(sizeof(*qhp), GFP_KERNEL);
  819. if (!qhp)
  820. return ERR_PTR(-ENOMEM);
  821. qhp->wq.size_log2 = ilog2(wqsize);
  822. qhp->wq.rq_size_log2 = ilog2(rqsize);
  823. qhp->wq.sq_size_log2 = ilog2(sqsize);
  824. if (cxio_create_qp(&rhp->rdev, !udata, &qhp->wq,
  825. ucontext ? &ucontext->uctx : &rhp->rdev.uctx)) {
  826. kfree(qhp);
  827. return ERR_PTR(-ENOMEM);
  828. }
  829. attrs->cap.max_recv_wr = rqsize - 1;
  830. attrs->cap.max_send_wr = sqsize;
  831. attrs->cap.max_inline_data = T3_MAX_INLINE;
  832. qhp->rhp = rhp;
  833. qhp->attr.pd = php->pdid;
  834. qhp->attr.scq = ((struct iwch_cq *) attrs->send_cq)->cq.cqid;
  835. qhp->attr.rcq = ((struct iwch_cq *) attrs->recv_cq)->cq.cqid;
  836. qhp->attr.sq_num_entries = attrs->cap.max_send_wr;
  837. qhp->attr.rq_num_entries = attrs->cap.max_recv_wr;
  838. qhp->attr.sq_max_sges = attrs->cap.max_send_sge;
  839. qhp->attr.sq_max_sges_rdma_write = attrs->cap.max_send_sge;
  840. qhp->attr.rq_max_sges = attrs->cap.max_recv_sge;
  841. qhp->attr.state = IWCH_QP_STATE_IDLE;
  842. qhp->attr.next_state = IWCH_QP_STATE_IDLE;
  843. /*
  844. * XXX - These don't get passed in from the openib user
  845. * at create time. The CM sets them via a QP modify.
  846. * Need to fix... I think the CM should
  847. */
  848. qhp->attr.enable_rdma_read = 1;
  849. qhp->attr.enable_rdma_write = 1;
  850. qhp->attr.enable_bind = 1;
  851. qhp->attr.max_ord = 1;
  852. qhp->attr.max_ird = 1;
  853. spin_lock_init(&qhp->lock);
  854. init_waitqueue_head(&qhp->wait);
  855. atomic_set(&qhp->refcnt, 1);
  856. if (insert_handle(rhp, &rhp->qpidr, qhp, qhp->wq.qpid)) {
  857. cxio_destroy_qp(&rhp->rdev, &qhp->wq,
  858. ucontext ? &ucontext->uctx : &rhp->rdev.uctx);
  859. kfree(qhp);
  860. return ERR_PTR(-ENOMEM);
  861. }
  862. if (udata) {
  863. struct iwch_mm_entry *mm1, *mm2;
  864. mm1 = kmalloc(sizeof *mm1, GFP_KERNEL);
  865. if (!mm1) {
  866. iwch_destroy_qp(&qhp->ibqp);
  867. return ERR_PTR(-ENOMEM);
  868. }
  869. mm2 = kmalloc(sizeof *mm2, GFP_KERNEL);
  870. if (!mm2) {
  871. kfree(mm1);
  872. iwch_destroy_qp(&qhp->ibqp);
  873. return ERR_PTR(-ENOMEM);
  874. }
  875. uresp.qpid = qhp->wq.qpid;
  876. uresp.size_log2 = qhp->wq.size_log2;
  877. uresp.sq_size_log2 = qhp->wq.sq_size_log2;
  878. uresp.rq_size_log2 = qhp->wq.rq_size_log2;
  879. spin_lock(&ucontext->mmap_lock);
  880. uresp.key = ucontext->key;
  881. ucontext->key += PAGE_SIZE;
  882. uresp.db_key = ucontext->key;
  883. ucontext->key += PAGE_SIZE;
  884. spin_unlock(&ucontext->mmap_lock);
  885. if (ib_copy_to_udata(udata, &uresp, sizeof (uresp))) {
  886. kfree(mm1);
  887. kfree(mm2);
  888. iwch_destroy_qp(&qhp->ibqp);
  889. return ERR_PTR(-EFAULT);
  890. }
  891. mm1->key = uresp.key;
  892. mm1->addr = virt_to_phys(qhp->wq.queue);
  893. mm1->len = PAGE_ALIGN(wqsize * sizeof (union t3_wr));
  894. insert_mmap(ucontext, mm1);
  895. mm2->key = uresp.db_key;
  896. mm2->addr = qhp->wq.udb & PAGE_MASK;
  897. mm2->len = PAGE_SIZE;
  898. insert_mmap(ucontext, mm2);
  899. }
  900. qhp->ibqp.qp_num = qhp->wq.qpid;
  901. init_timer(&(qhp->timer));
  902. PDBG("%s sq_num_entries %d, rq_num_entries %d "
  903. "qpid 0x%0x qhp %p dma_addr 0x%llx size %d rq_addr 0x%x\n",
  904. __func__, qhp->attr.sq_num_entries, qhp->attr.rq_num_entries,
  905. qhp->wq.qpid, qhp, (unsigned long long) qhp->wq.dma_addr,
  906. 1 << qhp->wq.size_log2, qhp->wq.rq_addr);
  907. return &qhp->ibqp;
  908. }
  909. static int iwch_ib_modify_qp(struct ib_qp *ibqp, struct ib_qp_attr *attr,
  910. int attr_mask, struct ib_udata *udata)
  911. {
  912. struct iwch_dev *rhp;
  913. struct iwch_qp *qhp;
  914. enum iwch_qp_attr_mask mask = 0;
  915. struct iwch_qp_attributes attrs;
  916. PDBG("%s ib_qp %p\n", __func__, ibqp);
  917. /* iwarp does not support the RTR state */
  918. if ((attr_mask & IB_QP_STATE) && (attr->qp_state == IB_QPS_RTR))
  919. attr_mask &= ~IB_QP_STATE;
  920. /* Make sure we still have something left to do */
  921. if (!attr_mask)
  922. return 0;
  923. memset(&attrs, 0, sizeof attrs);
  924. qhp = to_iwch_qp(ibqp);
  925. rhp = qhp->rhp;
  926. attrs.next_state = iwch_convert_state(attr->qp_state);
  927. attrs.enable_rdma_read = (attr->qp_access_flags &
  928. IB_ACCESS_REMOTE_READ) ? 1 : 0;
  929. attrs.enable_rdma_write = (attr->qp_access_flags &
  930. IB_ACCESS_REMOTE_WRITE) ? 1 : 0;
  931. attrs.enable_bind = (attr->qp_access_flags & IB_ACCESS_MW_BIND) ? 1 : 0;
  932. mask |= (attr_mask & IB_QP_STATE) ? IWCH_QP_ATTR_NEXT_STATE : 0;
  933. mask |= (attr_mask & IB_QP_ACCESS_FLAGS) ?
  934. (IWCH_QP_ATTR_ENABLE_RDMA_READ |
  935. IWCH_QP_ATTR_ENABLE_RDMA_WRITE |
  936. IWCH_QP_ATTR_ENABLE_RDMA_BIND) : 0;
  937. return iwch_modify_qp(rhp, qhp, mask, &attrs, 0);
  938. }
  939. void iwch_qp_add_ref(struct ib_qp *qp)
  940. {
  941. PDBG("%s ib_qp %p\n", __func__, qp);
  942. atomic_inc(&(to_iwch_qp(qp)->refcnt));
  943. }
  944. void iwch_qp_rem_ref(struct ib_qp *qp)
  945. {
  946. PDBG("%s ib_qp %p\n", __func__, qp);
  947. if (atomic_dec_and_test(&(to_iwch_qp(qp)->refcnt)))
  948. wake_up(&(to_iwch_qp(qp)->wait));
  949. }
  950. static struct ib_qp *iwch_get_qp(struct ib_device *dev, int qpn)
  951. {
  952. PDBG("%s ib_dev %p qpn 0x%x\n", __func__, dev, qpn);
  953. return (struct ib_qp *)get_qhp(to_iwch_dev(dev), qpn);
  954. }
  955. static int iwch_query_pkey(struct ib_device *ibdev,
  956. u8 port, u16 index, u16 * pkey)
  957. {
  958. PDBG("%s ibdev %p\n", __func__, ibdev);
  959. *pkey = 0;
  960. return 0;
  961. }
  962. static int iwch_query_gid(struct ib_device *ibdev, u8 port,
  963. int index, union ib_gid *gid)
  964. {
  965. struct iwch_dev *dev;
  966. PDBG("%s ibdev %p, port %d, index %d, gid %p\n",
  967. __func__, ibdev, port, index, gid);
  968. dev = to_iwch_dev(ibdev);
  969. BUG_ON(port == 0 || port > 2);
  970. memset(&(gid->raw[0]), 0, sizeof(gid->raw));
  971. memcpy(&(gid->raw[0]), dev->rdev.port_info.lldevs[port-1]->dev_addr, 6);
  972. return 0;
  973. }
  974. static u64 fw_vers_string_to_u64(struct iwch_dev *iwch_dev)
  975. {
  976. struct ethtool_drvinfo info;
  977. struct net_device *lldev = iwch_dev->rdev.t3cdev_p->lldev;
  978. char *cp, *next;
  979. unsigned fw_maj, fw_min, fw_mic;
  980. lldev->ethtool_ops->get_drvinfo(lldev, &info);
  981. next = info.fw_version + 1;
  982. cp = strsep(&next, ".");
  983. sscanf(cp, "%i", &fw_maj);
  984. cp = strsep(&next, ".");
  985. sscanf(cp, "%i", &fw_min);
  986. cp = strsep(&next, ".");
  987. sscanf(cp, "%i", &fw_mic);
  988. return (((u64)fw_maj & 0xffff) << 32) | ((fw_min & 0xffff) << 16) |
  989. (fw_mic & 0xffff);
  990. }
  991. static int iwch_query_device(struct ib_device *ibdev, struct ib_device_attr *props,
  992. struct ib_udata *uhw)
  993. {
  994. struct iwch_dev *dev;
  995. PDBG("%s ibdev %p\n", __func__, ibdev);
  996. if (uhw->inlen || uhw->outlen)
  997. return -EINVAL;
  998. dev = to_iwch_dev(ibdev);
  999. memset(props, 0, sizeof *props);
  1000. memcpy(&props->sys_image_guid, dev->rdev.t3cdev_p->lldev->dev_addr, 6);
  1001. props->hw_ver = dev->rdev.t3cdev_p->type;
  1002. props->fw_ver = fw_vers_string_to_u64(dev);
  1003. props->device_cap_flags = dev->device_cap_flags;
  1004. props->page_size_cap = dev->attr.mem_pgsizes_bitmask;
  1005. props->vendor_id = (u32)dev->rdev.rnic_info.pdev->vendor;
  1006. props->vendor_part_id = (u32)dev->rdev.rnic_info.pdev->device;
  1007. props->max_mr_size = dev->attr.max_mr_size;
  1008. props->max_qp = dev->attr.max_qps;
  1009. props->max_qp_wr = dev->attr.max_wrs;
  1010. props->max_sge = dev->attr.max_sge_per_wr;
  1011. props->max_sge_rd = 1;
  1012. props->max_qp_rd_atom = dev->attr.max_rdma_reads_per_qp;
  1013. props->max_qp_init_rd_atom = dev->attr.max_rdma_reads_per_qp;
  1014. props->max_cq = dev->attr.max_cqs;
  1015. props->max_cqe = dev->attr.max_cqes_per_cq;
  1016. props->max_mr = dev->attr.max_mem_regs;
  1017. props->max_pd = dev->attr.max_pds;
  1018. props->local_ca_ack_delay = 0;
  1019. props->max_fast_reg_page_list_len = T3_MAX_FASTREG_DEPTH;
  1020. return 0;
  1021. }
  1022. static int iwch_query_port(struct ib_device *ibdev,
  1023. u8 port, struct ib_port_attr *props)
  1024. {
  1025. struct iwch_dev *dev;
  1026. struct net_device *netdev;
  1027. struct in_device *inetdev;
  1028. PDBG("%s ibdev %p\n", __func__, ibdev);
  1029. dev = to_iwch_dev(ibdev);
  1030. netdev = dev->rdev.port_info.lldevs[port-1];
  1031. memset(props, 0, sizeof(struct ib_port_attr));
  1032. props->max_mtu = IB_MTU_4096;
  1033. if (netdev->mtu >= 4096)
  1034. props->active_mtu = IB_MTU_4096;
  1035. else if (netdev->mtu >= 2048)
  1036. props->active_mtu = IB_MTU_2048;
  1037. else if (netdev->mtu >= 1024)
  1038. props->active_mtu = IB_MTU_1024;
  1039. else if (netdev->mtu >= 512)
  1040. props->active_mtu = IB_MTU_512;
  1041. else
  1042. props->active_mtu = IB_MTU_256;
  1043. if (!netif_carrier_ok(netdev))
  1044. props->state = IB_PORT_DOWN;
  1045. else {
  1046. inetdev = in_dev_get(netdev);
  1047. if (inetdev) {
  1048. if (inetdev->ifa_list)
  1049. props->state = IB_PORT_ACTIVE;
  1050. else
  1051. props->state = IB_PORT_INIT;
  1052. in_dev_put(inetdev);
  1053. } else
  1054. props->state = IB_PORT_INIT;
  1055. }
  1056. props->port_cap_flags =
  1057. IB_PORT_CM_SUP |
  1058. IB_PORT_SNMP_TUNNEL_SUP |
  1059. IB_PORT_REINIT_SUP |
  1060. IB_PORT_DEVICE_MGMT_SUP |
  1061. IB_PORT_VENDOR_CLASS_SUP | IB_PORT_BOOT_MGMT_SUP;
  1062. props->gid_tbl_len = 1;
  1063. props->pkey_tbl_len = 1;
  1064. props->active_width = 2;
  1065. props->active_speed = IB_SPEED_DDR;
  1066. props->max_msg_sz = -1;
  1067. return 0;
  1068. }
  1069. static ssize_t show_rev(struct device *dev, struct device_attribute *attr,
  1070. char *buf)
  1071. {
  1072. struct iwch_dev *iwch_dev = container_of(dev, struct iwch_dev,
  1073. ibdev.dev);
  1074. PDBG("%s dev 0x%p\n", __func__, dev);
  1075. return sprintf(buf, "%d\n", iwch_dev->rdev.t3cdev_p->type);
  1076. }
  1077. static ssize_t show_fw_ver(struct device *dev, struct device_attribute *attr, char *buf)
  1078. {
  1079. struct iwch_dev *iwch_dev = container_of(dev, struct iwch_dev,
  1080. ibdev.dev);
  1081. struct ethtool_drvinfo info;
  1082. struct net_device *lldev = iwch_dev->rdev.t3cdev_p->lldev;
  1083. PDBG("%s dev 0x%p\n", __func__, dev);
  1084. lldev->ethtool_ops->get_drvinfo(lldev, &info);
  1085. return sprintf(buf, "%s\n", info.fw_version);
  1086. }
  1087. static ssize_t show_hca(struct device *dev, struct device_attribute *attr,
  1088. char *buf)
  1089. {
  1090. struct iwch_dev *iwch_dev = container_of(dev, struct iwch_dev,
  1091. ibdev.dev);
  1092. struct ethtool_drvinfo info;
  1093. struct net_device *lldev = iwch_dev->rdev.t3cdev_p->lldev;
  1094. PDBG("%s dev 0x%p\n", __func__, dev);
  1095. lldev->ethtool_ops->get_drvinfo(lldev, &info);
  1096. return sprintf(buf, "%s\n", info.driver);
  1097. }
  1098. static ssize_t show_board(struct device *dev, struct device_attribute *attr,
  1099. char *buf)
  1100. {
  1101. struct iwch_dev *iwch_dev = container_of(dev, struct iwch_dev,
  1102. ibdev.dev);
  1103. PDBG("%s dev 0x%p\n", __func__, dev);
  1104. return sprintf(buf, "%x.%x\n", iwch_dev->rdev.rnic_info.pdev->vendor,
  1105. iwch_dev->rdev.rnic_info.pdev->device);
  1106. }
  1107. static int iwch_get_mib(struct ib_device *ibdev,
  1108. union rdma_protocol_stats *stats)
  1109. {
  1110. struct iwch_dev *dev;
  1111. struct tp_mib_stats m;
  1112. int ret;
  1113. PDBG("%s ibdev %p\n", __func__, ibdev);
  1114. dev = to_iwch_dev(ibdev);
  1115. ret = dev->rdev.t3cdev_p->ctl(dev->rdev.t3cdev_p, RDMA_GET_MIB, &m);
  1116. if (ret)
  1117. return -ENOSYS;
  1118. memset(stats, 0, sizeof *stats);
  1119. stats->iw.ipInReceives = ((u64) m.ipInReceive_hi << 32) +
  1120. m.ipInReceive_lo;
  1121. stats->iw.ipInHdrErrors = ((u64) m.ipInHdrErrors_hi << 32) +
  1122. m.ipInHdrErrors_lo;
  1123. stats->iw.ipInAddrErrors = ((u64) m.ipInAddrErrors_hi << 32) +
  1124. m.ipInAddrErrors_lo;
  1125. stats->iw.ipInUnknownProtos = ((u64) m.ipInUnknownProtos_hi << 32) +
  1126. m.ipInUnknownProtos_lo;
  1127. stats->iw.ipInDiscards = ((u64) m.ipInDiscards_hi << 32) +
  1128. m.ipInDiscards_lo;
  1129. stats->iw.ipInDelivers = ((u64) m.ipInDelivers_hi << 32) +
  1130. m.ipInDelivers_lo;
  1131. stats->iw.ipOutRequests = ((u64) m.ipOutRequests_hi << 32) +
  1132. m.ipOutRequests_lo;
  1133. stats->iw.ipOutDiscards = ((u64) m.ipOutDiscards_hi << 32) +
  1134. m.ipOutDiscards_lo;
  1135. stats->iw.ipOutNoRoutes = ((u64) m.ipOutNoRoutes_hi << 32) +
  1136. m.ipOutNoRoutes_lo;
  1137. stats->iw.ipReasmTimeout = (u64) m.ipReasmTimeout;
  1138. stats->iw.ipReasmReqds = (u64) m.ipReasmReqds;
  1139. stats->iw.ipReasmOKs = (u64) m.ipReasmOKs;
  1140. stats->iw.ipReasmFails = (u64) m.ipReasmFails;
  1141. stats->iw.tcpActiveOpens = (u64) m.tcpActiveOpens;
  1142. stats->iw.tcpPassiveOpens = (u64) m.tcpPassiveOpens;
  1143. stats->iw.tcpAttemptFails = (u64) m.tcpAttemptFails;
  1144. stats->iw.tcpEstabResets = (u64) m.tcpEstabResets;
  1145. stats->iw.tcpOutRsts = (u64) m.tcpOutRsts;
  1146. stats->iw.tcpCurrEstab = (u64) m.tcpCurrEstab;
  1147. stats->iw.tcpInSegs = ((u64) m.tcpInSegs_hi << 32) +
  1148. m.tcpInSegs_lo;
  1149. stats->iw.tcpOutSegs = ((u64) m.tcpOutSegs_hi << 32) +
  1150. m.tcpOutSegs_lo;
  1151. stats->iw.tcpRetransSegs = ((u64) m.tcpRetransSeg_hi << 32) +
  1152. m.tcpRetransSeg_lo;
  1153. stats->iw.tcpInErrs = ((u64) m.tcpInErrs_hi << 32) +
  1154. m.tcpInErrs_lo;
  1155. stats->iw.tcpRtoMin = (u64) m.tcpRtoMin;
  1156. stats->iw.tcpRtoMax = (u64) m.tcpRtoMax;
  1157. return 0;
  1158. }
  1159. static DEVICE_ATTR(hw_rev, S_IRUGO, show_rev, NULL);
  1160. static DEVICE_ATTR(fw_ver, S_IRUGO, show_fw_ver, NULL);
  1161. static DEVICE_ATTR(hca_type, S_IRUGO, show_hca, NULL);
  1162. static DEVICE_ATTR(board_id, S_IRUGO, show_board, NULL);
  1163. static struct device_attribute *iwch_class_attributes[] = {
  1164. &dev_attr_hw_rev,
  1165. &dev_attr_fw_ver,
  1166. &dev_attr_hca_type,
  1167. &dev_attr_board_id,
  1168. };
  1169. static int iwch_port_immutable(struct ib_device *ibdev, u8 port_num,
  1170. struct ib_port_immutable *immutable)
  1171. {
  1172. struct ib_port_attr attr;
  1173. int err;
  1174. err = iwch_query_port(ibdev, port_num, &attr);
  1175. if (err)
  1176. return err;
  1177. immutable->pkey_tbl_len = attr.pkey_tbl_len;
  1178. immutable->gid_tbl_len = attr.gid_tbl_len;
  1179. immutable->core_cap_flags = RDMA_CORE_PORT_IWARP;
  1180. return 0;
  1181. }
  1182. int iwch_register_device(struct iwch_dev *dev)
  1183. {
  1184. int ret;
  1185. int i;
  1186. PDBG("%s iwch_dev %p\n", __func__, dev);
  1187. strlcpy(dev->ibdev.name, "cxgb3_%d", IB_DEVICE_NAME_MAX);
  1188. memset(&dev->ibdev.node_guid, 0, sizeof(dev->ibdev.node_guid));
  1189. memcpy(&dev->ibdev.node_guid, dev->rdev.t3cdev_p->lldev->dev_addr, 6);
  1190. dev->ibdev.owner = THIS_MODULE;
  1191. dev->device_cap_flags = IB_DEVICE_LOCAL_DMA_LKEY |
  1192. IB_DEVICE_MEM_WINDOW |
  1193. IB_DEVICE_MEM_MGT_EXTENSIONS;
  1194. /* cxgb3 supports STag 0. */
  1195. dev->ibdev.local_dma_lkey = 0;
  1196. dev->ibdev.uverbs_cmd_mask =
  1197. (1ull << IB_USER_VERBS_CMD_GET_CONTEXT) |
  1198. (1ull << IB_USER_VERBS_CMD_QUERY_DEVICE) |
  1199. (1ull << IB_USER_VERBS_CMD_QUERY_PORT) |
  1200. (1ull << IB_USER_VERBS_CMD_ALLOC_PD) |
  1201. (1ull << IB_USER_VERBS_CMD_DEALLOC_PD) |
  1202. (1ull << IB_USER_VERBS_CMD_REG_MR) |
  1203. (1ull << IB_USER_VERBS_CMD_DEREG_MR) |
  1204. (1ull << IB_USER_VERBS_CMD_CREATE_COMP_CHANNEL) |
  1205. (1ull << IB_USER_VERBS_CMD_CREATE_CQ) |
  1206. (1ull << IB_USER_VERBS_CMD_DESTROY_CQ) |
  1207. (1ull << IB_USER_VERBS_CMD_REQ_NOTIFY_CQ) |
  1208. (1ull << IB_USER_VERBS_CMD_CREATE_QP) |
  1209. (1ull << IB_USER_VERBS_CMD_MODIFY_QP) |
  1210. (1ull << IB_USER_VERBS_CMD_POLL_CQ) |
  1211. (1ull << IB_USER_VERBS_CMD_DESTROY_QP) |
  1212. (1ull << IB_USER_VERBS_CMD_POST_SEND) |
  1213. (1ull << IB_USER_VERBS_CMD_POST_RECV);
  1214. dev->ibdev.node_type = RDMA_NODE_RNIC;
  1215. memcpy(dev->ibdev.node_desc, IWCH_NODE_DESC, sizeof(IWCH_NODE_DESC));
  1216. dev->ibdev.phys_port_cnt = dev->rdev.port_info.nports;
  1217. dev->ibdev.num_comp_vectors = 1;
  1218. dev->ibdev.dma_device = &(dev->rdev.rnic_info.pdev->dev);
  1219. dev->ibdev.query_device = iwch_query_device;
  1220. dev->ibdev.query_port = iwch_query_port;
  1221. dev->ibdev.query_pkey = iwch_query_pkey;
  1222. dev->ibdev.query_gid = iwch_query_gid;
  1223. dev->ibdev.alloc_ucontext = iwch_alloc_ucontext;
  1224. dev->ibdev.dealloc_ucontext = iwch_dealloc_ucontext;
  1225. dev->ibdev.mmap = iwch_mmap;
  1226. dev->ibdev.alloc_pd = iwch_allocate_pd;
  1227. dev->ibdev.dealloc_pd = iwch_deallocate_pd;
  1228. dev->ibdev.create_ah = iwch_ah_create;
  1229. dev->ibdev.destroy_ah = iwch_ah_destroy;
  1230. dev->ibdev.create_qp = iwch_create_qp;
  1231. dev->ibdev.modify_qp = iwch_ib_modify_qp;
  1232. dev->ibdev.destroy_qp = iwch_destroy_qp;
  1233. dev->ibdev.create_cq = iwch_create_cq;
  1234. dev->ibdev.destroy_cq = iwch_destroy_cq;
  1235. dev->ibdev.resize_cq = iwch_resize_cq;
  1236. dev->ibdev.poll_cq = iwch_poll_cq;
  1237. dev->ibdev.get_dma_mr = iwch_get_dma_mr;
  1238. dev->ibdev.reg_phys_mr = iwch_register_phys_mem;
  1239. dev->ibdev.rereg_phys_mr = iwch_reregister_phys_mem;
  1240. dev->ibdev.reg_user_mr = iwch_reg_user_mr;
  1241. dev->ibdev.dereg_mr = iwch_dereg_mr;
  1242. dev->ibdev.alloc_mw = iwch_alloc_mw;
  1243. dev->ibdev.bind_mw = iwch_bind_mw;
  1244. dev->ibdev.dealloc_mw = iwch_dealloc_mw;
  1245. dev->ibdev.alloc_fast_reg_mr = iwch_alloc_fast_reg_mr;
  1246. dev->ibdev.alloc_fast_reg_page_list = iwch_alloc_fastreg_pbl;
  1247. dev->ibdev.free_fast_reg_page_list = iwch_free_fastreg_pbl;
  1248. dev->ibdev.attach_mcast = iwch_multicast_attach;
  1249. dev->ibdev.detach_mcast = iwch_multicast_detach;
  1250. dev->ibdev.process_mad = iwch_process_mad;
  1251. dev->ibdev.req_notify_cq = iwch_arm_cq;
  1252. dev->ibdev.post_send = iwch_post_send;
  1253. dev->ibdev.post_recv = iwch_post_receive;
  1254. dev->ibdev.get_protocol_stats = iwch_get_mib;
  1255. dev->ibdev.uverbs_abi_ver = IWCH_UVERBS_ABI_VERSION;
  1256. dev->ibdev.get_port_immutable = iwch_port_immutable;
  1257. dev->ibdev.iwcm = kmalloc(sizeof(struct iw_cm_verbs), GFP_KERNEL);
  1258. if (!dev->ibdev.iwcm)
  1259. return -ENOMEM;
  1260. dev->ibdev.iwcm->connect = iwch_connect;
  1261. dev->ibdev.iwcm->accept = iwch_accept_cr;
  1262. dev->ibdev.iwcm->reject = iwch_reject_cr;
  1263. dev->ibdev.iwcm->create_listen = iwch_create_listen;
  1264. dev->ibdev.iwcm->destroy_listen = iwch_destroy_listen;
  1265. dev->ibdev.iwcm->add_ref = iwch_qp_add_ref;
  1266. dev->ibdev.iwcm->rem_ref = iwch_qp_rem_ref;
  1267. dev->ibdev.iwcm->get_qp = iwch_get_qp;
  1268. ret = ib_register_device(&dev->ibdev, NULL);
  1269. if (ret)
  1270. goto bail1;
  1271. for (i = 0; i < ARRAY_SIZE(iwch_class_attributes); ++i) {
  1272. ret = device_create_file(&dev->ibdev.dev,
  1273. iwch_class_attributes[i]);
  1274. if (ret) {
  1275. goto bail2;
  1276. }
  1277. }
  1278. return 0;
  1279. bail2:
  1280. ib_unregister_device(&dev->ibdev);
  1281. bail1:
  1282. kfree(dev->ibdev.iwcm);
  1283. return ret;
  1284. }
  1285. void iwch_unregister_device(struct iwch_dev *dev)
  1286. {
  1287. int i;
  1288. PDBG("%s iwch_dev %p\n", __func__, dev);
  1289. for (i = 0; i < ARRAY_SIZE(iwch_class_attributes); ++i)
  1290. device_remove_file(&dev->ibdev.dev,
  1291. iwch_class_attributes[i]);
  1292. ib_unregister_device(&dev->ibdev);
  1293. kfree(dev->ibdev.iwcm);
  1294. return;
  1295. }