main.c 85 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913191419151916191719181919192019211922192319241925192619271928192919301931193219331934193519361937193819391940194119421943194419451946194719481949195019511952195319541955195619571958195919601961196219631964196519661967196819691970197119721973197419751976197719781979198019811982198319841985198619871988198919901991199219931994199519961997199819992000200120022003200420052006200720082009201020112012201320142015201620172018201920202021202220232024202520262027202820292030203120322033203420352036203720382039204020412042204320442045204620472048204920502051205220532054205520562057205820592060206120622063206420652066206720682069207020712072207320742075207620772078207920802081208220832084208520862087208820892090209120922093209420952096209720982099210021012102210321042105210621072108210921102111211221132114211521162117211821192120212121222123212421252126212721282129213021312132213321342135213621372138213921402141214221432144214521462147214821492150215121522153215421552156215721582159216021612162216321642165216621672168216921702171217221732174217521762177217821792180218121822183218421852186218721882189219021912192219321942195219621972198219922002201220222032204220522062207220822092210221122122213221422152216221722182219222022212222222322242225222622272228222922302231223222332234223522362237223822392240224122422243224422452246224722482249225022512252225322542255225622572258225922602261226222632264226522662267226822692270227122722273227422752276227722782279228022812282228322842285228622872288228922902291229222932294229522962297229822992300230123022303230423052306230723082309231023112312231323142315231623172318231923202321232223232324232523262327232823292330233123322333233423352336233723382339234023412342234323442345234623472348234923502351235223532354235523562357235823592360236123622363236423652366236723682369237023712372237323742375237623772378237923802381238223832384238523862387238823892390239123922393239423952396239723982399240024012402240324042405240624072408240924102411241224132414241524162417241824192420242124222423242424252426242724282429243024312432243324342435243624372438243924402441244224432444244524462447244824492450245124522453245424552456245724582459246024612462246324642465246624672468246924702471247224732474247524762477247824792480248124822483248424852486248724882489249024912492249324942495249624972498249925002501250225032504250525062507250825092510251125122513251425152516251725182519252025212522252325242525252625272528252925302531253225332534253525362537253825392540254125422543254425452546254725482549255025512552255325542555255625572558255925602561256225632564256525662567256825692570257125722573257425752576257725782579258025812582258325842585258625872588258925902591259225932594259525962597259825992600260126022603260426052606260726082609261026112612261326142615261626172618261926202621262226232624262526262627262826292630263126322633263426352636263726382639264026412642264326442645264626472648264926502651265226532654265526562657265826592660266126622663266426652666266726682669267026712672267326742675267626772678267926802681268226832684268526862687268826892690269126922693269426952696269726982699270027012702270327042705270627072708270927102711271227132714271527162717271827192720272127222723272427252726272727282729273027312732273327342735273627372738273927402741274227432744274527462747274827492750275127522753275427552756275727582759276027612762276327642765276627672768276927702771277227732774277527762777277827792780278127822783278427852786278727882789279027912792279327942795279627972798279928002801280228032804280528062807280828092810281128122813281428152816281728182819282028212822282328242825282628272828282928302831283228332834283528362837283828392840284128422843284428452846284728482849285028512852285328542855285628572858285928602861286228632864286528662867286828692870287128722873287428752876287728782879288028812882288328842885288628872888288928902891289228932894289528962897289828992900290129022903290429052906290729082909291029112912291329142915291629172918291929202921292229232924292529262927292829292930293129322933293429352936293729382939294029412942294329442945294629472948294929502951295229532954295529562957295829592960296129622963296429652966296729682969297029712972297329742975297629772978297929802981298229832984298529862987298829892990299129922993299429952996299729982999300030013002300330043005300630073008300930103011301230133014301530163017301830193020302130223023302430253026302730283029303030313032303330343035303630373038303930403041304230433044304530463047304830493050305130523053305430553056305730583059306030613062306330643065306630673068306930703071307230733074307530763077307830793080308130823083308430853086308730883089309030913092309330943095309630973098309931003101310231033104310531063107310831093110311131123113311431153116311731183119312031213122312331243125312631273128312931303131313231333134313531363137313831393140314131423143314431453146314731483149315031513152315331543155315631573158315931603161316231633164316531663167316831693170317131723173317431753176317731783179318031813182318331843185318631873188318931903191319231933194319531963197319831993200320132023203
  1. /*
  2. * Copyright (c) 2013-2015, Mellanox Technologies. 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/highmem.h>
  33. #include <linux/module.h>
  34. #include <linux/init.h>
  35. #include <linux/errno.h>
  36. #include <linux/pci.h>
  37. #include <linux/dma-mapping.h>
  38. #include <linux/slab.h>
  39. #include <linux/io-mapping.h>
  40. #if defined(CONFIG_X86)
  41. #include <asm/pat.h>
  42. #endif
  43. #include <linux/sched.h>
  44. #include <linux/delay.h>
  45. #include <rdma/ib_user_verbs.h>
  46. #include <rdma/ib_addr.h>
  47. #include <rdma/ib_cache.h>
  48. #include <linux/mlx5/port.h>
  49. #include <linux/mlx5/vport.h>
  50. #include <linux/list.h>
  51. #include <rdma/ib_smi.h>
  52. #include <rdma/ib_umem.h>
  53. #include <linux/in.h>
  54. #include <linux/etherdevice.h>
  55. #include <linux/mlx5/fs.h>
  56. #include "user.h"
  57. #include "mlx5_ib.h"
  58. #define DRIVER_NAME "mlx5_ib"
  59. #define DRIVER_VERSION "2.2-1"
  60. #define DRIVER_RELDATE "Feb 2014"
  61. MODULE_AUTHOR("Eli Cohen <eli@mellanox.com>");
  62. MODULE_DESCRIPTION("Mellanox Connect-IB HCA IB driver");
  63. MODULE_LICENSE("Dual BSD/GPL");
  64. MODULE_VERSION(DRIVER_VERSION);
  65. static int deprecated_prof_sel = 2;
  66. module_param_named(prof_sel, deprecated_prof_sel, int, 0444);
  67. MODULE_PARM_DESC(prof_sel, "profile selector. Deprecated here. Moved to module mlx5_core");
  68. static char mlx5_version[] =
  69. DRIVER_NAME ": Mellanox Connect-IB Infiniband driver v"
  70. DRIVER_VERSION " (" DRIVER_RELDATE ")\n";
  71. enum {
  72. MLX5_ATOMIC_SIZE_QP_8BYTES = 1 << 3,
  73. };
  74. static enum rdma_link_layer
  75. mlx5_port_type_cap_to_rdma_ll(int port_type_cap)
  76. {
  77. switch (port_type_cap) {
  78. case MLX5_CAP_PORT_TYPE_IB:
  79. return IB_LINK_LAYER_INFINIBAND;
  80. case MLX5_CAP_PORT_TYPE_ETH:
  81. return IB_LINK_LAYER_ETHERNET;
  82. default:
  83. return IB_LINK_LAYER_UNSPECIFIED;
  84. }
  85. }
  86. static enum rdma_link_layer
  87. mlx5_ib_port_link_layer(struct ib_device *device, u8 port_num)
  88. {
  89. struct mlx5_ib_dev *dev = to_mdev(device);
  90. int port_type_cap = MLX5_CAP_GEN(dev->mdev, port_type);
  91. return mlx5_port_type_cap_to_rdma_ll(port_type_cap);
  92. }
  93. static int mlx5_netdev_event(struct notifier_block *this,
  94. unsigned long event, void *ptr)
  95. {
  96. struct net_device *ndev = netdev_notifier_info_to_dev(ptr);
  97. struct mlx5_ib_dev *ibdev = container_of(this, struct mlx5_ib_dev,
  98. roce.nb);
  99. switch (event) {
  100. case NETDEV_REGISTER:
  101. case NETDEV_UNREGISTER:
  102. write_lock(&ibdev->roce.netdev_lock);
  103. if (ndev->dev.parent == &ibdev->mdev->pdev->dev)
  104. ibdev->roce.netdev = (event == NETDEV_UNREGISTER) ?
  105. NULL : ndev;
  106. write_unlock(&ibdev->roce.netdev_lock);
  107. break;
  108. case NETDEV_UP:
  109. case NETDEV_DOWN:
  110. if (ndev == ibdev->roce.netdev && ibdev->ib_active) {
  111. struct ib_event ibev = {0};
  112. ibev.device = &ibdev->ib_dev;
  113. ibev.event = (event == NETDEV_UP) ?
  114. IB_EVENT_PORT_ACTIVE : IB_EVENT_PORT_ERR;
  115. ibev.element.port_num = 1;
  116. ib_dispatch_event(&ibev);
  117. }
  118. break;
  119. default:
  120. break;
  121. }
  122. return NOTIFY_DONE;
  123. }
  124. static struct net_device *mlx5_ib_get_netdev(struct ib_device *device,
  125. u8 port_num)
  126. {
  127. struct mlx5_ib_dev *ibdev = to_mdev(device);
  128. struct net_device *ndev;
  129. /* Ensure ndev does not disappear before we invoke dev_hold()
  130. */
  131. read_lock(&ibdev->roce.netdev_lock);
  132. ndev = ibdev->roce.netdev;
  133. if (ndev)
  134. dev_hold(ndev);
  135. read_unlock(&ibdev->roce.netdev_lock);
  136. return ndev;
  137. }
  138. static int mlx5_query_port_roce(struct ib_device *device, u8 port_num,
  139. struct ib_port_attr *props)
  140. {
  141. struct mlx5_ib_dev *dev = to_mdev(device);
  142. struct net_device *ndev;
  143. enum ib_mtu ndev_ib_mtu;
  144. u16 qkey_viol_cntr;
  145. memset(props, 0, sizeof(*props));
  146. props->port_cap_flags |= IB_PORT_CM_SUP;
  147. props->port_cap_flags |= IB_PORT_IP_BASED_GIDS;
  148. props->gid_tbl_len = MLX5_CAP_ROCE(dev->mdev,
  149. roce_address_table_size);
  150. props->max_mtu = IB_MTU_4096;
  151. props->max_msg_sz = 1 << MLX5_CAP_GEN(dev->mdev, log_max_msg);
  152. props->pkey_tbl_len = 1;
  153. props->state = IB_PORT_DOWN;
  154. props->phys_state = 3;
  155. mlx5_query_nic_vport_qkey_viol_cntr(dev->mdev, &qkey_viol_cntr);
  156. props->qkey_viol_cntr = qkey_viol_cntr;
  157. ndev = mlx5_ib_get_netdev(device, port_num);
  158. if (!ndev)
  159. return 0;
  160. if (netif_running(ndev) && netif_carrier_ok(ndev)) {
  161. props->state = IB_PORT_ACTIVE;
  162. props->phys_state = 5;
  163. }
  164. ndev_ib_mtu = iboe_get_mtu(ndev->mtu);
  165. dev_put(ndev);
  166. props->active_mtu = min(props->max_mtu, ndev_ib_mtu);
  167. props->active_width = IB_WIDTH_4X; /* TODO */
  168. props->active_speed = IB_SPEED_QDR; /* TODO */
  169. return 0;
  170. }
  171. static void ib_gid_to_mlx5_roce_addr(const union ib_gid *gid,
  172. const struct ib_gid_attr *attr,
  173. void *mlx5_addr)
  174. {
  175. #define MLX5_SET_RA(p, f, v) MLX5_SET(roce_addr_layout, p, f, v)
  176. char *mlx5_addr_l3_addr = MLX5_ADDR_OF(roce_addr_layout, mlx5_addr,
  177. source_l3_address);
  178. void *mlx5_addr_mac = MLX5_ADDR_OF(roce_addr_layout, mlx5_addr,
  179. source_mac_47_32);
  180. if (!gid)
  181. return;
  182. ether_addr_copy(mlx5_addr_mac, attr->ndev->dev_addr);
  183. if (is_vlan_dev(attr->ndev)) {
  184. MLX5_SET_RA(mlx5_addr, vlan_valid, 1);
  185. MLX5_SET_RA(mlx5_addr, vlan_id, vlan_dev_vlan_id(attr->ndev));
  186. }
  187. switch (attr->gid_type) {
  188. case IB_GID_TYPE_IB:
  189. MLX5_SET_RA(mlx5_addr, roce_version, MLX5_ROCE_VERSION_1);
  190. break;
  191. case IB_GID_TYPE_ROCE_UDP_ENCAP:
  192. MLX5_SET_RA(mlx5_addr, roce_version, MLX5_ROCE_VERSION_2);
  193. break;
  194. default:
  195. WARN_ON(true);
  196. }
  197. if (attr->gid_type != IB_GID_TYPE_IB) {
  198. if (ipv6_addr_v4mapped((void *)gid))
  199. MLX5_SET_RA(mlx5_addr, roce_l3_type,
  200. MLX5_ROCE_L3_TYPE_IPV4);
  201. else
  202. MLX5_SET_RA(mlx5_addr, roce_l3_type,
  203. MLX5_ROCE_L3_TYPE_IPV6);
  204. }
  205. if ((attr->gid_type == IB_GID_TYPE_IB) ||
  206. !ipv6_addr_v4mapped((void *)gid))
  207. memcpy(mlx5_addr_l3_addr, gid, sizeof(*gid));
  208. else
  209. memcpy(&mlx5_addr_l3_addr[12], &gid->raw[12], 4);
  210. }
  211. static int set_roce_addr(struct ib_device *device, u8 port_num,
  212. unsigned int index,
  213. const union ib_gid *gid,
  214. const struct ib_gid_attr *attr)
  215. {
  216. struct mlx5_ib_dev *dev = to_mdev(device);
  217. u32 in[MLX5_ST_SZ_DW(set_roce_address_in)] = {0};
  218. u32 out[MLX5_ST_SZ_DW(set_roce_address_out)] = {0};
  219. void *in_addr = MLX5_ADDR_OF(set_roce_address_in, in, roce_address);
  220. enum rdma_link_layer ll = mlx5_ib_port_link_layer(device, port_num);
  221. if (ll != IB_LINK_LAYER_ETHERNET)
  222. return -EINVAL;
  223. ib_gid_to_mlx5_roce_addr(gid, attr, in_addr);
  224. MLX5_SET(set_roce_address_in, in, roce_address_index, index);
  225. MLX5_SET(set_roce_address_in, in, opcode, MLX5_CMD_OP_SET_ROCE_ADDRESS);
  226. return mlx5_cmd_exec(dev->mdev, in, sizeof(in), out, sizeof(out));
  227. }
  228. static int mlx5_ib_add_gid(struct ib_device *device, u8 port_num,
  229. unsigned int index, const union ib_gid *gid,
  230. const struct ib_gid_attr *attr,
  231. __always_unused void **context)
  232. {
  233. return set_roce_addr(device, port_num, index, gid, attr);
  234. }
  235. static int mlx5_ib_del_gid(struct ib_device *device, u8 port_num,
  236. unsigned int index, __always_unused void **context)
  237. {
  238. return set_roce_addr(device, port_num, index, NULL, NULL);
  239. }
  240. __be16 mlx5_get_roce_udp_sport(struct mlx5_ib_dev *dev, u8 port_num,
  241. int index)
  242. {
  243. struct ib_gid_attr attr;
  244. union ib_gid gid;
  245. if (ib_get_cached_gid(&dev->ib_dev, port_num, index, &gid, &attr))
  246. return 0;
  247. if (!attr.ndev)
  248. return 0;
  249. dev_put(attr.ndev);
  250. if (attr.gid_type != IB_GID_TYPE_ROCE_UDP_ENCAP)
  251. return 0;
  252. return cpu_to_be16(MLX5_CAP_ROCE(dev->mdev, r_roce_min_src_udp_port));
  253. }
  254. static int mlx5_use_mad_ifc(struct mlx5_ib_dev *dev)
  255. {
  256. return !MLX5_CAP_GEN(dev->mdev, ib_virt);
  257. }
  258. enum {
  259. MLX5_VPORT_ACCESS_METHOD_MAD,
  260. MLX5_VPORT_ACCESS_METHOD_HCA,
  261. MLX5_VPORT_ACCESS_METHOD_NIC,
  262. };
  263. static int mlx5_get_vport_access_method(struct ib_device *ibdev)
  264. {
  265. if (mlx5_use_mad_ifc(to_mdev(ibdev)))
  266. return MLX5_VPORT_ACCESS_METHOD_MAD;
  267. if (mlx5_ib_port_link_layer(ibdev, 1) ==
  268. IB_LINK_LAYER_ETHERNET)
  269. return MLX5_VPORT_ACCESS_METHOD_NIC;
  270. return MLX5_VPORT_ACCESS_METHOD_HCA;
  271. }
  272. static void get_atomic_caps(struct mlx5_ib_dev *dev,
  273. struct ib_device_attr *props)
  274. {
  275. u8 tmp;
  276. u8 atomic_operations = MLX5_CAP_ATOMIC(dev->mdev, atomic_operations);
  277. u8 atomic_size_qp = MLX5_CAP_ATOMIC(dev->mdev, atomic_size_qp);
  278. u8 atomic_req_8B_endianness_mode =
  279. MLX5_CAP_ATOMIC(dev->mdev, atomic_req_8B_endianess_mode);
  280. /* Check if HW supports 8 bytes standard atomic operations and capable
  281. * of host endianness respond
  282. */
  283. tmp = MLX5_ATOMIC_OPS_CMP_SWAP | MLX5_ATOMIC_OPS_FETCH_ADD;
  284. if (((atomic_operations & tmp) == tmp) &&
  285. (atomic_size_qp & MLX5_ATOMIC_SIZE_QP_8BYTES) &&
  286. (atomic_req_8B_endianness_mode)) {
  287. props->atomic_cap = IB_ATOMIC_HCA;
  288. } else {
  289. props->atomic_cap = IB_ATOMIC_NONE;
  290. }
  291. }
  292. static int mlx5_query_system_image_guid(struct ib_device *ibdev,
  293. __be64 *sys_image_guid)
  294. {
  295. struct mlx5_ib_dev *dev = to_mdev(ibdev);
  296. struct mlx5_core_dev *mdev = dev->mdev;
  297. u64 tmp;
  298. int err;
  299. switch (mlx5_get_vport_access_method(ibdev)) {
  300. case MLX5_VPORT_ACCESS_METHOD_MAD:
  301. return mlx5_query_mad_ifc_system_image_guid(ibdev,
  302. sys_image_guid);
  303. case MLX5_VPORT_ACCESS_METHOD_HCA:
  304. err = mlx5_query_hca_vport_system_image_guid(mdev, &tmp);
  305. break;
  306. case MLX5_VPORT_ACCESS_METHOD_NIC:
  307. err = mlx5_query_nic_vport_system_image_guid(mdev, &tmp);
  308. break;
  309. default:
  310. return -EINVAL;
  311. }
  312. if (!err)
  313. *sys_image_guid = cpu_to_be64(tmp);
  314. return err;
  315. }
  316. static int mlx5_query_max_pkeys(struct ib_device *ibdev,
  317. u16 *max_pkeys)
  318. {
  319. struct mlx5_ib_dev *dev = to_mdev(ibdev);
  320. struct mlx5_core_dev *mdev = dev->mdev;
  321. switch (mlx5_get_vport_access_method(ibdev)) {
  322. case MLX5_VPORT_ACCESS_METHOD_MAD:
  323. return mlx5_query_mad_ifc_max_pkeys(ibdev, max_pkeys);
  324. case MLX5_VPORT_ACCESS_METHOD_HCA:
  325. case MLX5_VPORT_ACCESS_METHOD_NIC:
  326. *max_pkeys = mlx5_to_sw_pkey_sz(MLX5_CAP_GEN(mdev,
  327. pkey_table_size));
  328. return 0;
  329. default:
  330. return -EINVAL;
  331. }
  332. }
  333. static int mlx5_query_vendor_id(struct ib_device *ibdev,
  334. u32 *vendor_id)
  335. {
  336. struct mlx5_ib_dev *dev = to_mdev(ibdev);
  337. switch (mlx5_get_vport_access_method(ibdev)) {
  338. case MLX5_VPORT_ACCESS_METHOD_MAD:
  339. return mlx5_query_mad_ifc_vendor_id(ibdev, vendor_id);
  340. case MLX5_VPORT_ACCESS_METHOD_HCA:
  341. case MLX5_VPORT_ACCESS_METHOD_NIC:
  342. return mlx5_core_query_vendor_id(dev->mdev, vendor_id);
  343. default:
  344. return -EINVAL;
  345. }
  346. }
  347. static int mlx5_query_node_guid(struct mlx5_ib_dev *dev,
  348. __be64 *node_guid)
  349. {
  350. u64 tmp;
  351. int err;
  352. switch (mlx5_get_vport_access_method(&dev->ib_dev)) {
  353. case MLX5_VPORT_ACCESS_METHOD_MAD:
  354. return mlx5_query_mad_ifc_node_guid(dev, node_guid);
  355. case MLX5_VPORT_ACCESS_METHOD_HCA:
  356. err = mlx5_query_hca_vport_node_guid(dev->mdev, &tmp);
  357. break;
  358. case MLX5_VPORT_ACCESS_METHOD_NIC:
  359. err = mlx5_query_nic_vport_node_guid(dev->mdev, &tmp);
  360. break;
  361. default:
  362. return -EINVAL;
  363. }
  364. if (!err)
  365. *node_guid = cpu_to_be64(tmp);
  366. return err;
  367. }
  368. struct mlx5_reg_node_desc {
  369. u8 desc[64];
  370. };
  371. static int mlx5_query_node_desc(struct mlx5_ib_dev *dev, char *node_desc)
  372. {
  373. struct mlx5_reg_node_desc in;
  374. if (mlx5_use_mad_ifc(dev))
  375. return mlx5_query_mad_ifc_node_desc(dev, node_desc);
  376. memset(&in, 0, sizeof(in));
  377. return mlx5_core_access_reg(dev->mdev, &in, sizeof(in), node_desc,
  378. sizeof(struct mlx5_reg_node_desc),
  379. MLX5_REG_NODE_DESC, 0, 0);
  380. }
  381. static int mlx5_ib_query_device(struct ib_device *ibdev,
  382. struct ib_device_attr *props,
  383. struct ib_udata *uhw)
  384. {
  385. struct mlx5_ib_dev *dev = to_mdev(ibdev);
  386. struct mlx5_core_dev *mdev = dev->mdev;
  387. int err = -ENOMEM;
  388. int max_rq_sg;
  389. int max_sq_sg;
  390. u64 min_page_size = 1ull << MLX5_CAP_GEN(mdev, log_pg_sz);
  391. struct mlx5_ib_query_device_resp resp = {};
  392. size_t resp_len;
  393. u64 max_tso;
  394. resp_len = sizeof(resp.comp_mask) + sizeof(resp.response_length);
  395. if (uhw->outlen && uhw->outlen < resp_len)
  396. return -EINVAL;
  397. else
  398. resp.response_length = resp_len;
  399. if (uhw->inlen && !ib_is_udata_cleared(uhw, 0, uhw->inlen))
  400. return -EINVAL;
  401. memset(props, 0, sizeof(*props));
  402. err = mlx5_query_system_image_guid(ibdev,
  403. &props->sys_image_guid);
  404. if (err)
  405. return err;
  406. err = mlx5_query_max_pkeys(ibdev, &props->max_pkeys);
  407. if (err)
  408. return err;
  409. err = mlx5_query_vendor_id(ibdev, &props->vendor_id);
  410. if (err)
  411. return err;
  412. props->fw_ver = ((u64)fw_rev_maj(dev->mdev) << 32) |
  413. (fw_rev_min(dev->mdev) << 16) |
  414. fw_rev_sub(dev->mdev);
  415. props->device_cap_flags = IB_DEVICE_CHANGE_PHY_PORT |
  416. IB_DEVICE_PORT_ACTIVE_EVENT |
  417. IB_DEVICE_SYS_IMAGE_GUID |
  418. IB_DEVICE_RC_RNR_NAK_GEN;
  419. if (MLX5_CAP_GEN(mdev, pkv))
  420. props->device_cap_flags |= IB_DEVICE_BAD_PKEY_CNTR;
  421. if (MLX5_CAP_GEN(mdev, qkv))
  422. props->device_cap_flags |= IB_DEVICE_BAD_QKEY_CNTR;
  423. if (MLX5_CAP_GEN(mdev, apm))
  424. props->device_cap_flags |= IB_DEVICE_AUTO_PATH_MIG;
  425. if (MLX5_CAP_GEN(mdev, xrc))
  426. props->device_cap_flags |= IB_DEVICE_XRC;
  427. if (MLX5_CAP_GEN(mdev, imaicl)) {
  428. props->device_cap_flags |= IB_DEVICE_MEM_WINDOW |
  429. IB_DEVICE_MEM_WINDOW_TYPE_2B;
  430. props->max_mw = 1 << MLX5_CAP_GEN(mdev, log_max_mkey);
  431. /* We support 'Gappy' memory registration too */
  432. props->device_cap_flags |= IB_DEVICE_SG_GAPS_REG;
  433. }
  434. props->device_cap_flags |= IB_DEVICE_MEM_MGT_EXTENSIONS;
  435. if (MLX5_CAP_GEN(mdev, sho)) {
  436. props->device_cap_flags |= IB_DEVICE_SIGNATURE_HANDOVER;
  437. /* At this stage no support for signature handover */
  438. props->sig_prot_cap = IB_PROT_T10DIF_TYPE_1 |
  439. IB_PROT_T10DIF_TYPE_2 |
  440. IB_PROT_T10DIF_TYPE_3;
  441. props->sig_guard_cap = IB_GUARD_T10DIF_CRC |
  442. IB_GUARD_T10DIF_CSUM;
  443. }
  444. if (MLX5_CAP_GEN(mdev, block_lb_mc))
  445. props->device_cap_flags |= IB_DEVICE_BLOCK_MULTICAST_LOOPBACK;
  446. if (MLX5_CAP_GEN(dev->mdev, eth_net_offloads)) {
  447. if (MLX5_CAP_ETH(mdev, csum_cap))
  448. props->device_cap_flags |= IB_DEVICE_RAW_IP_CSUM;
  449. if (field_avail(typeof(resp), tso_caps, uhw->outlen)) {
  450. max_tso = MLX5_CAP_ETH(mdev, max_lso_cap);
  451. if (max_tso) {
  452. resp.tso_caps.max_tso = 1 << max_tso;
  453. resp.tso_caps.supported_qpts |=
  454. 1 << IB_QPT_RAW_PACKET;
  455. resp.response_length += sizeof(resp.tso_caps);
  456. }
  457. }
  458. if (field_avail(typeof(resp), rss_caps, uhw->outlen)) {
  459. resp.rss_caps.rx_hash_function =
  460. MLX5_RX_HASH_FUNC_TOEPLITZ;
  461. resp.rss_caps.rx_hash_fields_mask =
  462. MLX5_RX_HASH_SRC_IPV4 |
  463. MLX5_RX_HASH_DST_IPV4 |
  464. MLX5_RX_HASH_SRC_IPV6 |
  465. MLX5_RX_HASH_DST_IPV6 |
  466. MLX5_RX_HASH_SRC_PORT_TCP |
  467. MLX5_RX_HASH_DST_PORT_TCP |
  468. MLX5_RX_HASH_SRC_PORT_UDP |
  469. MLX5_RX_HASH_DST_PORT_UDP;
  470. resp.response_length += sizeof(resp.rss_caps);
  471. }
  472. } else {
  473. if (field_avail(typeof(resp), tso_caps, uhw->outlen))
  474. resp.response_length += sizeof(resp.tso_caps);
  475. if (field_avail(typeof(resp), rss_caps, uhw->outlen))
  476. resp.response_length += sizeof(resp.rss_caps);
  477. }
  478. if (MLX5_CAP_GEN(mdev, ipoib_basic_offloads)) {
  479. props->device_cap_flags |= IB_DEVICE_UD_IP_CSUM;
  480. props->device_cap_flags |= IB_DEVICE_UD_TSO;
  481. }
  482. if (MLX5_CAP_GEN(dev->mdev, eth_net_offloads) &&
  483. MLX5_CAP_ETH(dev->mdev, scatter_fcs))
  484. props->device_cap_flags |= IB_DEVICE_RAW_SCATTER_FCS;
  485. if (mlx5_get_flow_namespace(dev->mdev, MLX5_FLOW_NAMESPACE_BYPASS))
  486. props->device_cap_flags |= IB_DEVICE_MANAGED_FLOW_STEERING;
  487. props->vendor_part_id = mdev->pdev->device;
  488. props->hw_ver = mdev->pdev->revision;
  489. props->max_mr_size = ~0ull;
  490. props->page_size_cap = ~(min_page_size - 1);
  491. props->max_qp = 1 << MLX5_CAP_GEN(mdev, log_max_qp);
  492. props->max_qp_wr = 1 << MLX5_CAP_GEN(mdev, log_max_qp_sz);
  493. max_rq_sg = MLX5_CAP_GEN(mdev, max_wqe_sz_rq) /
  494. sizeof(struct mlx5_wqe_data_seg);
  495. max_sq_sg = (MLX5_CAP_GEN(mdev, max_wqe_sz_sq) -
  496. sizeof(struct mlx5_wqe_ctrl_seg)) /
  497. sizeof(struct mlx5_wqe_data_seg);
  498. props->max_sge = min(max_rq_sg, max_sq_sg);
  499. props->max_sge_rd = MLX5_MAX_SGE_RD;
  500. props->max_cq = 1 << MLX5_CAP_GEN(mdev, log_max_cq);
  501. props->max_cqe = (1 << MLX5_CAP_GEN(mdev, log_max_cq_sz)) - 1;
  502. props->max_mr = 1 << MLX5_CAP_GEN(mdev, log_max_mkey);
  503. props->max_pd = 1 << MLX5_CAP_GEN(mdev, log_max_pd);
  504. props->max_qp_rd_atom = 1 << MLX5_CAP_GEN(mdev, log_max_ra_req_qp);
  505. props->max_qp_init_rd_atom = 1 << MLX5_CAP_GEN(mdev, log_max_ra_res_qp);
  506. props->max_srq = 1 << MLX5_CAP_GEN(mdev, log_max_srq);
  507. props->max_srq_wr = (1 << MLX5_CAP_GEN(mdev, log_max_srq_sz)) - 1;
  508. props->local_ca_ack_delay = MLX5_CAP_GEN(mdev, local_ca_ack_delay);
  509. props->max_res_rd_atom = props->max_qp_rd_atom * props->max_qp;
  510. props->max_srq_sge = max_rq_sg - 1;
  511. props->max_fast_reg_page_list_len =
  512. 1 << MLX5_CAP_GEN(mdev, log_max_klm_list_size);
  513. get_atomic_caps(dev, props);
  514. props->masked_atomic_cap = IB_ATOMIC_NONE;
  515. props->max_mcast_grp = 1 << MLX5_CAP_GEN(mdev, log_max_mcg);
  516. props->max_mcast_qp_attach = MLX5_CAP_GEN(mdev, max_qp_mcg);
  517. props->max_total_mcast_qp_attach = props->max_mcast_qp_attach *
  518. props->max_mcast_grp;
  519. props->max_map_per_fmr = INT_MAX; /* no limit in ConnectIB */
  520. props->hca_core_clock = MLX5_CAP_GEN(mdev, device_frequency_khz);
  521. props->timestamp_mask = 0x7FFFFFFFFFFFFFFFULL;
  522. #ifdef CONFIG_INFINIBAND_ON_DEMAND_PAGING
  523. if (MLX5_CAP_GEN(mdev, pg))
  524. props->device_cap_flags |= IB_DEVICE_ON_DEMAND_PAGING;
  525. props->odp_caps = dev->odp_caps;
  526. #endif
  527. if (MLX5_CAP_GEN(mdev, cd))
  528. props->device_cap_flags |= IB_DEVICE_CROSS_CHANNEL;
  529. if (!mlx5_core_is_pf(mdev))
  530. props->device_cap_flags |= IB_DEVICE_VIRTUAL_FUNCTION;
  531. if (mlx5_ib_port_link_layer(ibdev, 1) ==
  532. IB_LINK_LAYER_ETHERNET) {
  533. props->rss_caps.max_rwq_indirection_tables =
  534. 1 << MLX5_CAP_GEN(dev->mdev, log_max_rqt);
  535. props->rss_caps.max_rwq_indirection_table_size =
  536. 1 << MLX5_CAP_GEN(dev->mdev, log_max_rqt_size);
  537. props->rss_caps.supported_qpts = 1 << IB_QPT_RAW_PACKET;
  538. props->max_wq_type_rq =
  539. 1 << MLX5_CAP_GEN(dev->mdev, log_max_rq);
  540. }
  541. if (uhw->outlen) {
  542. err = ib_copy_to_udata(uhw, &resp, resp.response_length);
  543. if (err)
  544. return err;
  545. }
  546. return 0;
  547. }
  548. enum mlx5_ib_width {
  549. MLX5_IB_WIDTH_1X = 1 << 0,
  550. MLX5_IB_WIDTH_2X = 1 << 1,
  551. MLX5_IB_WIDTH_4X = 1 << 2,
  552. MLX5_IB_WIDTH_8X = 1 << 3,
  553. MLX5_IB_WIDTH_12X = 1 << 4
  554. };
  555. static int translate_active_width(struct ib_device *ibdev, u8 active_width,
  556. u8 *ib_width)
  557. {
  558. struct mlx5_ib_dev *dev = to_mdev(ibdev);
  559. int err = 0;
  560. if (active_width & MLX5_IB_WIDTH_1X) {
  561. *ib_width = IB_WIDTH_1X;
  562. } else if (active_width & MLX5_IB_WIDTH_2X) {
  563. mlx5_ib_dbg(dev, "active_width %d is not supported by IB spec\n",
  564. (int)active_width);
  565. err = -EINVAL;
  566. } else if (active_width & MLX5_IB_WIDTH_4X) {
  567. *ib_width = IB_WIDTH_4X;
  568. } else if (active_width & MLX5_IB_WIDTH_8X) {
  569. *ib_width = IB_WIDTH_8X;
  570. } else if (active_width & MLX5_IB_WIDTH_12X) {
  571. *ib_width = IB_WIDTH_12X;
  572. } else {
  573. mlx5_ib_dbg(dev, "Invalid active_width %d\n",
  574. (int)active_width);
  575. err = -EINVAL;
  576. }
  577. return err;
  578. }
  579. static int mlx5_mtu_to_ib_mtu(int mtu)
  580. {
  581. switch (mtu) {
  582. case 256: return 1;
  583. case 512: return 2;
  584. case 1024: return 3;
  585. case 2048: return 4;
  586. case 4096: return 5;
  587. default:
  588. pr_warn("invalid mtu\n");
  589. return -1;
  590. }
  591. }
  592. enum ib_max_vl_num {
  593. __IB_MAX_VL_0 = 1,
  594. __IB_MAX_VL_0_1 = 2,
  595. __IB_MAX_VL_0_3 = 3,
  596. __IB_MAX_VL_0_7 = 4,
  597. __IB_MAX_VL_0_14 = 5,
  598. };
  599. enum mlx5_vl_hw_cap {
  600. MLX5_VL_HW_0 = 1,
  601. MLX5_VL_HW_0_1 = 2,
  602. MLX5_VL_HW_0_2 = 3,
  603. MLX5_VL_HW_0_3 = 4,
  604. MLX5_VL_HW_0_4 = 5,
  605. MLX5_VL_HW_0_5 = 6,
  606. MLX5_VL_HW_0_6 = 7,
  607. MLX5_VL_HW_0_7 = 8,
  608. MLX5_VL_HW_0_14 = 15
  609. };
  610. static int translate_max_vl_num(struct ib_device *ibdev, u8 vl_hw_cap,
  611. u8 *max_vl_num)
  612. {
  613. switch (vl_hw_cap) {
  614. case MLX5_VL_HW_0:
  615. *max_vl_num = __IB_MAX_VL_0;
  616. break;
  617. case MLX5_VL_HW_0_1:
  618. *max_vl_num = __IB_MAX_VL_0_1;
  619. break;
  620. case MLX5_VL_HW_0_3:
  621. *max_vl_num = __IB_MAX_VL_0_3;
  622. break;
  623. case MLX5_VL_HW_0_7:
  624. *max_vl_num = __IB_MAX_VL_0_7;
  625. break;
  626. case MLX5_VL_HW_0_14:
  627. *max_vl_num = __IB_MAX_VL_0_14;
  628. break;
  629. default:
  630. return -EINVAL;
  631. }
  632. return 0;
  633. }
  634. static int mlx5_query_hca_port(struct ib_device *ibdev, u8 port,
  635. struct ib_port_attr *props)
  636. {
  637. struct mlx5_ib_dev *dev = to_mdev(ibdev);
  638. struct mlx5_core_dev *mdev = dev->mdev;
  639. struct mlx5_hca_vport_context *rep;
  640. u16 max_mtu;
  641. u16 oper_mtu;
  642. int err;
  643. u8 ib_link_width_oper;
  644. u8 vl_hw_cap;
  645. rep = kzalloc(sizeof(*rep), GFP_KERNEL);
  646. if (!rep) {
  647. err = -ENOMEM;
  648. goto out;
  649. }
  650. memset(props, 0, sizeof(*props));
  651. err = mlx5_query_hca_vport_context(mdev, 0, port, 0, rep);
  652. if (err)
  653. goto out;
  654. props->lid = rep->lid;
  655. props->lmc = rep->lmc;
  656. props->sm_lid = rep->sm_lid;
  657. props->sm_sl = rep->sm_sl;
  658. props->state = rep->vport_state;
  659. props->phys_state = rep->port_physical_state;
  660. props->port_cap_flags = rep->cap_mask1;
  661. props->gid_tbl_len = mlx5_get_gid_table_len(MLX5_CAP_GEN(mdev, gid_table_size));
  662. props->max_msg_sz = 1 << MLX5_CAP_GEN(mdev, log_max_msg);
  663. props->pkey_tbl_len = mlx5_to_sw_pkey_sz(MLX5_CAP_GEN(mdev, pkey_table_size));
  664. props->bad_pkey_cntr = rep->pkey_violation_counter;
  665. props->qkey_viol_cntr = rep->qkey_violation_counter;
  666. props->subnet_timeout = rep->subnet_timeout;
  667. props->init_type_reply = rep->init_type_reply;
  668. props->grh_required = rep->grh_required;
  669. err = mlx5_query_port_link_width_oper(mdev, &ib_link_width_oper, port);
  670. if (err)
  671. goto out;
  672. err = translate_active_width(ibdev, ib_link_width_oper,
  673. &props->active_width);
  674. if (err)
  675. goto out;
  676. err = mlx5_query_port_ib_proto_oper(mdev, &props->active_speed, port);
  677. if (err)
  678. goto out;
  679. mlx5_query_port_max_mtu(mdev, &max_mtu, port);
  680. props->max_mtu = mlx5_mtu_to_ib_mtu(max_mtu);
  681. mlx5_query_port_oper_mtu(mdev, &oper_mtu, port);
  682. props->active_mtu = mlx5_mtu_to_ib_mtu(oper_mtu);
  683. err = mlx5_query_port_vl_hw_cap(mdev, &vl_hw_cap, port);
  684. if (err)
  685. goto out;
  686. err = translate_max_vl_num(ibdev, vl_hw_cap,
  687. &props->max_vl_num);
  688. out:
  689. kfree(rep);
  690. return err;
  691. }
  692. int mlx5_ib_query_port(struct ib_device *ibdev, u8 port,
  693. struct ib_port_attr *props)
  694. {
  695. switch (mlx5_get_vport_access_method(ibdev)) {
  696. case MLX5_VPORT_ACCESS_METHOD_MAD:
  697. return mlx5_query_mad_ifc_port(ibdev, port, props);
  698. case MLX5_VPORT_ACCESS_METHOD_HCA:
  699. return mlx5_query_hca_port(ibdev, port, props);
  700. case MLX5_VPORT_ACCESS_METHOD_NIC:
  701. return mlx5_query_port_roce(ibdev, port, props);
  702. default:
  703. return -EINVAL;
  704. }
  705. }
  706. static int mlx5_ib_query_gid(struct ib_device *ibdev, u8 port, int index,
  707. union ib_gid *gid)
  708. {
  709. struct mlx5_ib_dev *dev = to_mdev(ibdev);
  710. struct mlx5_core_dev *mdev = dev->mdev;
  711. switch (mlx5_get_vport_access_method(ibdev)) {
  712. case MLX5_VPORT_ACCESS_METHOD_MAD:
  713. return mlx5_query_mad_ifc_gids(ibdev, port, index, gid);
  714. case MLX5_VPORT_ACCESS_METHOD_HCA:
  715. return mlx5_query_hca_vport_gid(mdev, 0, port, 0, index, gid);
  716. default:
  717. return -EINVAL;
  718. }
  719. }
  720. static int mlx5_ib_query_pkey(struct ib_device *ibdev, u8 port, u16 index,
  721. u16 *pkey)
  722. {
  723. struct mlx5_ib_dev *dev = to_mdev(ibdev);
  724. struct mlx5_core_dev *mdev = dev->mdev;
  725. switch (mlx5_get_vport_access_method(ibdev)) {
  726. case MLX5_VPORT_ACCESS_METHOD_MAD:
  727. return mlx5_query_mad_ifc_pkey(ibdev, port, index, pkey);
  728. case MLX5_VPORT_ACCESS_METHOD_HCA:
  729. case MLX5_VPORT_ACCESS_METHOD_NIC:
  730. return mlx5_query_hca_vport_pkey(mdev, 0, port, 0, index,
  731. pkey);
  732. default:
  733. return -EINVAL;
  734. }
  735. }
  736. static int mlx5_ib_modify_device(struct ib_device *ibdev, int mask,
  737. struct ib_device_modify *props)
  738. {
  739. struct mlx5_ib_dev *dev = to_mdev(ibdev);
  740. struct mlx5_reg_node_desc in;
  741. struct mlx5_reg_node_desc out;
  742. int err;
  743. if (mask & ~IB_DEVICE_MODIFY_NODE_DESC)
  744. return -EOPNOTSUPP;
  745. if (!(mask & IB_DEVICE_MODIFY_NODE_DESC))
  746. return 0;
  747. /*
  748. * If possible, pass node desc to FW, so it can generate
  749. * a 144 trap. If cmd fails, just ignore.
  750. */
  751. memcpy(&in, props->node_desc, 64);
  752. err = mlx5_core_access_reg(dev->mdev, &in, sizeof(in), &out,
  753. sizeof(out), MLX5_REG_NODE_DESC, 0, 1);
  754. if (err)
  755. return err;
  756. memcpy(ibdev->node_desc, props->node_desc, 64);
  757. return err;
  758. }
  759. static int mlx5_ib_modify_port(struct ib_device *ibdev, u8 port, int mask,
  760. struct ib_port_modify *props)
  761. {
  762. struct mlx5_ib_dev *dev = to_mdev(ibdev);
  763. struct ib_port_attr attr;
  764. u32 tmp;
  765. int err;
  766. mutex_lock(&dev->cap_mask_mutex);
  767. err = mlx5_ib_query_port(ibdev, port, &attr);
  768. if (err)
  769. goto out;
  770. tmp = (attr.port_cap_flags | props->set_port_cap_mask) &
  771. ~props->clr_port_cap_mask;
  772. err = mlx5_set_port_caps(dev->mdev, port, tmp);
  773. out:
  774. mutex_unlock(&dev->cap_mask_mutex);
  775. return err;
  776. }
  777. static struct ib_ucontext *mlx5_ib_alloc_ucontext(struct ib_device *ibdev,
  778. struct ib_udata *udata)
  779. {
  780. struct mlx5_ib_dev *dev = to_mdev(ibdev);
  781. struct mlx5_ib_alloc_ucontext_req_v2 req = {};
  782. struct mlx5_ib_alloc_ucontext_resp resp = {};
  783. struct mlx5_ib_ucontext *context;
  784. struct mlx5_uuar_info *uuari;
  785. struct mlx5_uar *uars;
  786. int gross_uuars;
  787. int num_uars;
  788. int ver;
  789. int uuarn;
  790. int err;
  791. int i;
  792. size_t reqlen;
  793. size_t min_req_v2 = offsetof(struct mlx5_ib_alloc_ucontext_req_v2,
  794. max_cqe_version);
  795. if (!dev->ib_active)
  796. return ERR_PTR(-EAGAIN);
  797. if (udata->inlen < sizeof(struct ib_uverbs_cmd_hdr))
  798. return ERR_PTR(-EINVAL);
  799. reqlen = udata->inlen - sizeof(struct ib_uverbs_cmd_hdr);
  800. if (reqlen == sizeof(struct mlx5_ib_alloc_ucontext_req))
  801. ver = 0;
  802. else if (reqlen >= min_req_v2)
  803. ver = 2;
  804. else
  805. return ERR_PTR(-EINVAL);
  806. err = ib_copy_from_udata(&req, udata, min(reqlen, sizeof(req)));
  807. if (err)
  808. return ERR_PTR(err);
  809. if (req.flags)
  810. return ERR_PTR(-EINVAL);
  811. if (req.total_num_uuars > MLX5_MAX_UUARS)
  812. return ERR_PTR(-ENOMEM);
  813. if (req.total_num_uuars == 0)
  814. return ERR_PTR(-EINVAL);
  815. if (req.comp_mask || req.reserved0 || req.reserved1 || req.reserved2)
  816. return ERR_PTR(-EOPNOTSUPP);
  817. if (reqlen > sizeof(req) &&
  818. !ib_is_udata_cleared(udata, sizeof(req),
  819. reqlen - sizeof(req)))
  820. return ERR_PTR(-EOPNOTSUPP);
  821. req.total_num_uuars = ALIGN(req.total_num_uuars,
  822. MLX5_NON_FP_BF_REGS_PER_PAGE);
  823. if (req.num_low_latency_uuars > req.total_num_uuars - 1)
  824. return ERR_PTR(-EINVAL);
  825. num_uars = req.total_num_uuars / MLX5_NON_FP_BF_REGS_PER_PAGE;
  826. gross_uuars = num_uars * MLX5_BF_REGS_PER_PAGE;
  827. resp.qp_tab_size = 1 << MLX5_CAP_GEN(dev->mdev, log_max_qp);
  828. if (mlx5_core_is_pf(dev->mdev) && MLX5_CAP_GEN(dev->mdev, bf))
  829. resp.bf_reg_size = 1 << MLX5_CAP_GEN(dev->mdev, log_bf_reg_size);
  830. resp.cache_line_size = L1_CACHE_BYTES;
  831. resp.max_sq_desc_sz = MLX5_CAP_GEN(dev->mdev, max_wqe_sz_sq);
  832. resp.max_rq_desc_sz = MLX5_CAP_GEN(dev->mdev, max_wqe_sz_rq);
  833. resp.max_send_wqebb = 1 << MLX5_CAP_GEN(dev->mdev, log_max_qp_sz);
  834. resp.max_recv_wr = 1 << MLX5_CAP_GEN(dev->mdev, log_max_qp_sz);
  835. resp.max_srq_recv_wr = 1 << MLX5_CAP_GEN(dev->mdev, log_max_srq_sz);
  836. resp.cqe_version = min_t(__u8,
  837. (__u8)MLX5_CAP_GEN(dev->mdev, cqe_version),
  838. req.max_cqe_version);
  839. resp.response_length = min(offsetof(typeof(resp), response_length) +
  840. sizeof(resp.response_length), udata->outlen);
  841. context = kzalloc(sizeof(*context), GFP_KERNEL);
  842. if (!context)
  843. return ERR_PTR(-ENOMEM);
  844. uuari = &context->uuari;
  845. mutex_init(&uuari->lock);
  846. uars = kcalloc(num_uars, sizeof(*uars), GFP_KERNEL);
  847. if (!uars) {
  848. err = -ENOMEM;
  849. goto out_ctx;
  850. }
  851. uuari->bitmap = kcalloc(BITS_TO_LONGS(gross_uuars),
  852. sizeof(*uuari->bitmap),
  853. GFP_KERNEL);
  854. if (!uuari->bitmap) {
  855. err = -ENOMEM;
  856. goto out_uar_ctx;
  857. }
  858. /*
  859. * clear all fast path uuars
  860. */
  861. for (i = 0; i < gross_uuars; i++) {
  862. uuarn = i & 3;
  863. if (uuarn == 2 || uuarn == 3)
  864. set_bit(i, uuari->bitmap);
  865. }
  866. uuari->count = kcalloc(gross_uuars, sizeof(*uuari->count), GFP_KERNEL);
  867. if (!uuari->count) {
  868. err = -ENOMEM;
  869. goto out_bitmap;
  870. }
  871. for (i = 0; i < num_uars; i++) {
  872. err = mlx5_cmd_alloc_uar(dev->mdev, &uars[i].index);
  873. if (err)
  874. goto out_count;
  875. }
  876. #ifdef CONFIG_INFINIBAND_ON_DEMAND_PAGING
  877. context->ibucontext.invalidate_range = &mlx5_ib_invalidate_range;
  878. #endif
  879. if (MLX5_CAP_GEN(dev->mdev, log_max_transport_domain)) {
  880. err = mlx5_core_alloc_transport_domain(dev->mdev,
  881. &context->tdn);
  882. if (err)
  883. goto out_uars;
  884. }
  885. INIT_LIST_HEAD(&context->vma_private_list);
  886. INIT_LIST_HEAD(&context->db_page_list);
  887. mutex_init(&context->db_page_mutex);
  888. resp.tot_uuars = req.total_num_uuars;
  889. resp.num_ports = MLX5_CAP_GEN(dev->mdev, num_ports);
  890. if (field_avail(typeof(resp), cqe_version, udata->outlen))
  891. resp.response_length += sizeof(resp.cqe_version);
  892. if (field_avail(typeof(resp), cmds_supp_uhw, udata->outlen)) {
  893. resp.cmds_supp_uhw |= MLX5_USER_CMDS_SUPP_UHW_QUERY_DEVICE;
  894. resp.response_length += sizeof(resp.cmds_supp_uhw);
  895. }
  896. /*
  897. * We don't want to expose information from the PCI bar that is located
  898. * after 4096 bytes, so if the arch only supports larger pages, let's
  899. * pretend we don't support reading the HCA's core clock. This is also
  900. * forced by mmap function.
  901. */
  902. if (PAGE_SIZE <= 4096 &&
  903. field_avail(typeof(resp), hca_core_clock_offset, udata->outlen)) {
  904. resp.comp_mask |=
  905. MLX5_IB_ALLOC_UCONTEXT_RESP_MASK_CORE_CLOCK_OFFSET;
  906. resp.hca_core_clock_offset =
  907. offsetof(struct mlx5_init_seg, internal_timer_h) %
  908. PAGE_SIZE;
  909. resp.response_length += sizeof(resp.hca_core_clock_offset) +
  910. sizeof(resp.reserved2);
  911. }
  912. err = ib_copy_to_udata(udata, &resp, resp.response_length);
  913. if (err)
  914. goto out_td;
  915. uuari->ver = ver;
  916. uuari->num_low_latency_uuars = req.num_low_latency_uuars;
  917. uuari->uars = uars;
  918. uuari->num_uars = num_uars;
  919. context->cqe_version = resp.cqe_version;
  920. return &context->ibucontext;
  921. out_td:
  922. if (MLX5_CAP_GEN(dev->mdev, log_max_transport_domain))
  923. mlx5_core_dealloc_transport_domain(dev->mdev, context->tdn);
  924. out_uars:
  925. for (i--; i >= 0; i--)
  926. mlx5_cmd_free_uar(dev->mdev, uars[i].index);
  927. out_count:
  928. kfree(uuari->count);
  929. out_bitmap:
  930. kfree(uuari->bitmap);
  931. out_uar_ctx:
  932. kfree(uars);
  933. out_ctx:
  934. kfree(context);
  935. return ERR_PTR(err);
  936. }
  937. static int mlx5_ib_dealloc_ucontext(struct ib_ucontext *ibcontext)
  938. {
  939. struct mlx5_ib_ucontext *context = to_mucontext(ibcontext);
  940. struct mlx5_ib_dev *dev = to_mdev(ibcontext->device);
  941. struct mlx5_uuar_info *uuari = &context->uuari;
  942. int i;
  943. if (MLX5_CAP_GEN(dev->mdev, log_max_transport_domain))
  944. mlx5_core_dealloc_transport_domain(dev->mdev, context->tdn);
  945. for (i = 0; i < uuari->num_uars; i++) {
  946. if (mlx5_cmd_free_uar(dev->mdev, uuari->uars[i].index))
  947. mlx5_ib_warn(dev, "failed to free UAR 0x%x\n", uuari->uars[i].index);
  948. }
  949. kfree(uuari->count);
  950. kfree(uuari->bitmap);
  951. kfree(uuari->uars);
  952. kfree(context);
  953. return 0;
  954. }
  955. static phys_addr_t uar_index2pfn(struct mlx5_ib_dev *dev, int index)
  956. {
  957. return (pci_resource_start(dev->mdev->pdev, 0) >> PAGE_SHIFT) + index;
  958. }
  959. static int get_command(unsigned long offset)
  960. {
  961. return (offset >> MLX5_IB_MMAP_CMD_SHIFT) & MLX5_IB_MMAP_CMD_MASK;
  962. }
  963. static int get_arg(unsigned long offset)
  964. {
  965. return offset & ((1 << MLX5_IB_MMAP_CMD_SHIFT) - 1);
  966. }
  967. static int get_index(unsigned long offset)
  968. {
  969. return get_arg(offset);
  970. }
  971. static void mlx5_ib_vma_open(struct vm_area_struct *area)
  972. {
  973. /* vma_open is called when a new VMA is created on top of our VMA. This
  974. * is done through either mremap flow or split_vma (usually due to
  975. * mlock, madvise, munmap, etc.) We do not support a clone of the VMA,
  976. * as this VMA is strongly hardware related. Therefore we set the
  977. * vm_ops of the newly created/cloned VMA to NULL, to prevent it from
  978. * calling us again and trying to do incorrect actions. We assume that
  979. * the original VMA size is exactly a single page, and therefore all
  980. * "splitting" operation will not happen to it.
  981. */
  982. area->vm_ops = NULL;
  983. }
  984. static void mlx5_ib_vma_close(struct vm_area_struct *area)
  985. {
  986. struct mlx5_ib_vma_private_data *mlx5_ib_vma_priv_data;
  987. /* It's guaranteed that all VMAs opened on a FD are closed before the
  988. * file itself is closed, therefore no sync is needed with the regular
  989. * closing flow. (e.g. mlx5 ib_dealloc_ucontext)
  990. * However need a sync with accessing the vma as part of
  991. * mlx5_ib_disassociate_ucontext.
  992. * The close operation is usually called under mm->mmap_sem except when
  993. * process is exiting.
  994. * The exiting case is handled explicitly as part of
  995. * mlx5_ib_disassociate_ucontext.
  996. */
  997. mlx5_ib_vma_priv_data = (struct mlx5_ib_vma_private_data *)area->vm_private_data;
  998. /* setting the vma context pointer to null in the mlx5_ib driver's
  999. * private data, to protect a race condition in
  1000. * mlx5_ib_disassociate_ucontext().
  1001. */
  1002. mlx5_ib_vma_priv_data->vma = NULL;
  1003. list_del(&mlx5_ib_vma_priv_data->list);
  1004. kfree(mlx5_ib_vma_priv_data);
  1005. }
  1006. static const struct vm_operations_struct mlx5_ib_vm_ops = {
  1007. .open = mlx5_ib_vma_open,
  1008. .close = mlx5_ib_vma_close
  1009. };
  1010. static int mlx5_ib_set_vma_data(struct vm_area_struct *vma,
  1011. struct mlx5_ib_ucontext *ctx)
  1012. {
  1013. struct mlx5_ib_vma_private_data *vma_prv;
  1014. struct list_head *vma_head = &ctx->vma_private_list;
  1015. vma_prv = kzalloc(sizeof(*vma_prv), GFP_KERNEL);
  1016. if (!vma_prv)
  1017. return -ENOMEM;
  1018. vma_prv->vma = vma;
  1019. vma->vm_private_data = vma_prv;
  1020. vma->vm_ops = &mlx5_ib_vm_ops;
  1021. list_add(&vma_prv->list, vma_head);
  1022. return 0;
  1023. }
  1024. static void mlx5_ib_disassociate_ucontext(struct ib_ucontext *ibcontext)
  1025. {
  1026. int ret;
  1027. struct vm_area_struct *vma;
  1028. struct mlx5_ib_vma_private_data *vma_private, *n;
  1029. struct mlx5_ib_ucontext *context = to_mucontext(ibcontext);
  1030. struct task_struct *owning_process = NULL;
  1031. struct mm_struct *owning_mm = NULL;
  1032. owning_process = get_pid_task(ibcontext->tgid, PIDTYPE_PID);
  1033. if (!owning_process)
  1034. return;
  1035. owning_mm = get_task_mm(owning_process);
  1036. if (!owning_mm) {
  1037. pr_info("no mm, disassociate ucontext is pending task termination\n");
  1038. while (1) {
  1039. put_task_struct(owning_process);
  1040. usleep_range(1000, 2000);
  1041. owning_process = get_pid_task(ibcontext->tgid,
  1042. PIDTYPE_PID);
  1043. if (!owning_process ||
  1044. owning_process->state == TASK_DEAD) {
  1045. pr_info("disassociate ucontext done, task was terminated\n");
  1046. /* in case task was dead need to release the
  1047. * task struct.
  1048. */
  1049. if (owning_process)
  1050. put_task_struct(owning_process);
  1051. return;
  1052. }
  1053. }
  1054. }
  1055. /* need to protect from a race on closing the vma as part of
  1056. * mlx5_ib_vma_close.
  1057. */
  1058. down_read(&owning_mm->mmap_sem);
  1059. list_for_each_entry_safe(vma_private, n, &context->vma_private_list,
  1060. list) {
  1061. vma = vma_private->vma;
  1062. ret = zap_vma_ptes(vma, vma->vm_start,
  1063. PAGE_SIZE);
  1064. WARN_ONCE(ret, "%s: zap_vma_ptes failed", __func__);
  1065. /* context going to be destroyed, should
  1066. * not access ops any more.
  1067. */
  1068. vma->vm_ops = NULL;
  1069. list_del(&vma_private->list);
  1070. kfree(vma_private);
  1071. }
  1072. up_read(&owning_mm->mmap_sem);
  1073. mmput(owning_mm);
  1074. put_task_struct(owning_process);
  1075. }
  1076. static inline char *mmap_cmd2str(enum mlx5_ib_mmap_cmd cmd)
  1077. {
  1078. switch (cmd) {
  1079. case MLX5_IB_MMAP_WC_PAGE:
  1080. return "WC";
  1081. case MLX5_IB_MMAP_REGULAR_PAGE:
  1082. return "best effort WC";
  1083. case MLX5_IB_MMAP_NC_PAGE:
  1084. return "NC";
  1085. default:
  1086. return NULL;
  1087. }
  1088. }
  1089. static int uar_mmap(struct mlx5_ib_dev *dev, enum mlx5_ib_mmap_cmd cmd,
  1090. struct vm_area_struct *vma,
  1091. struct mlx5_ib_ucontext *context)
  1092. {
  1093. struct mlx5_uuar_info *uuari = &context->uuari;
  1094. int err;
  1095. unsigned long idx;
  1096. phys_addr_t pfn, pa;
  1097. pgprot_t prot;
  1098. switch (cmd) {
  1099. case MLX5_IB_MMAP_WC_PAGE:
  1100. /* Some architectures don't support WC memory */
  1101. #if defined(CONFIG_X86)
  1102. if (!pat_enabled())
  1103. return -EPERM;
  1104. #elif !(defined(CONFIG_PPC) || (defined(CONFIG_ARM) && defined(CONFIG_MMU)))
  1105. return -EPERM;
  1106. #endif
  1107. /* fall through */
  1108. case MLX5_IB_MMAP_REGULAR_PAGE:
  1109. /* For MLX5_IB_MMAP_REGULAR_PAGE do the best effort to get WC */
  1110. prot = pgprot_writecombine(vma->vm_page_prot);
  1111. break;
  1112. case MLX5_IB_MMAP_NC_PAGE:
  1113. prot = pgprot_noncached(vma->vm_page_prot);
  1114. break;
  1115. default:
  1116. return -EINVAL;
  1117. }
  1118. if (vma->vm_end - vma->vm_start != PAGE_SIZE)
  1119. return -EINVAL;
  1120. idx = get_index(vma->vm_pgoff);
  1121. if (idx >= uuari->num_uars)
  1122. return -EINVAL;
  1123. pfn = uar_index2pfn(dev, uuari->uars[idx].index);
  1124. mlx5_ib_dbg(dev, "uar idx 0x%lx, pfn %pa\n", idx, &pfn);
  1125. vma->vm_page_prot = prot;
  1126. err = io_remap_pfn_range(vma, vma->vm_start, pfn,
  1127. PAGE_SIZE, vma->vm_page_prot);
  1128. if (err) {
  1129. mlx5_ib_err(dev, "io_remap_pfn_range failed with error=%d, vm_start=0x%lx, pfn=%pa, mmap_cmd=%s\n",
  1130. err, vma->vm_start, &pfn, mmap_cmd2str(cmd));
  1131. return -EAGAIN;
  1132. }
  1133. pa = pfn << PAGE_SHIFT;
  1134. mlx5_ib_dbg(dev, "mapped %s at 0x%lx, PA %pa\n", mmap_cmd2str(cmd),
  1135. vma->vm_start, &pa);
  1136. return mlx5_ib_set_vma_data(vma, context);
  1137. }
  1138. static int mlx5_ib_mmap(struct ib_ucontext *ibcontext, struct vm_area_struct *vma)
  1139. {
  1140. struct mlx5_ib_ucontext *context = to_mucontext(ibcontext);
  1141. struct mlx5_ib_dev *dev = to_mdev(ibcontext->device);
  1142. unsigned long command;
  1143. phys_addr_t pfn;
  1144. command = get_command(vma->vm_pgoff);
  1145. switch (command) {
  1146. case MLX5_IB_MMAP_WC_PAGE:
  1147. case MLX5_IB_MMAP_NC_PAGE:
  1148. case MLX5_IB_MMAP_REGULAR_PAGE:
  1149. return uar_mmap(dev, command, vma, context);
  1150. case MLX5_IB_MMAP_GET_CONTIGUOUS_PAGES:
  1151. return -ENOSYS;
  1152. case MLX5_IB_MMAP_CORE_CLOCK:
  1153. if (vma->vm_end - vma->vm_start != PAGE_SIZE)
  1154. return -EINVAL;
  1155. if (vma->vm_flags & VM_WRITE)
  1156. return -EPERM;
  1157. /* Don't expose to user-space information it shouldn't have */
  1158. if (PAGE_SIZE > 4096)
  1159. return -EOPNOTSUPP;
  1160. vma->vm_page_prot = pgprot_noncached(vma->vm_page_prot);
  1161. pfn = (dev->mdev->iseg_base +
  1162. offsetof(struct mlx5_init_seg, internal_timer_h)) >>
  1163. PAGE_SHIFT;
  1164. if (io_remap_pfn_range(vma, vma->vm_start, pfn,
  1165. PAGE_SIZE, vma->vm_page_prot))
  1166. return -EAGAIN;
  1167. mlx5_ib_dbg(dev, "mapped internal timer at 0x%lx, PA 0x%llx\n",
  1168. vma->vm_start,
  1169. (unsigned long long)pfn << PAGE_SHIFT);
  1170. break;
  1171. default:
  1172. return -EINVAL;
  1173. }
  1174. return 0;
  1175. }
  1176. static struct ib_pd *mlx5_ib_alloc_pd(struct ib_device *ibdev,
  1177. struct ib_ucontext *context,
  1178. struct ib_udata *udata)
  1179. {
  1180. struct mlx5_ib_alloc_pd_resp resp;
  1181. struct mlx5_ib_pd *pd;
  1182. int err;
  1183. pd = kmalloc(sizeof(*pd), GFP_KERNEL);
  1184. if (!pd)
  1185. return ERR_PTR(-ENOMEM);
  1186. err = mlx5_core_alloc_pd(to_mdev(ibdev)->mdev, &pd->pdn);
  1187. if (err) {
  1188. kfree(pd);
  1189. return ERR_PTR(err);
  1190. }
  1191. if (context) {
  1192. resp.pdn = pd->pdn;
  1193. if (ib_copy_to_udata(udata, &resp, sizeof(resp))) {
  1194. mlx5_core_dealloc_pd(to_mdev(ibdev)->mdev, pd->pdn);
  1195. kfree(pd);
  1196. return ERR_PTR(-EFAULT);
  1197. }
  1198. }
  1199. return &pd->ibpd;
  1200. }
  1201. static int mlx5_ib_dealloc_pd(struct ib_pd *pd)
  1202. {
  1203. struct mlx5_ib_dev *mdev = to_mdev(pd->device);
  1204. struct mlx5_ib_pd *mpd = to_mpd(pd);
  1205. mlx5_core_dealloc_pd(mdev->mdev, mpd->pdn);
  1206. kfree(mpd);
  1207. return 0;
  1208. }
  1209. enum {
  1210. MATCH_CRITERIA_ENABLE_OUTER_BIT,
  1211. MATCH_CRITERIA_ENABLE_MISC_BIT,
  1212. MATCH_CRITERIA_ENABLE_INNER_BIT
  1213. };
  1214. #define HEADER_IS_ZERO(match_criteria, headers) \
  1215. !(memchr_inv(MLX5_ADDR_OF(fte_match_param, match_criteria, headers), \
  1216. 0, MLX5_FLD_SZ_BYTES(fte_match_param, headers))) \
  1217. static u8 get_match_criteria_enable(u32 *match_criteria)
  1218. {
  1219. u8 match_criteria_enable;
  1220. match_criteria_enable =
  1221. (!HEADER_IS_ZERO(match_criteria, outer_headers)) <<
  1222. MATCH_CRITERIA_ENABLE_OUTER_BIT;
  1223. match_criteria_enable |=
  1224. (!HEADER_IS_ZERO(match_criteria, misc_parameters)) <<
  1225. MATCH_CRITERIA_ENABLE_MISC_BIT;
  1226. match_criteria_enable |=
  1227. (!HEADER_IS_ZERO(match_criteria, inner_headers)) <<
  1228. MATCH_CRITERIA_ENABLE_INNER_BIT;
  1229. return match_criteria_enable;
  1230. }
  1231. static void set_proto(void *outer_c, void *outer_v, u8 mask, u8 val)
  1232. {
  1233. MLX5_SET(fte_match_set_lyr_2_4, outer_c, ip_protocol, mask);
  1234. MLX5_SET(fte_match_set_lyr_2_4, outer_v, ip_protocol, val);
  1235. }
  1236. static void set_tos(void *outer_c, void *outer_v, u8 mask, u8 val)
  1237. {
  1238. MLX5_SET(fte_match_set_lyr_2_4, outer_c, ip_ecn, mask);
  1239. MLX5_SET(fte_match_set_lyr_2_4, outer_v, ip_ecn, val);
  1240. MLX5_SET(fte_match_set_lyr_2_4, outer_c, ip_dscp, mask >> 2);
  1241. MLX5_SET(fte_match_set_lyr_2_4, outer_v, ip_dscp, val >> 2);
  1242. }
  1243. #define LAST_ETH_FIELD vlan_tag
  1244. #define LAST_IB_FIELD sl
  1245. #define LAST_IPV4_FIELD tos
  1246. #define LAST_IPV6_FIELD traffic_class
  1247. #define LAST_TCP_UDP_FIELD src_port
  1248. /* Field is the last supported field */
  1249. #define FIELDS_NOT_SUPPORTED(filter, field)\
  1250. memchr_inv((void *)&filter.field +\
  1251. sizeof(filter.field), 0,\
  1252. sizeof(filter) -\
  1253. offsetof(typeof(filter), field) -\
  1254. sizeof(filter.field))
  1255. static int parse_flow_attr(u32 *match_c, u32 *match_v,
  1256. const union ib_flow_spec *ib_spec)
  1257. {
  1258. void *outer_headers_c = MLX5_ADDR_OF(fte_match_param, match_c,
  1259. outer_headers);
  1260. void *outer_headers_v = MLX5_ADDR_OF(fte_match_param, match_v,
  1261. outer_headers);
  1262. void *misc_params_c = MLX5_ADDR_OF(fte_match_param, match_c,
  1263. misc_parameters);
  1264. void *misc_params_v = MLX5_ADDR_OF(fte_match_param, match_v,
  1265. misc_parameters);
  1266. switch (ib_spec->type) {
  1267. case IB_FLOW_SPEC_ETH:
  1268. if (FIELDS_NOT_SUPPORTED(ib_spec->eth.mask, LAST_ETH_FIELD))
  1269. return -ENOTSUPP;
  1270. ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, outer_headers_c,
  1271. dmac_47_16),
  1272. ib_spec->eth.mask.dst_mac);
  1273. ether_addr_copy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, outer_headers_v,
  1274. dmac_47_16),
  1275. ib_spec->eth.val.dst_mac);
  1276. if (ib_spec->eth.mask.vlan_tag) {
  1277. MLX5_SET(fte_match_set_lyr_2_4, outer_headers_c,
  1278. vlan_tag, 1);
  1279. MLX5_SET(fte_match_set_lyr_2_4, outer_headers_v,
  1280. vlan_tag, 1);
  1281. MLX5_SET(fte_match_set_lyr_2_4, outer_headers_c,
  1282. first_vid, ntohs(ib_spec->eth.mask.vlan_tag));
  1283. MLX5_SET(fte_match_set_lyr_2_4, outer_headers_v,
  1284. first_vid, ntohs(ib_spec->eth.val.vlan_tag));
  1285. MLX5_SET(fte_match_set_lyr_2_4, outer_headers_c,
  1286. first_cfi,
  1287. ntohs(ib_spec->eth.mask.vlan_tag) >> 12);
  1288. MLX5_SET(fte_match_set_lyr_2_4, outer_headers_v,
  1289. first_cfi,
  1290. ntohs(ib_spec->eth.val.vlan_tag) >> 12);
  1291. MLX5_SET(fte_match_set_lyr_2_4, outer_headers_c,
  1292. first_prio,
  1293. ntohs(ib_spec->eth.mask.vlan_tag) >> 13);
  1294. MLX5_SET(fte_match_set_lyr_2_4, outer_headers_v,
  1295. first_prio,
  1296. ntohs(ib_spec->eth.val.vlan_tag) >> 13);
  1297. }
  1298. MLX5_SET(fte_match_set_lyr_2_4, outer_headers_c,
  1299. ethertype, ntohs(ib_spec->eth.mask.ether_type));
  1300. MLX5_SET(fte_match_set_lyr_2_4, outer_headers_v,
  1301. ethertype, ntohs(ib_spec->eth.val.ether_type));
  1302. break;
  1303. case IB_FLOW_SPEC_IPV4:
  1304. if (FIELDS_NOT_SUPPORTED(ib_spec->ipv4.mask, LAST_IPV4_FIELD))
  1305. return -ENOTSUPP;
  1306. MLX5_SET(fte_match_set_lyr_2_4, outer_headers_c,
  1307. ethertype, 0xffff);
  1308. MLX5_SET(fte_match_set_lyr_2_4, outer_headers_v,
  1309. ethertype, ETH_P_IP);
  1310. memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, outer_headers_c,
  1311. src_ipv4_src_ipv6.ipv4_layout.ipv4),
  1312. &ib_spec->ipv4.mask.src_ip,
  1313. sizeof(ib_spec->ipv4.mask.src_ip));
  1314. memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, outer_headers_v,
  1315. src_ipv4_src_ipv6.ipv4_layout.ipv4),
  1316. &ib_spec->ipv4.val.src_ip,
  1317. sizeof(ib_spec->ipv4.val.src_ip));
  1318. memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, outer_headers_c,
  1319. dst_ipv4_dst_ipv6.ipv4_layout.ipv4),
  1320. &ib_spec->ipv4.mask.dst_ip,
  1321. sizeof(ib_spec->ipv4.mask.dst_ip));
  1322. memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, outer_headers_v,
  1323. dst_ipv4_dst_ipv6.ipv4_layout.ipv4),
  1324. &ib_spec->ipv4.val.dst_ip,
  1325. sizeof(ib_spec->ipv4.val.dst_ip));
  1326. set_tos(outer_headers_c, outer_headers_v,
  1327. ib_spec->ipv4.mask.tos, ib_spec->ipv4.val.tos);
  1328. set_proto(outer_headers_c, outer_headers_v,
  1329. ib_spec->ipv4.mask.proto, ib_spec->ipv4.val.proto);
  1330. break;
  1331. case IB_FLOW_SPEC_IPV6:
  1332. if (FIELDS_NOT_SUPPORTED(ib_spec->ipv6.mask, LAST_IPV6_FIELD))
  1333. return -ENOTSUPP;
  1334. MLX5_SET(fte_match_set_lyr_2_4, outer_headers_c,
  1335. ethertype, 0xffff);
  1336. MLX5_SET(fte_match_set_lyr_2_4, outer_headers_v,
  1337. ethertype, ETH_P_IPV6);
  1338. memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, outer_headers_c,
  1339. src_ipv4_src_ipv6.ipv6_layout.ipv6),
  1340. &ib_spec->ipv6.mask.src_ip,
  1341. sizeof(ib_spec->ipv6.mask.src_ip));
  1342. memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, outer_headers_v,
  1343. src_ipv4_src_ipv6.ipv6_layout.ipv6),
  1344. &ib_spec->ipv6.val.src_ip,
  1345. sizeof(ib_spec->ipv6.val.src_ip));
  1346. memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, outer_headers_c,
  1347. dst_ipv4_dst_ipv6.ipv6_layout.ipv6),
  1348. &ib_spec->ipv6.mask.dst_ip,
  1349. sizeof(ib_spec->ipv6.mask.dst_ip));
  1350. memcpy(MLX5_ADDR_OF(fte_match_set_lyr_2_4, outer_headers_v,
  1351. dst_ipv4_dst_ipv6.ipv6_layout.ipv6),
  1352. &ib_spec->ipv6.val.dst_ip,
  1353. sizeof(ib_spec->ipv6.val.dst_ip));
  1354. set_tos(outer_headers_c, outer_headers_v,
  1355. ib_spec->ipv6.mask.traffic_class,
  1356. ib_spec->ipv6.val.traffic_class);
  1357. set_proto(outer_headers_c, outer_headers_v,
  1358. ib_spec->ipv6.mask.next_hdr,
  1359. ib_spec->ipv6.val.next_hdr);
  1360. MLX5_SET(fte_match_set_misc, misc_params_c,
  1361. outer_ipv6_flow_label,
  1362. ntohl(ib_spec->ipv6.mask.flow_label));
  1363. MLX5_SET(fte_match_set_misc, misc_params_v,
  1364. outer_ipv6_flow_label,
  1365. ntohl(ib_spec->ipv6.val.flow_label));
  1366. break;
  1367. case IB_FLOW_SPEC_TCP:
  1368. if (FIELDS_NOT_SUPPORTED(ib_spec->tcp_udp.mask,
  1369. LAST_TCP_UDP_FIELD))
  1370. return -ENOTSUPP;
  1371. MLX5_SET(fte_match_set_lyr_2_4, outer_headers_c, ip_protocol,
  1372. 0xff);
  1373. MLX5_SET(fte_match_set_lyr_2_4, outer_headers_v, ip_protocol,
  1374. IPPROTO_TCP);
  1375. MLX5_SET(fte_match_set_lyr_2_4, outer_headers_c, tcp_sport,
  1376. ntohs(ib_spec->tcp_udp.mask.src_port));
  1377. MLX5_SET(fte_match_set_lyr_2_4, outer_headers_v, tcp_sport,
  1378. ntohs(ib_spec->tcp_udp.val.src_port));
  1379. MLX5_SET(fte_match_set_lyr_2_4, outer_headers_c, tcp_dport,
  1380. ntohs(ib_spec->tcp_udp.mask.dst_port));
  1381. MLX5_SET(fte_match_set_lyr_2_4, outer_headers_v, tcp_dport,
  1382. ntohs(ib_spec->tcp_udp.val.dst_port));
  1383. break;
  1384. case IB_FLOW_SPEC_UDP:
  1385. if (FIELDS_NOT_SUPPORTED(ib_spec->tcp_udp.mask,
  1386. LAST_TCP_UDP_FIELD))
  1387. return -ENOTSUPP;
  1388. MLX5_SET(fte_match_set_lyr_2_4, outer_headers_c, ip_protocol,
  1389. 0xff);
  1390. MLX5_SET(fte_match_set_lyr_2_4, outer_headers_v, ip_protocol,
  1391. IPPROTO_UDP);
  1392. MLX5_SET(fte_match_set_lyr_2_4, outer_headers_c, udp_sport,
  1393. ntohs(ib_spec->tcp_udp.mask.src_port));
  1394. MLX5_SET(fte_match_set_lyr_2_4, outer_headers_v, udp_sport,
  1395. ntohs(ib_spec->tcp_udp.val.src_port));
  1396. MLX5_SET(fte_match_set_lyr_2_4, outer_headers_c, udp_dport,
  1397. ntohs(ib_spec->tcp_udp.mask.dst_port));
  1398. MLX5_SET(fte_match_set_lyr_2_4, outer_headers_v, udp_dport,
  1399. ntohs(ib_spec->tcp_udp.val.dst_port));
  1400. break;
  1401. default:
  1402. return -EINVAL;
  1403. }
  1404. return 0;
  1405. }
  1406. /* If a flow could catch both multicast and unicast packets,
  1407. * it won't fall into the multicast flow steering table and this rule
  1408. * could steal other multicast packets.
  1409. */
  1410. static bool flow_is_multicast_only(struct ib_flow_attr *ib_attr)
  1411. {
  1412. struct ib_flow_spec_eth *eth_spec;
  1413. if (ib_attr->type != IB_FLOW_ATTR_NORMAL ||
  1414. ib_attr->size < sizeof(struct ib_flow_attr) +
  1415. sizeof(struct ib_flow_spec_eth) ||
  1416. ib_attr->num_of_specs < 1)
  1417. return false;
  1418. eth_spec = (struct ib_flow_spec_eth *)(ib_attr + 1);
  1419. if (eth_spec->type != IB_FLOW_SPEC_ETH ||
  1420. eth_spec->size != sizeof(*eth_spec))
  1421. return false;
  1422. return is_multicast_ether_addr(eth_spec->mask.dst_mac) &&
  1423. is_multicast_ether_addr(eth_spec->val.dst_mac);
  1424. }
  1425. static bool is_valid_attr(const struct ib_flow_attr *flow_attr)
  1426. {
  1427. union ib_flow_spec *ib_spec = (union ib_flow_spec *)(flow_attr + 1);
  1428. bool has_ipv4_spec = false;
  1429. bool eth_type_ipv4 = true;
  1430. unsigned int spec_index;
  1431. /* Validate that ethertype is correct */
  1432. for (spec_index = 0; spec_index < flow_attr->num_of_specs; spec_index++) {
  1433. if (ib_spec->type == IB_FLOW_SPEC_ETH &&
  1434. ib_spec->eth.mask.ether_type) {
  1435. if (!((ib_spec->eth.mask.ether_type == htons(0xffff)) &&
  1436. ib_spec->eth.val.ether_type == htons(ETH_P_IP)))
  1437. eth_type_ipv4 = false;
  1438. } else if (ib_spec->type == IB_FLOW_SPEC_IPV4) {
  1439. has_ipv4_spec = true;
  1440. }
  1441. ib_spec = (void *)ib_spec + ib_spec->size;
  1442. }
  1443. return !has_ipv4_spec || eth_type_ipv4;
  1444. }
  1445. static void put_flow_table(struct mlx5_ib_dev *dev,
  1446. struct mlx5_ib_flow_prio *prio, bool ft_added)
  1447. {
  1448. prio->refcount -= !!ft_added;
  1449. if (!prio->refcount) {
  1450. mlx5_destroy_flow_table(prio->flow_table);
  1451. prio->flow_table = NULL;
  1452. }
  1453. }
  1454. static int mlx5_ib_destroy_flow(struct ib_flow *flow_id)
  1455. {
  1456. struct mlx5_ib_dev *dev = to_mdev(flow_id->qp->device);
  1457. struct mlx5_ib_flow_handler *handler = container_of(flow_id,
  1458. struct mlx5_ib_flow_handler,
  1459. ibflow);
  1460. struct mlx5_ib_flow_handler *iter, *tmp;
  1461. mutex_lock(&dev->flow_db.lock);
  1462. list_for_each_entry_safe(iter, tmp, &handler->list, list) {
  1463. mlx5_del_flow_rule(iter->rule);
  1464. put_flow_table(dev, iter->prio, true);
  1465. list_del(&iter->list);
  1466. kfree(iter);
  1467. }
  1468. mlx5_del_flow_rule(handler->rule);
  1469. put_flow_table(dev, handler->prio, true);
  1470. mutex_unlock(&dev->flow_db.lock);
  1471. kfree(handler);
  1472. return 0;
  1473. }
  1474. static int ib_prio_to_core_prio(unsigned int priority, bool dont_trap)
  1475. {
  1476. priority *= 2;
  1477. if (!dont_trap)
  1478. priority++;
  1479. return priority;
  1480. }
  1481. enum flow_table_type {
  1482. MLX5_IB_FT_RX,
  1483. MLX5_IB_FT_TX
  1484. };
  1485. #define MLX5_FS_MAX_TYPES 10
  1486. #define MLX5_FS_MAX_ENTRIES 32000UL
  1487. static struct mlx5_ib_flow_prio *get_flow_table(struct mlx5_ib_dev *dev,
  1488. struct ib_flow_attr *flow_attr,
  1489. enum flow_table_type ft_type)
  1490. {
  1491. bool dont_trap = flow_attr->flags & IB_FLOW_ATTR_FLAGS_DONT_TRAP;
  1492. struct mlx5_flow_namespace *ns = NULL;
  1493. struct mlx5_ib_flow_prio *prio;
  1494. struct mlx5_flow_table *ft;
  1495. int num_entries;
  1496. int num_groups;
  1497. int priority;
  1498. int err = 0;
  1499. if (flow_attr->type == IB_FLOW_ATTR_NORMAL) {
  1500. if (flow_is_multicast_only(flow_attr) &&
  1501. !dont_trap)
  1502. priority = MLX5_IB_FLOW_MCAST_PRIO;
  1503. else
  1504. priority = ib_prio_to_core_prio(flow_attr->priority,
  1505. dont_trap);
  1506. ns = mlx5_get_flow_namespace(dev->mdev,
  1507. MLX5_FLOW_NAMESPACE_BYPASS);
  1508. num_entries = MLX5_FS_MAX_ENTRIES;
  1509. num_groups = MLX5_FS_MAX_TYPES;
  1510. prio = &dev->flow_db.prios[priority];
  1511. } else if (flow_attr->type == IB_FLOW_ATTR_ALL_DEFAULT ||
  1512. flow_attr->type == IB_FLOW_ATTR_MC_DEFAULT) {
  1513. ns = mlx5_get_flow_namespace(dev->mdev,
  1514. MLX5_FLOW_NAMESPACE_LEFTOVERS);
  1515. build_leftovers_ft_param(&priority,
  1516. &num_entries,
  1517. &num_groups);
  1518. prio = &dev->flow_db.prios[MLX5_IB_FLOW_LEFTOVERS_PRIO];
  1519. } else if (flow_attr->type == IB_FLOW_ATTR_SNIFFER) {
  1520. if (!MLX5_CAP_FLOWTABLE(dev->mdev,
  1521. allow_sniffer_and_nic_rx_shared_tir))
  1522. return ERR_PTR(-ENOTSUPP);
  1523. ns = mlx5_get_flow_namespace(dev->mdev, ft_type == MLX5_IB_FT_RX ?
  1524. MLX5_FLOW_NAMESPACE_SNIFFER_RX :
  1525. MLX5_FLOW_NAMESPACE_SNIFFER_TX);
  1526. prio = &dev->flow_db.sniffer[ft_type];
  1527. priority = 0;
  1528. num_entries = 1;
  1529. num_groups = 1;
  1530. }
  1531. if (!ns)
  1532. return ERR_PTR(-ENOTSUPP);
  1533. ft = prio->flow_table;
  1534. if (!ft) {
  1535. ft = mlx5_create_auto_grouped_flow_table(ns, priority,
  1536. num_entries,
  1537. num_groups,
  1538. 0);
  1539. if (!IS_ERR(ft)) {
  1540. prio->refcount = 0;
  1541. prio->flow_table = ft;
  1542. } else {
  1543. err = PTR_ERR(ft);
  1544. }
  1545. }
  1546. return err ? ERR_PTR(err) : prio;
  1547. }
  1548. static struct mlx5_ib_flow_handler *create_flow_rule(struct mlx5_ib_dev *dev,
  1549. struct mlx5_ib_flow_prio *ft_prio,
  1550. const struct ib_flow_attr *flow_attr,
  1551. struct mlx5_flow_destination *dst)
  1552. {
  1553. struct mlx5_flow_table *ft = ft_prio->flow_table;
  1554. struct mlx5_ib_flow_handler *handler;
  1555. struct mlx5_flow_spec *spec;
  1556. const void *ib_flow = (const void *)flow_attr + sizeof(*flow_attr);
  1557. unsigned int spec_index;
  1558. u32 action;
  1559. int err = 0;
  1560. if (!is_valid_attr(flow_attr))
  1561. return ERR_PTR(-EINVAL);
  1562. spec = mlx5_vzalloc(sizeof(*spec));
  1563. handler = kzalloc(sizeof(*handler), GFP_KERNEL);
  1564. if (!handler || !spec) {
  1565. err = -ENOMEM;
  1566. goto free;
  1567. }
  1568. INIT_LIST_HEAD(&handler->list);
  1569. for (spec_index = 0; spec_index < flow_attr->num_of_specs; spec_index++) {
  1570. err = parse_flow_attr(spec->match_criteria,
  1571. spec->match_value, ib_flow);
  1572. if (err < 0)
  1573. goto free;
  1574. ib_flow += ((union ib_flow_spec *)ib_flow)->size;
  1575. }
  1576. spec->match_criteria_enable = get_match_criteria_enable(spec->match_criteria);
  1577. action = dst ? MLX5_FLOW_CONTEXT_ACTION_FWD_DEST :
  1578. MLX5_FLOW_CONTEXT_ACTION_FWD_NEXT_PRIO;
  1579. handler->rule = mlx5_add_flow_rule(ft, spec,
  1580. action,
  1581. MLX5_FS_DEFAULT_FLOW_TAG,
  1582. dst);
  1583. if (IS_ERR(handler->rule)) {
  1584. err = PTR_ERR(handler->rule);
  1585. goto free;
  1586. }
  1587. ft_prio->refcount++;
  1588. handler->prio = ft_prio;
  1589. ft_prio->flow_table = ft;
  1590. free:
  1591. if (err)
  1592. kfree(handler);
  1593. kvfree(spec);
  1594. return err ? ERR_PTR(err) : handler;
  1595. }
  1596. static struct mlx5_ib_flow_handler *create_dont_trap_rule(struct mlx5_ib_dev *dev,
  1597. struct mlx5_ib_flow_prio *ft_prio,
  1598. struct ib_flow_attr *flow_attr,
  1599. struct mlx5_flow_destination *dst)
  1600. {
  1601. struct mlx5_ib_flow_handler *handler_dst = NULL;
  1602. struct mlx5_ib_flow_handler *handler = NULL;
  1603. handler = create_flow_rule(dev, ft_prio, flow_attr, NULL);
  1604. if (!IS_ERR(handler)) {
  1605. handler_dst = create_flow_rule(dev, ft_prio,
  1606. flow_attr, dst);
  1607. if (IS_ERR(handler_dst)) {
  1608. mlx5_del_flow_rule(handler->rule);
  1609. ft_prio->refcount--;
  1610. kfree(handler);
  1611. handler = handler_dst;
  1612. } else {
  1613. list_add(&handler_dst->list, &handler->list);
  1614. }
  1615. }
  1616. return handler;
  1617. }
  1618. enum {
  1619. LEFTOVERS_MC,
  1620. LEFTOVERS_UC,
  1621. };
  1622. static struct mlx5_ib_flow_handler *create_leftovers_rule(struct mlx5_ib_dev *dev,
  1623. struct mlx5_ib_flow_prio *ft_prio,
  1624. struct ib_flow_attr *flow_attr,
  1625. struct mlx5_flow_destination *dst)
  1626. {
  1627. struct mlx5_ib_flow_handler *handler_ucast = NULL;
  1628. struct mlx5_ib_flow_handler *handler = NULL;
  1629. static struct {
  1630. struct ib_flow_attr flow_attr;
  1631. struct ib_flow_spec_eth eth_flow;
  1632. } leftovers_specs[] = {
  1633. [LEFTOVERS_MC] = {
  1634. .flow_attr = {
  1635. .num_of_specs = 1,
  1636. .size = sizeof(leftovers_specs[0])
  1637. },
  1638. .eth_flow = {
  1639. .type = IB_FLOW_SPEC_ETH,
  1640. .size = sizeof(struct ib_flow_spec_eth),
  1641. .mask = {.dst_mac = {0x1} },
  1642. .val = {.dst_mac = {0x1} }
  1643. }
  1644. },
  1645. [LEFTOVERS_UC] = {
  1646. .flow_attr = {
  1647. .num_of_specs = 1,
  1648. .size = sizeof(leftovers_specs[0])
  1649. },
  1650. .eth_flow = {
  1651. .type = IB_FLOW_SPEC_ETH,
  1652. .size = sizeof(struct ib_flow_spec_eth),
  1653. .mask = {.dst_mac = {0x1} },
  1654. .val = {.dst_mac = {} }
  1655. }
  1656. }
  1657. };
  1658. handler = create_flow_rule(dev, ft_prio,
  1659. &leftovers_specs[LEFTOVERS_MC].flow_attr,
  1660. dst);
  1661. if (!IS_ERR(handler) &&
  1662. flow_attr->type == IB_FLOW_ATTR_ALL_DEFAULT) {
  1663. handler_ucast = create_flow_rule(dev, ft_prio,
  1664. &leftovers_specs[LEFTOVERS_UC].flow_attr,
  1665. dst);
  1666. if (IS_ERR(handler_ucast)) {
  1667. mlx5_del_flow_rule(handler->rule);
  1668. ft_prio->refcount--;
  1669. kfree(handler);
  1670. handler = handler_ucast;
  1671. } else {
  1672. list_add(&handler_ucast->list, &handler->list);
  1673. }
  1674. }
  1675. return handler;
  1676. }
  1677. static struct mlx5_ib_flow_handler *create_sniffer_rule(struct mlx5_ib_dev *dev,
  1678. struct mlx5_ib_flow_prio *ft_rx,
  1679. struct mlx5_ib_flow_prio *ft_tx,
  1680. struct mlx5_flow_destination *dst)
  1681. {
  1682. struct mlx5_ib_flow_handler *handler_rx;
  1683. struct mlx5_ib_flow_handler *handler_tx;
  1684. int err;
  1685. static const struct ib_flow_attr flow_attr = {
  1686. .num_of_specs = 0,
  1687. .size = sizeof(flow_attr)
  1688. };
  1689. handler_rx = create_flow_rule(dev, ft_rx, &flow_attr, dst);
  1690. if (IS_ERR(handler_rx)) {
  1691. err = PTR_ERR(handler_rx);
  1692. goto err;
  1693. }
  1694. handler_tx = create_flow_rule(dev, ft_tx, &flow_attr, dst);
  1695. if (IS_ERR(handler_tx)) {
  1696. err = PTR_ERR(handler_tx);
  1697. goto err_tx;
  1698. }
  1699. list_add(&handler_tx->list, &handler_rx->list);
  1700. return handler_rx;
  1701. err_tx:
  1702. mlx5_del_flow_rule(handler_rx->rule);
  1703. ft_rx->refcount--;
  1704. kfree(handler_rx);
  1705. err:
  1706. return ERR_PTR(err);
  1707. }
  1708. static struct ib_flow *mlx5_ib_create_flow(struct ib_qp *qp,
  1709. struct ib_flow_attr *flow_attr,
  1710. int domain)
  1711. {
  1712. struct mlx5_ib_dev *dev = to_mdev(qp->device);
  1713. struct mlx5_ib_flow_handler *handler = NULL;
  1714. struct mlx5_flow_destination *dst = NULL;
  1715. struct mlx5_ib_flow_prio *ft_prio_tx = NULL;
  1716. struct mlx5_ib_flow_prio *ft_prio;
  1717. int err;
  1718. if (flow_attr->priority > MLX5_IB_FLOW_LAST_PRIO)
  1719. return ERR_PTR(-ENOSPC);
  1720. if (domain != IB_FLOW_DOMAIN_USER ||
  1721. flow_attr->port > MLX5_CAP_GEN(dev->mdev, num_ports) ||
  1722. (flow_attr->flags & ~IB_FLOW_ATTR_FLAGS_DONT_TRAP))
  1723. return ERR_PTR(-EINVAL);
  1724. dst = kzalloc(sizeof(*dst), GFP_KERNEL);
  1725. if (!dst)
  1726. return ERR_PTR(-ENOMEM);
  1727. mutex_lock(&dev->flow_db.lock);
  1728. ft_prio = get_flow_table(dev, flow_attr, MLX5_IB_FT_RX);
  1729. if (IS_ERR(ft_prio)) {
  1730. err = PTR_ERR(ft_prio);
  1731. goto unlock;
  1732. }
  1733. if (flow_attr->type == IB_FLOW_ATTR_SNIFFER) {
  1734. ft_prio_tx = get_flow_table(dev, flow_attr, MLX5_IB_FT_TX);
  1735. if (IS_ERR(ft_prio_tx)) {
  1736. err = PTR_ERR(ft_prio_tx);
  1737. ft_prio_tx = NULL;
  1738. goto destroy_ft;
  1739. }
  1740. }
  1741. dst->type = MLX5_FLOW_DESTINATION_TYPE_TIR;
  1742. dst->tir_num = to_mqp(qp)->raw_packet_qp.rq.tirn;
  1743. if (flow_attr->type == IB_FLOW_ATTR_NORMAL) {
  1744. if (flow_attr->flags & IB_FLOW_ATTR_FLAGS_DONT_TRAP) {
  1745. handler = create_dont_trap_rule(dev, ft_prio,
  1746. flow_attr, dst);
  1747. } else {
  1748. handler = create_flow_rule(dev, ft_prio, flow_attr,
  1749. dst);
  1750. }
  1751. } else if (flow_attr->type == IB_FLOW_ATTR_ALL_DEFAULT ||
  1752. flow_attr->type == IB_FLOW_ATTR_MC_DEFAULT) {
  1753. handler = create_leftovers_rule(dev, ft_prio, flow_attr,
  1754. dst);
  1755. } else if (flow_attr->type == IB_FLOW_ATTR_SNIFFER) {
  1756. handler = create_sniffer_rule(dev, ft_prio, ft_prio_tx, dst);
  1757. } else {
  1758. err = -EINVAL;
  1759. goto destroy_ft;
  1760. }
  1761. if (IS_ERR(handler)) {
  1762. err = PTR_ERR(handler);
  1763. handler = NULL;
  1764. goto destroy_ft;
  1765. }
  1766. mutex_unlock(&dev->flow_db.lock);
  1767. kfree(dst);
  1768. return &handler->ibflow;
  1769. destroy_ft:
  1770. put_flow_table(dev, ft_prio, false);
  1771. if (ft_prio_tx)
  1772. put_flow_table(dev, ft_prio_tx, false);
  1773. unlock:
  1774. mutex_unlock(&dev->flow_db.lock);
  1775. kfree(dst);
  1776. kfree(handler);
  1777. return ERR_PTR(err);
  1778. }
  1779. static int mlx5_ib_mcg_attach(struct ib_qp *ibqp, union ib_gid *gid, u16 lid)
  1780. {
  1781. struct mlx5_ib_dev *dev = to_mdev(ibqp->device);
  1782. int err;
  1783. err = mlx5_core_attach_mcg(dev->mdev, gid, ibqp->qp_num);
  1784. if (err)
  1785. mlx5_ib_warn(dev, "failed attaching QPN 0x%x, MGID %pI6\n",
  1786. ibqp->qp_num, gid->raw);
  1787. return err;
  1788. }
  1789. static int mlx5_ib_mcg_detach(struct ib_qp *ibqp, union ib_gid *gid, u16 lid)
  1790. {
  1791. struct mlx5_ib_dev *dev = to_mdev(ibqp->device);
  1792. int err;
  1793. err = mlx5_core_detach_mcg(dev->mdev, gid, ibqp->qp_num);
  1794. if (err)
  1795. mlx5_ib_warn(dev, "failed detaching QPN 0x%x, MGID %pI6\n",
  1796. ibqp->qp_num, gid->raw);
  1797. return err;
  1798. }
  1799. static int init_node_data(struct mlx5_ib_dev *dev)
  1800. {
  1801. int err;
  1802. err = mlx5_query_node_desc(dev, dev->ib_dev.node_desc);
  1803. if (err)
  1804. return err;
  1805. dev->mdev->rev_id = dev->mdev->pdev->revision;
  1806. return mlx5_query_node_guid(dev, &dev->ib_dev.node_guid);
  1807. }
  1808. static ssize_t show_fw_pages(struct device *device, struct device_attribute *attr,
  1809. char *buf)
  1810. {
  1811. struct mlx5_ib_dev *dev =
  1812. container_of(device, struct mlx5_ib_dev, ib_dev.dev);
  1813. return sprintf(buf, "%d\n", dev->mdev->priv.fw_pages);
  1814. }
  1815. static ssize_t show_reg_pages(struct device *device,
  1816. struct device_attribute *attr, char *buf)
  1817. {
  1818. struct mlx5_ib_dev *dev =
  1819. container_of(device, struct mlx5_ib_dev, ib_dev.dev);
  1820. return sprintf(buf, "%d\n", atomic_read(&dev->mdev->priv.reg_pages));
  1821. }
  1822. static ssize_t show_hca(struct device *device, struct device_attribute *attr,
  1823. char *buf)
  1824. {
  1825. struct mlx5_ib_dev *dev =
  1826. container_of(device, struct mlx5_ib_dev, ib_dev.dev);
  1827. return sprintf(buf, "MT%d\n", dev->mdev->pdev->device);
  1828. }
  1829. static ssize_t show_rev(struct device *device, struct device_attribute *attr,
  1830. char *buf)
  1831. {
  1832. struct mlx5_ib_dev *dev =
  1833. container_of(device, struct mlx5_ib_dev, ib_dev.dev);
  1834. return sprintf(buf, "%x\n", dev->mdev->rev_id);
  1835. }
  1836. static ssize_t show_board(struct device *device, struct device_attribute *attr,
  1837. char *buf)
  1838. {
  1839. struct mlx5_ib_dev *dev =
  1840. container_of(device, struct mlx5_ib_dev, ib_dev.dev);
  1841. return sprintf(buf, "%.*s\n", MLX5_BOARD_ID_LEN,
  1842. dev->mdev->board_id);
  1843. }
  1844. static DEVICE_ATTR(hw_rev, S_IRUGO, show_rev, NULL);
  1845. static DEVICE_ATTR(hca_type, S_IRUGO, show_hca, NULL);
  1846. static DEVICE_ATTR(board_id, S_IRUGO, show_board, NULL);
  1847. static DEVICE_ATTR(fw_pages, S_IRUGO, show_fw_pages, NULL);
  1848. static DEVICE_ATTR(reg_pages, S_IRUGO, show_reg_pages, NULL);
  1849. static struct device_attribute *mlx5_class_attributes[] = {
  1850. &dev_attr_hw_rev,
  1851. &dev_attr_hca_type,
  1852. &dev_attr_board_id,
  1853. &dev_attr_fw_pages,
  1854. &dev_attr_reg_pages,
  1855. };
  1856. static void pkey_change_handler(struct work_struct *work)
  1857. {
  1858. struct mlx5_ib_port_resources *ports =
  1859. container_of(work, struct mlx5_ib_port_resources,
  1860. pkey_change_work);
  1861. mutex_lock(&ports->devr->mutex);
  1862. mlx5_ib_gsi_pkey_change(ports->gsi);
  1863. mutex_unlock(&ports->devr->mutex);
  1864. }
  1865. static void mlx5_ib_handle_internal_error(struct mlx5_ib_dev *ibdev)
  1866. {
  1867. struct mlx5_ib_qp *mqp;
  1868. struct mlx5_ib_cq *send_mcq, *recv_mcq;
  1869. struct mlx5_core_cq *mcq;
  1870. struct list_head cq_armed_list;
  1871. unsigned long flags_qp;
  1872. unsigned long flags_cq;
  1873. unsigned long flags;
  1874. INIT_LIST_HEAD(&cq_armed_list);
  1875. /* Go over qp list reside on that ibdev, sync with create/destroy qp.*/
  1876. spin_lock_irqsave(&ibdev->reset_flow_resource_lock, flags);
  1877. list_for_each_entry(mqp, &ibdev->qp_list, qps_list) {
  1878. spin_lock_irqsave(&mqp->sq.lock, flags_qp);
  1879. if (mqp->sq.tail != mqp->sq.head) {
  1880. send_mcq = to_mcq(mqp->ibqp.send_cq);
  1881. spin_lock_irqsave(&send_mcq->lock, flags_cq);
  1882. if (send_mcq->mcq.comp &&
  1883. mqp->ibqp.send_cq->comp_handler) {
  1884. if (!send_mcq->mcq.reset_notify_added) {
  1885. send_mcq->mcq.reset_notify_added = 1;
  1886. list_add_tail(&send_mcq->mcq.reset_notify,
  1887. &cq_armed_list);
  1888. }
  1889. }
  1890. spin_unlock_irqrestore(&send_mcq->lock, flags_cq);
  1891. }
  1892. spin_unlock_irqrestore(&mqp->sq.lock, flags_qp);
  1893. spin_lock_irqsave(&mqp->rq.lock, flags_qp);
  1894. /* no handling is needed for SRQ */
  1895. if (!mqp->ibqp.srq) {
  1896. if (mqp->rq.tail != mqp->rq.head) {
  1897. recv_mcq = to_mcq(mqp->ibqp.recv_cq);
  1898. spin_lock_irqsave(&recv_mcq->lock, flags_cq);
  1899. if (recv_mcq->mcq.comp &&
  1900. mqp->ibqp.recv_cq->comp_handler) {
  1901. if (!recv_mcq->mcq.reset_notify_added) {
  1902. recv_mcq->mcq.reset_notify_added = 1;
  1903. list_add_tail(&recv_mcq->mcq.reset_notify,
  1904. &cq_armed_list);
  1905. }
  1906. }
  1907. spin_unlock_irqrestore(&recv_mcq->lock,
  1908. flags_cq);
  1909. }
  1910. }
  1911. spin_unlock_irqrestore(&mqp->rq.lock, flags_qp);
  1912. }
  1913. /*At that point all inflight post send were put to be executed as of we
  1914. * lock/unlock above locks Now need to arm all involved CQs.
  1915. */
  1916. list_for_each_entry(mcq, &cq_armed_list, reset_notify) {
  1917. mcq->comp(mcq);
  1918. }
  1919. spin_unlock_irqrestore(&ibdev->reset_flow_resource_lock, flags);
  1920. }
  1921. static void mlx5_ib_event(struct mlx5_core_dev *dev, void *context,
  1922. enum mlx5_dev_event event, unsigned long param)
  1923. {
  1924. struct mlx5_ib_dev *ibdev = (struct mlx5_ib_dev *)context;
  1925. struct ib_event ibev;
  1926. u8 port = 0;
  1927. switch (event) {
  1928. case MLX5_DEV_EVENT_SYS_ERROR:
  1929. ibdev->ib_active = false;
  1930. ibev.event = IB_EVENT_DEVICE_FATAL;
  1931. mlx5_ib_handle_internal_error(ibdev);
  1932. break;
  1933. case MLX5_DEV_EVENT_PORT_UP:
  1934. case MLX5_DEV_EVENT_PORT_DOWN:
  1935. case MLX5_DEV_EVENT_PORT_INITIALIZED:
  1936. port = (u8)param;
  1937. /* In RoCE, port up/down events are handled in
  1938. * mlx5_netdev_event().
  1939. */
  1940. if (mlx5_ib_port_link_layer(&ibdev->ib_dev, port) ==
  1941. IB_LINK_LAYER_ETHERNET)
  1942. return;
  1943. ibev.event = (event == MLX5_DEV_EVENT_PORT_UP) ?
  1944. IB_EVENT_PORT_ACTIVE : IB_EVENT_PORT_ERR;
  1945. break;
  1946. case MLX5_DEV_EVENT_LID_CHANGE:
  1947. ibev.event = IB_EVENT_LID_CHANGE;
  1948. port = (u8)param;
  1949. break;
  1950. case MLX5_DEV_EVENT_PKEY_CHANGE:
  1951. ibev.event = IB_EVENT_PKEY_CHANGE;
  1952. port = (u8)param;
  1953. schedule_work(&ibdev->devr.ports[port - 1].pkey_change_work);
  1954. break;
  1955. case MLX5_DEV_EVENT_GUID_CHANGE:
  1956. ibev.event = IB_EVENT_GID_CHANGE;
  1957. port = (u8)param;
  1958. break;
  1959. case MLX5_DEV_EVENT_CLIENT_REREG:
  1960. ibev.event = IB_EVENT_CLIENT_REREGISTER;
  1961. port = (u8)param;
  1962. break;
  1963. }
  1964. ibev.device = &ibdev->ib_dev;
  1965. ibev.element.port_num = port;
  1966. if (port < 1 || port > ibdev->num_ports) {
  1967. mlx5_ib_warn(ibdev, "warning: event on port %d\n", port);
  1968. return;
  1969. }
  1970. if (ibdev->ib_active)
  1971. ib_dispatch_event(&ibev);
  1972. }
  1973. static void get_ext_port_caps(struct mlx5_ib_dev *dev)
  1974. {
  1975. int port;
  1976. for (port = 1; port <= MLX5_CAP_GEN(dev->mdev, num_ports); port++)
  1977. mlx5_query_ext_port_caps(dev, port);
  1978. }
  1979. static int get_port_caps(struct mlx5_ib_dev *dev)
  1980. {
  1981. struct ib_device_attr *dprops = NULL;
  1982. struct ib_port_attr *pprops = NULL;
  1983. int err = -ENOMEM;
  1984. int port;
  1985. struct ib_udata uhw = {.inlen = 0, .outlen = 0};
  1986. pprops = kmalloc(sizeof(*pprops), GFP_KERNEL);
  1987. if (!pprops)
  1988. goto out;
  1989. dprops = kmalloc(sizeof(*dprops), GFP_KERNEL);
  1990. if (!dprops)
  1991. goto out;
  1992. err = mlx5_ib_query_device(&dev->ib_dev, dprops, &uhw);
  1993. if (err) {
  1994. mlx5_ib_warn(dev, "query_device failed %d\n", err);
  1995. goto out;
  1996. }
  1997. for (port = 1; port <= MLX5_CAP_GEN(dev->mdev, num_ports); port++) {
  1998. err = mlx5_ib_query_port(&dev->ib_dev, port, pprops);
  1999. if (err) {
  2000. mlx5_ib_warn(dev, "query_port %d failed %d\n",
  2001. port, err);
  2002. break;
  2003. }
  2004. dev->mdev->port_caps[port - 1].pkey_table_len =
  2005. dprops->max_pkeys;
  2006. dev->mdev->port_caps[port - 1].gid_table_len =
  2007. pprops->gid_tbl_len;
  2008. mlx5_ib_dbg(dev, "pkey_table_len %d, gid_table_len %d\n",
  2009. dprops->max_pkeys, pprops->gid_tbl_len);
  2010. }
  2011. out:
  2012. kfree(pprops);
  2013. kfree(dprops);
  2014. return err;
  2015. }
  2016. static void destroy_umrc_res(struct mlx5_ib_dev *dev)
  2017. {
  2018. int err;
  2019. err = mlx5_mr_cache_cleanup(dev);
  2020. if (err)
  2021. mlx5_ib_warn(dev, "mr cache cleanup failed\n");
  2022. mlx5_ib_destroy_qp(dev->umrc.qp);
  2023. ib_free_cq(dev->umrc.cq);
  2024. ib_dealloc_pd(dev->umrc.pd);
  2025. }
  2026. enum {
  2027. MAX_UMR_WR = 128,
  2028. };
  2029. static int create_umr_res(struct mlx5_ib_dev *dev)
  2030. {
  2031. struct ib_qp_init_attr *init_attr = NULL;
  2032. struct ib_qp_attr *attr = NULL;
  2033. struct ib_pd *pd;
  2034. struct ib_cq *cq;
  2035. struct ib_qp *qp;
  2036. int ret;
  2037. attr = kzalloc(sizeof(*attr), GFP_KERNEL);
  2038. init_attr = kzalloc(sizeof(*init_attr), GFP_KERNEL);
  2039. if (!attr || !init_attr) {
  2040. ret = -ENOMEM;
  2041. goto error_0;
  2042. }
  2043. pd = ib_alloc_pd(&dev->ib_dev, 0);
  2044. if (IS_ERR(pd)) {
  2045. mlx5_ib_dbg(dev, "Couldn't create PD for sync UMR QP\n");
  2046. ret = PTR_ERR(pd);
  2047. goto error_0;
  2048. }
  2049. cq = ib_alloc_cq(&dev->ib_dev, NULL, 128, 0, IB_POLL_SOFTIRQ);
  2050. if (IS_ERR(cq)) {
  2051. mlx5_ib_dbg(dev, "Couldn't create CQ for sync UMR QP\n");
  2052. ret = PTR_ERR(cq);
  2053. goto error_2;
  2054. }
  2055. init_attr->send_cq = cq;
  2056. init_attr->recv_cq = cq;
  2057. init_attr->sq_sig_type = IB_SIGNAL_ALL_WR;
  2058. init_attr->cap.max_send_wr = MAX_UMR_WR;
  2059. init_attr->cap.max_send_sge = 1;
  2060. init_attr->qp_type = MLX5_IB_QPT_REG_UMR;
  2061. init_attr->port_num = 1;
  2062. qp = mlx5_ib_create_qp(pd, init_attr, NULL);
  2063. if (IS_ERR(qp)) {
  2064. mlx5_ib_dbg(dev, "Couldn't create sync UMR QP\n");
  2065. ret = PTR_ERR(qp);
  2066. goto error_3;
  2067. }
  2068. qp->device = &dev->ib_dev;
  2069. qp->real_qp = qp;
  2070. qp->uobject = NULL;
  2071. qp->qp_type = MLX5_IB_QPT_REG_UMR;
  2072. attr->qp_state = IB_QPS_INIT;
  2073. attr->port_num = 1;
  2074. ret = mlx5_ib_modify_qp(qp, attr, IB_QP_STATE | IB_QP_PKEY_INDEX |
  2075. IB_QP_PORT, NULL);
  2076. if (ret) {
  2077. mlx5_ib_dbg(dev, "Couldn't modify UMR QP\n");
  2078. goto error_4;
  2079. }
  2080. memset(attr, 0, sizeof(*attr));
  2081. attr->qp_state = IB_QPS_RTR;
  2082. attr->path_mtu = IB_MTU_256;
  2083. ret = mlx5_ib_modify_qp(qp, attr, IB_QP_STATE, NULL);
  2084. if (ret) {
  2085. mlx5_ib_dbg(dev, "Couldn't modify umr QP to rtr\n");
  2086. goto error_4;
  2087. }
  2088. memset(attr, 0, sizeof(*attr));
  2089. attr->qp_state = IB_QPS_RTS;
  2090. ret = mlx5_ib_modify_qp(qp, attr, IB_QP_STATE, NULL);
  2091. if (ret) {
  2092. mlx5_ib_dbg(dev, "Couldn't modify umr QP to rts\n");
  2093. goto error_4;
  2094. }
  2095. dev->umrc.qp = qp;
  2096. dev->umrc.cq = cq;
  2097. dev->umrc.pd = pd;
  2098. sema_init(&dev->umrc.sem, MAX_UMR_WR);
  2099. ret = mlx5_mr_cache_init(dev);
  2100. if (ret) {
  2101. mlx5_ib_warn(dev, "mr cache init failed %d\n", ret);
  2102. goto error_4;
  2103. }
  2104. kfree(attr);
  2105. kfree(init_attr);
  2106. return 0;
  2107. error_4:
  2108. mlx5_ib_destroy_qp(qp);
  2109. error_3:
  2110. ib_free_cq(cq);
  2111. error_2:
  2112. ib_dealloc_pd(pd);
  2113. error_0:
  2114. kfree(attr);
  2115. kfree(init_attr);
  2116. return ret;
  2117. }
  2118. static int create_dev_resources(struct mlx5_ib_resources *devr)
  2119. {
  2120. struct ib_srq_init_attr attr;
  2121. struct mlx5_ib_dev *dev;
  2122. struct ib_cq_init_attr cq_attr = {.cqe = 1};
  2123. int port;
  2124. int ret = 0;
  2125. dev = container_of(devr, struct mlx5_ib_dev, devr);
  2126. mutex_init(&devr->mutex);
  2127. devr->p0 = mlx5_ib_alloc_pd(&dev->ib_dev, NULL, NULL);
  2128. if (IS_ERR(devr->p0)) {
  2129. ret = PTR_ERR(devr->p0);
  2130. goto error0;
  2131. }
  2132. devr->p0->device = &dev->ib_dev;
  2133. devr->p0->uobject = NULL;
  2134. atomic_set(&devr->p0->usecnt, 0);
  2135. devr->c0 = mlx5_ib_create_cq(&dev->ib_dev, &cq_attr, NULL, NULL);
  2136. if (IS_ERR(devr->c0)) {
  2137. ret = PTR_ERR(devr->c0);
  2138. goto error1;
  2139. }
  2140. devr->c0->device = &dev->ib_dev;
  2141. devr->c0->uobject = NULL;
  2142. devr->c0->comp_handler = NULL;
  2143. devr->c0->event_handler = NULL;
  2144. devr->c0->cq_context = NULL;
  2145. atomic_set(&devr->c0->usecnt, 0);
  2146. devr->x0 = mlx5_ib_alloc_xrcd(&dev->ib_dev, NULL, NULL);
  2147. if (IS_ERR(devr->x0)) {
  2148. ret = PTR_ERR(devr->x0);
  2149. goto error2;
  2150. }
  2151. devr->x0->device = &dev->ib_dev;
  2152. devr->x0->inode = NULL;
  2153. atomic_set(&devr->x0->usecnt, 0);
  2154. mutex_init(&devr->x0->tgt_qp_mutex);
  2155. INIT_LIST_HEAD(&devr->x0->tgt_qp_list);
  2156. devr->x1 = mlx5_ib_alloc_xrcd(&dev->ib_dev, NULL, NULL);
  2157. if (IS_ERR(devr->x1)) {
  2158. ret = PTR_ERR(devr->x1);
  2159. goto error3;
  2160. }
  2161. devr->x1->device = &dev->ib_dev;
  2162. devr->x1->inode = NULL;
  2163. atomic_set(&devr->x1->usecnt, 0);
  2164. mutex_init(&devr->x1->tgt_qp_mutex);
  2165. INIT_LIST_HEAD(&devr->x1->tgt_qp_list);
  2166. memset(&attr, 0, sizeof(attr));
  2167. attr.attr.max_sge = 1;
  2168. attr.attr.max_wr = 1;
  2169. attr.srq_type = IB_SRQT_XRC;
  2170. attr.ext.xrc.cq = devr->c0;
  2171. attr.ext.xrc.xrcd = devr->x0;
  2172. devr->s0 = mlx5_ib_create_srq(devr->p0, &attr, NULL);
  2173. if (IS_ERR(devr->s0)) {
  2174. ret = PTR_ERR(devr->s0);
  2175. goto error4;
  2176. }
  2177. devr->s0->device = &dev->ib_dev;
  2178. devr->s0->pd = devr->p0;
  2179. devr->s0->uobject = NULL;
  2180. devr->s0->event_handler = NULL;
  2181. devr->s0->srq_context = NULL;
  2182. devr->s0->srq_type = IB_SRQT_XRC;
  2183. devr->s0->ext.xrc.xrcd = devr->x0;
  2184. devr->s0->ext.xrc.cq = devr->c0;
  2185. atomic_inc(&devr->s0->ext.xrc.xrcd->usecnt);
  2186. atomic_inc(&devr->s0->ext.xrc.cq->usecnt);
  2187. atomic_inc(&devr->p0->usecnt);
  2188. atomic_set(&devr->s0->usecnt, 0);
  2189. memset(&attr, 0, sizeof(attr));
  2190. attr.attr.max_sge = 1;
  2191. attr.attr.max_wr = 1;
  2192. attr.srq_type = IB_SRQT_BASIC;
  2193. devr->s1 = mlx5_ib_create_srq(devr->p0, &attr, NULL);
  2194. if (IS_ERR(devr->s1)) {
  2195. ret = PTR_ERR(devr->s1);
  2196. goto error5;
  2197. }
  2198. devr->s1->device = &dev->ib_dev;
  2199. devr->s1->pd = devr->p0;
  2200. devr->s1->uobject = NULL;
  2201. devr->s1->event_handler = NULL;
  2202. devr->s1->srq_context = NULL;
  2203. devr->s1->srq_type = IB_SRQT_BASIC;
  2204. devr->s1->ext.xrc.cq = devr->c0;
  2205. atomic_inc(&devr->p0->usecnt);
  2206. atomic_set(&devr->s0->usecnt, 0);
  2207. for (port = 0; port < ARRAY_SIZE(devr->ports); ++port) {
  2208. INIT_WORK(&devr->ports[port].pkey_change_work,
  2209. pkey_change_handler);
  2210. devr->ports[port].devr = devr;
  2211. }
  2212. return 0;
  2213. error5:
  2214. mlx5_ib_destroy_srq(devr->s0);
  2215. error4:
  2216. mlx5_ib_dealloc_xrcd(devr->x1);
  2217. error3:
  2218. mlx5_ib_dealloc_xrcd(devr->x0);
  2219. error2:
  2220. mlx5_ib_destroy_cq(devr->c0);
  2221. error1:
  2222. mlx5_ib_dealloc_pd(devr->p0);
  2223. error0:
  2224. return ret;
  2225. }
  2226. static void destroy_dev_resources(struct mlx5_ib_resources *devr)
  2227. {
  2228. struct mlx5_ib_dev *dev =
  2229. container_of(devr, struct mlx5_ib_dev, devr);
  2230. int port;
  2231. mlx5_ib_destroy_srq(devr->s1);
  2232. mlx5_ib_destroy_srq(devr->s0);
  2233. mlx5_ib_dealloc_xrcd(devr->x0);
  2234. mlx5_ib_dealloc_xrcd(devr->x1);
  2235. mlx5_ib_destroy_cq(devr->c0);
  2236. mlx5_ib_dealloc_pd(devr->p0);
  2237. /* Make sure no change P_Key work items are still executing */
  2238. for (port = 0; port < dev->num_ports; ++port)
  2239. cancel_work_sync(&devr->ports[port].pkey_change_work);
  2240. }
  2241. static u32 get_core_cap_flags(struct ib_device *ibdev)
  2242. {
  2243. struct mlx5_ib_dev *dev = to_mdev(ibdev);
  2244. enum rdma_link_layer ll = mlx5_ib_port_link_layer(ibdev, 1);
  2245. u8 l3_type_cap = MLX5_CAP_ROCE(dev->mdev, l3_type);
  2246. u8 roce_version_cap = MLX5_CAP_ROCE(dev->mdev, roce_version);
  2247. u32 ret = 0;
  2248. if (ll == IB_LINK_LAYER_INFINIBAND)
  2249. return RDMA_CORE_PORT_IBA_IB;
  2250. if (!(l3_type_cap & MLX5_ROCE_L3_TYPE_IPV4_CAP))
  2251. return 0;
  2252. if (!(l3_type_cap & MLX5_ROCE_L3_TYPE_IPV6_CAP))
  2253. return 0;
  2254. if (roce_version_cap & MLX5_ROCE_VERSION_1_CAP)
  2255. ret |= RDMA_CORE_PORT_IBA_ROCE;
  2256. if (roce_version_cap & MLX5_ROCE_VERSION_2_CAP)
  2257. ret |= RDMA_CORE_PORT_IBA_ROCE_UDP_ENCAP;
  2258. return ret;
  2259. }
  2260. static int mlx5_port_immutable(struct ib_device *ibdev, u8 port_num,
  2261. struct ib_port_immutable *immutable)
  2262. {
  2263. struct ib_port_attr attr;
  2264. int err;
  2265. err = mlx5_ib_query_port(ibdev, port_num, &attr);
  2266. if (err)
  2267. return err;
  2268. immutable->pkey_tbl_len = attr.pkey_tbl_len;
  2269. immutable->gid_tbl_len = attr.gid_tbl_len;
  2270. immutable->core_cap_flags = get_core_cap_flags(ibdev);
  2271. immutable->max_mad_size = IB_MGMT_MAD_SIZE;
  2272. return 0;
  2273. }
  2274. static void get_dev_fw_str(struct ib_device *ibdev, char *str,
  2275. size_t str_len)
  2276. {
  2277. struct mlx5_ib_dev *dev =
  2278. container_of(ibdev, struct mlx5_ib_dev, ib_dev);
  2279. snprintf(str, str_len, "%d.%d.%04d", fw_rev_maj(dev->mdev),
  2280. fw_rev_min(dev->mdev), fw_rev_sub(dev->mdev));
  2281. }
  2282. static int mlx5_roce_lag_init(struct mlx5_ib_dev *dev)
  2283. {
  2284. struct mlx5_core_dev *mdev = dev->mdev;
  2285. struct mlx5_flow_namespace *ns = mlx5_get_flow_namespace(mdev,
  2286. MLX5_FLOW_NAMESPACE_LAG);
  2287. struct mlx5_flow_table *ft;
  2288. int err;
  2289. if (!ns || !mlx5_lag_is_active(mdev))
  2290. return 0;
  2291. err = mlx5_cmd_create_vport_lag(mdev);
  2292. if (err)
  2293. return err;
  2294. ft = mlx5_create_lag_demux_flow_table(ns, 0, 0);
  2295. if (IS_ERR(ft)) {
  2296. err = PTR_ERR(ft);
  2297. goto err_destroy_vport_lag;
  2298. }
  2299. dev->flow_db.lag_demux_ft = ft;
  2300. return 0;
  2301. err_destroy_vport_lag:
  2302. mlx5_cmd_destroy_vport_lag(mdev);
  2303. return err;
  2304. }
  2305. static void mlx5_roce_lag_cleanup(struct mlx5_ib_dev *dev)
  2306. {
  2307. struct mlx5_core_dev *mdev = dev->mdev;
  2308. if (dev->flow_db.lag_demux_ft) {
  2309. mlx5_destroy_flow_table(dev->flow_db.lag_demux_ft);
  2310. dev->flow_db.lag_demux_ft = NULL;
  2311. mlx5_cmd_destroy_vport_lag(mdev);
  2312. }
  2313. }
  2314. static void mlx5_remove_roce_notifier(struct mlx5_ib_dev *dev)
  2315. {
  2316. if (dev->roce.nb.notifier_call) {
  2317. unregister_netdevice_notifier(&dev->roce.nb);
  2318. dev->roce.nb.notifier_call = NULL;
  2319. }
  2320. }
  2321. static int mlx5_enable_roce(struct mlx5_ib_dev *dev)
  2322. {
  2323. int err;
  2324. dev->roce.nb.notifier_call = mlx5_netdev_event;
  2325. err = register_netdevice_notifier(&dev->roce.nb);
  2326. if (err) {
  2327. dev->roce.nb.notifier_call = NULL;
  2328. return err;
  2329. }
  2330. err = mlx5_nic_vport_enable_roce(dev->mdev);
  2331. if (err)
  2332. goto err_unregister_netdevice_notifier;
  2333. err = mlx5_roce_lag_init(dev);
  2334. if (err)
  2335. goto err_disable_roce;
  2336. return 0;
  2337. err_disable_roce:
  2338. mlx5_nic_vport_disable_roce(dev->mdev);
  2339. err_unregister_netdevice_notifier:
  2340. mlx5_remove_roce_notifier(dev);
  2341. return err;
  2342. }
  2343. static void mlx5_disable_roce(struct mlx5_ib_dev *dev)
  2344. {
  2345. mlx5_roce_lag_cleanup(dev);
  2346. mlx5_nic_vport_disable_roce(dev->mdev);
  2347. }
  2348. static void mlx5_ib_dealloc_q_counters(struct mlx5_ib_dev *dev)
  2349. {
  2350. unsigned int i;
  2351. for (i = 0; i < dev->num_ports; i++)
  2352. mlx5_core_dealloc_q_counter(dev->mdev,
  2353. dev->port[i].q_cnt_id);
  2354. }
  2355. static int mlx5_ib_alloc_q_counters(struct mlx5_ib_dev *dev)
  2356. {
  2357. int i;
  2358. int ret;
  2359. for (i = 0; i < dev->num_ports; i++) {
  2360. ret = mlx5_core_alloc_q_counter(dev->mdev,
  2361. &dev->port[i].q_cnt_id);
  2362. if (ret) {
  2363. mlx5_ib_warn(dev,
  2364. "couldn't allocate queue counter for port %d, err %d\n",
  2365. i + 1, ret);
  2366. goto dealloc_counters;
  2367. }
  2368. }
  2369. return 0;
  2370. dealloc_counters:
  2371. while (--i >= 0)
  2372. mlx5_core_dealloc_q_counter(dev->mdev,
  2373. dev->port[i].q_cnt_id);
  2374. return ret;
  2375. }
  2376. static const char * const names[] = {
  2377. "rx_write_requests",
  2378. "rx_read_requests",
  2379. "rx_atomic_requests",
  2380. "out_of_buffer",
  2381. "out_of_sequence",
  2382. "duplicate_request",
  2383. "rnr_nak_retry_err",
  2384. "packet_seq_err",
  2385. "implied_nak_seq_err",
  2386. "local_ack_timeout_err",
  2387. };
  2388. static const size_t stats_offsets[] = {
  2389. MLX5_BYTE_OFF(query_q_counter_out, rx_write_requests),
  2390. MLX5_BYTE_OFF(query_q_counter_out, rx_read_requests),
  2391. MLX5_BYTE_OFF(query_q_counter_out, rx_atomic_requests),
  2392. MLX5_BYTE_OFF(query_q_counter_out, out_of_buffer),
  2393. MLX5_BYTE_OFF(query_q_counter_out, out_of_sequence),
  2394. MLX5_BYTE_OFF(query_q_counter_out, duplicate_request),
  2395. MLX5_BYTE_OFF(query_q_counter_out, rnr_nak_retry_err),
  2396. MLX5_BYTE_OFF(query_q_counter_out, packet_seq_err),
  2397. MLX5_BYTE_OFF(query_q_counter_out, implied_nak_seq_err),
  2398. MLX5_BYTE_OFF(query_q_counter_out, local_ack_timeout_err),
  2399. };
  2400. static struct rdma_hw_stats *mlx5_ib_alloc_hw_stats(struct ib_device *ibdev,
  2401. u8 port_num)
  2402. {
  2403. BUILD_BUG_ON(ARRAY_SIZE(names) != ARRAY_SIZE(stats_offsets));
  2404. /* We support only per port stats */
  2405. if (port_num == 0)
  2406. return NULL;
  2407. return rdma_alloc_hw_stats_struct(names, ARRAY_SIZE(names),
  2408. RDMA_HW_STATS_DEFAULT_LIFESPAN);
  2409. }
  2410. static int mlx5_ib_get_hw_stats(struct ib_device *ibdev,
  2411. struct rdma_hw_stats *stats,
  2412. u8 port, int index)
  2413. {
  2414. struct mlx5_ib_dev *dev = to_mdev(ibdev);
  2415. int outlen = MLX5_ST_SZ_BYTES(query_q_counter_out);
  2416. void *out;
  2417. __be32 val;
  2418. int ret;
  2419. int i;
  2420. if (!port || !stats)
  2421. return -ENOSYS;
  2422. out = mlx5_vzalloc(outlen);
  2423. if (!out)
  2424. return -ENOMEM;
  2425. ret = mlx5_core_query_q_counter(dev->mdev,
  2426. dev->port[port - 1].q_cnt_id, 0,
  2427. out, outlen);
  2428. if (ret)
  2429. goto free;
  2430. for (i = 0; i < ARRAY_SIZE(names); i++) {
  2431. val = *(__be32 *)(out + stats_offsets[i]);
  2432. stats->value[i] = (u64)be32_to_cpu(val);
  2433. }
  2434. free:
  2435. kvfree(out);
  2436. return ARRAY_SIZE(names);
  2437. }
  2438. static void *mlx5_ib_add(struct mlx5_core_dev *mdev)
  2439. {
  2440. struct mlx5_ib_dev *dev;
  2441. enum rdma_link_layer ll;
  2442. int port_type_cap;
  2443. int err;
  2444. int i;
  2445. port_type_cap = MLX5_CAP_GEN(mdev, port_type);
  2446. ll = mlx5_port_type_cap_to_rdma_ll(port_type_cap);
  2447. if ((ll == IB_LINK_LAYER_ETHERNET) && !MLX5_CAP_GEN(mdev, roce))
  2448. return NULL;
  2449. printk_once(KERN_INFO "%s", mlx5_version);
  2450. dev = (struct mlx5_ib_dev *)ib_alloc_device(sizeof(*dev));
  2451. if (!dev)
  2452. return NULL;
  2453. dev->mdev = mdev;
  2454. dev->port = kcalloc(MLX5_CAP_GEN(mdev, num_ports), sizeof(*dev->port),
  2455. GFP_KERNEL);
  2456. if (!dev->port)
  2457. goto err_dealloc;
  2458. rwlock_init(&dev->roce.netdev_lock);
  2459. err = get_port_caps(dev);
  2460. if (err)
  2461. goto err_free_port;
  2462. if (mlx5_use_mad_ifc(dev))
  2463. get_ext_port_caps(dev);
  2464. MLX5_INIT_DOORBELL_LOCK(&dev->uar_lock);
  2465. strlcpy(dev->ib_dev.name, "mlx5_%d", IB_DEVICE_NAME_MAX);
  2466. dev->ib_dev.owner = THIS_MODULE;
  2467. dev->ib_dev.node_type = RDMA_NODE_IB_CA;
  2468. dev->ib_dev.local_dma_lkey = 0 /* not supported for now */;
  2469. dev->num_ports = MLX5_CAP_GEN(mdev, num_ports);
  2470. dev->ib_dev.phys_port_cnt = dev->num_ports;
  2471. dev->ib_dev.num_comp_vectors =
  2472. dev->mdev->priv.eq_table.num_comp_vectors;
  2473. dev->ib_dev.dma_device = &mdev->pdev->dev;
  2474. dev->ib_dev.uverbs_abi_ver = MLX5_IB_UVERBS_ABI_VERSION;
  2475. dev->ib_dev.uverbs_cmd_mask =
  2476. (1ull << IB_USER_VERBS_CMD_GET_CONTEXT) |
  2477. (1ull << IB_USER_VERBS_CMD_QUERY_DEVICE) |
  2478. (1ull << IB_USER_VERBS_CMD_QUERY_PORT) |
  2479. (1ull << IB_USER_VERBS_CMD_ALLOC_PD) |
  2480. (1ull << IB_USER_VERBS_CMD_DEALLOC_PD) |
  2481. (1ull << IB_USER_VERBS_CMD_REG_MR) |
  2482. (1ull << IB_USER_VERBS_CMD_REREG_MR) |
  2483. (1ull << IB_USER_VERBS_CMD_DEREG_MR) |
  2484. (1ull << IB_USER_VERBS_CMD_CREATE_COMP_CHANNEL) |
  2485. (1ull << IB_USER_VERBS_CMD_CREATE_CQ) |
  2486. (1ull << IB_USER_VERBS_CMD_RESIZE_CQ) |
  2487. (1ull << IB_USER_VERBS_CMD_DESTROY_CQ) |
  2488. (1ull << IB_USER_VERBS_CMD_CREATE_QP) |
  2489. (1ull << IB_USER_VERBS_CMD_MODIFY_QP) |
  2490. (1ull << IB_USER_VERBS_CMD_QUERY_QP) |
  2491. (1ull << IB_USER_VERBS_CMD_DESTROY_QP) |
  2492. (1ull << IB_USER_VERBS_CMD_ATTACH_MCAST) |
  2493. (1ull << IB_USER_VERBS_CMD_DETACH_MCAST) |
  2494. (1ull << IB_USER_VERBS_CMD_CREATE_SRQ) |
  2495. (1ull << IB_USER_VERBS_CMD_MODIFY_SRQ) |
  2496. (1ull << IB_USER_VERBS_CMD_QUERY_SRQ) |
  2497. (1ull << IB_USER_VERBS_CMD_DESTROY_SRQ) |
  2498. (1ull << IB_USER_VERBS_CMD_CREATE_XSRQ) |
  2499. (1ull << IB_USER_VERBS_CMD_OPEN_QP);
  2500. dev->ib_dev.uverbs_ex_cmd_mask =
  2501. (1ull << IB_USER_VERBS_EX_CMD_QUERY_DEVICE) |
  2502. (1ull << IB_USER_VERBS_EX_CMD_CREATE_CQ) |
  2503. (1ull << IB_USER_VERBS_EX_CMD_CREATE_QP);
  2504. dev->ib_dev.query_device = mlx5_ib_query_device;
  2505. dev->ib_dev.query_port = mlx5_ib_query_port;
  2506. dev->ib_dev.get_link_layer = mlx5_ib_port_link_layer;
  2507. if (ll == IB_LINK_LAYER_ETHERNET)
  2508. dev->ib_dev.get_netdev = mlx5_ib_get_netdev;
  2509. dev->ib_dev.query_gid = mlx5_ib_query_gid;
  2510. dev->ib_dev.add_gid = mlx5_ib_add_gid;
  2511. dev->ib_dev.del_gid = mlx5_ib_del_gid;
  2512. dev->ib_dev.query_pkey = mlx5_ib_query_pkey;
  2513. dev->ib_dev.modify_device = mlx5_ib_modify_device;
  2514. dev->ib_dev.modify_port = mlx5_ib_modify_port;
  2515. dev->ib_dev.alloc_ucontext = mlx5_ib_alloc_ucontext;
  2516. dev->ib_dev.dealloc_ucontext = mlx5_ib_dealloc_ucontext;
  2517. dev->ib_dev.mmap = mlx5_ib_mmap;
  2518. dev->ib_dev.alloc_pd = mlx5_ib_alloc_pd;
  2519. dev->ib_dev.dealloc_pd = mlx5_ib_dealloc_pd;
  2520. dev->ib_dev.create_ah = mlx5_ib_create_ah;
  2521. dev->ib_dev.query_ah = mlx5_ib_query_ah;
  2522. dev->ib_dev.destroy_ah = mlx5_ib_destroy_ah;
  2523. dev->ib_dev.create_srq = mlx5_ib_create_srq;
  2524. dev->ib_dev.modify_srq = mlx5_ib_modify_srq;
  2525. dev->ib_dev.query_srq = mlx5_ib_query_srq;
  2526. dev->ib_dev.destroy_srq = mlx5_ib_destroy_srq;
  2527. dev->ib_dev.post_srq_recv = mlx5_ib_post_srq_recv;
  2528. dev->ib_dev.create_qp = mlx5_ib_create_qp;
  2529. dev->ib_dev.modify_qp = mlx5_ib_modify_qp;
  2530. dev->ib_dev.query_qp = mlx5_ib_query_qp;
  2531. dev->ib_dev.destroy_qp = mlx5_ib_destroy_qp;
  2532. dev->ib_dev.post_send = mlx5_ib_post_send;
  2533. dev->ib_dev.post_recv = mlx5_ib_post_recv;
  2534. dev->ib_dev.create_cq = mlx5_ib_create_cq;
  2535. dev->ib_dev.modify_cq = mlx5_ib_modify_cq;
  2536. dev->ib_dev.resize_cq = mlx5_ib_resize_cq;
  2537. dev->ib_dev.destroy_cq = mlx5_ib_destroy_cq;
  2538. dev->ib_dev.poll_cq = mlx5_ib_poll_cq;
  2539. dev->ib_dev.req_notify_cq = mlx5_ib_arm_cq;
  2540. dev->ib_dev.get_dma_mr = mlx5_ib_get_dma_mr;
  2541. dev->ib_dev.reg_user_mr = mlx5_ib_reg_user_mr;
  2542. dev->ib_dev.rereg_user_mr = mlx5_ib_rereg_user_mr;
  2543. dev->ib_dev.dereg_mr = mlx5_ib_dereg_mr;
  2544. dev->ib_dev.attach_mcast = mlx5_ib_mcg_attach;
  2545. dev->ib_dev.detach_mcast = mlx5_ib_mcg_detach;
  2546. dev->ib_dev.process_mad = mlx5_ib_process_mad;
  2547. dev->ib_dev.alloc_mr = mlx5_ib_alloc_mr;
  2548. dev->ib_dev.map_mr_sg = mlx5_ib_map_mr_sg;
  2549. dev->ib_dev.check_mr_status = mlx5_ib_check_mr_status;
  2550. dev->ib_dev.get_port_immutable = mlx5_port_immutable;
  2551. dev->ib_dev.get_dev_fw_str = get_dev_fw_str;
  2552. if (mlx5_core_is_pf(mdev)) {
  2553. dev->ib_dev.get_vf_config = mlx5_ib_get_vf_config;
  2554. dev->ib_dev.set_vf_link_state = mlx5_ib_set_vf_link_state;
  2555. dev->ib_dev.get_vf_stats = mlx5_ib_get_vf_stats;
  2556. dev->ib_dev.set_vf_guid = mlx5_ib_set_vf_guid;
  2557. }
  2558. dev->ib_dev.disassociate_ucontext = mlx5_ib_disassociate_ucontext;
  2559. mlx5_ib_internal_fill_odp_caps(dev);
  2560. if (MLX5_CAP_GEN(mdev, imaicl)) {
  2561. dev->ib_dev.alloc_mw = mlx5_ib_alloc_mw;
  2562. dev->ib_dev.dealloc_mw = mlx5_ib_dealloc_mw;
  2563. dev->ib_dev.uverbs_cmd_mask |=
  2564. (1ull << IB_USER_VERBS_CMD_ALLOC_MW) |
  2565. (1ull << IB_USER_VERBS_CMD_DEALLOC_MW);
  2566. }
  2567. if (MLX5_CAP_GEN(dev->mdev, out_of_seq_cnt) &&
  2568. MLX5_CAP_GEN(dev->mdev, retransmission_q_counters)) {
  2569. dev->ib_dev.get_hw_stats = mlx5_ib_get_hw_stats;
  2570. dev->ib_dev.alloc_hw_stats = mlx5_ib_alloc_hw_stats;
  2571. }
  2572. if (MLX5_CAP_GEN(mdev, xrc)) {
  2573. dev->ib_dev.alloc_xrcd = mlx5_ib_alloc_xrcd;
  2574. dev->ib_dev.dealloc_xrcd = mlx5_ib_dealloc_xrcd;
  2575. dev->ib_dev.uverbs_cmd_mask |=
  2576. (1ull << IB_USER_VERBS_CMD_OPEN_XRCD) |
  2577. (1ull << IB_USER_VERBS_CMD_CLOSE_XRCD);
  2578. }
  2579. if (mlx5_ib_port_link_layer(&dev->ib_dev, 1) ==
  2580. IB_LINK_LAYER_ETHERNET) {
  2581. dev->ib_dev.create_flow = mlx5_ib_create_flow;
  2582. dev->ib_dev.destroy_flow = mlx5_ib_destroy_flow;
  2583. dev->ib_dev.create_wq = mlx5_ib_create_wq;
  2584. dev->ib_dev.modify_wq = mlx5_ib_modify_wq;
  2585. dev->ib_dev.destroy_wq = mlx5_ib_destroy_wq;
  2586. dev->ib_dev.create_rwq_ind_table = mlx5_ib_create_rwq_ind_table;
  2587. dev->ib_dev.destroy_rwq_ind_table = mlx5_ib_destroy_rwq_ind_table;
  2588. dev->ib_dev.uverbs_ex_cmd_mask |=
  2589. (1ull << IB_USER_VERBS_EX_CMD_CREATE_FLOW) |
  2590. (1ull << IB_USER_VERBS_EX_CMD_DESTROY_FLOW) |
  2591. (1ull << IB_USER_VERBS_EX_CMD_CREATE_WQ) |
  2592. (1ull << IB_USER_VERBS_EX_CMD_MODIFY_WQ) |
  2593. (1ull << IB_USER_VERBS_EX_CMD_DESTROY_WQ) |
  2594. (1ull << IB_USER_VERBS_EX_CMD_CREATE_RWQ_IND_TBL) |
  2595. (1ull << IB_USER_VERBS_EX_CMD_DESTROY_RWQ_IND_TBL);
  2596. }
  2597. err = init_node_data(dev);
  2598. if (err)
  2599. goto err_dealloc;
  2600. mutex_init(&dev->flow_db.lock);
  2601. mutex_init(&dev->cap_mask_mutex);
  2602. INIT_LIST_HEAD(&dev->qp_list);
  2603. spin_lock_init(&dev->reset_flow_resource_lock);
  2604. if (ll == IB_LINK_LAYER_ETHERNET) {
  2605. err = mlx5_enable_roce(dev);
  2606. if (err)
  2607. goto err_dealloc;
  2608. }
  2609. err = create_dev_resources(&dev->devr);
  2610. if (err)
  2611. goto err_disable_roce;
  2612. err = mlx5_ib_odp_init_one(dev);
  2613. if (err)
  2614. goto err_rsrc;
  2615. err = mlx5_ib_alloc_q_counters(dev);
  2616. if (err)
  2617. goto err_odp;
  2618. err = ib_register_device(&dev->ib_dev, NULL);
  2619. if (err)
  2620. goto err_q_cnt;
  2621. err = create_umr_res(dev);
  2622. if (err)
  2623. goto err_dev;
  2624. for (i = 0; i < ARRAY_SIZE(mlx5_class_attributes); i++) {
  2625. err = device_create_file(&dev->ib_dev.dev,
  2626. mlx5_class_attributes[i]);
  2627. if (err)
  2628. goto err_umrc;
  2629. }
  2630. dev->ib_active = true;
  2631. return dev;
  2632. err_umrc:
  2633. destroy_umrc_res(dev);
  2634. err_dev:
  2635. ib_unregister_device(&dev->ib_dev);
  2636. err_q_cnt:
  2637. mlx5_ib_dealloc_q_counters(dev);
  2638. err_odp:
  2639. mlx5_ib_odp_remove_one(dev);
  2640. err_rsrc:
  2641. destroy_dev_resources(&dev->devr);
  2642. err_disable_roce:
  2643. if (ll == IB_LINK_LAYER_ETHERNET) {
  2644. mlx5_disable_roce(dev);
  2645. mlx5_remove_roce_notifier(dev);
  2646. }
  2647. err_free_port:
  2648. kfree(dev->port);
  2649. err_dealloc:
  2650. ib_dealloc_device((struct ib_device *)dev);
  2651. return NULL;
  2652. }
  2653. static void mlx5_ib_remove(struct mlx5_core_dev *mdev, void *context)
  2654. {
  2655. struct mlx5_ib_dev *dev = context;
  2656. enum rdma_link_layer ll = mlx5_ib_port_link_layer(&dev->ib_dev, 1);
  2657. mlx5_remove_roce_notifier(dev);
  2658. ib_unregister_device(&dev->ib_dev);
  2659. mlx5_ib_dealloc_q_counters(dev);
  2660. destroy_umrc_res(dev);
  2661. mlx5_ib_odp_remove_one(dev);
  2662. destroy_dev_resources(&dev->devr);
  2663. if (ll == IB_LINK_LAYER_ETHERNET)
  2664. mlx5_disable_roce(dev);
  2665. kfree(dev->port);
  2666. ib_dealloc_device(&dev->ib_dev);
  2667. }
  2668. static struct mlx5_interface mlx5_ib_interface = {
  2669. .add = mlx5_ib_add,
  2670. .remove = mlx5_ib_remove,
  2671. .event = mlx5_ib_event,
  2672. .protocol = MLX5_INTERFACE_PROTOCOL_IB,
  2673. };
  2674. static int __init mlx5_ib_init(void)
  2675. {
  2676. int err;
  2677. if (deprecated_prof_sel != 2)
  2678. pr_warn("prof_sel is deprecated for mlx5_ib, set it for mlx5_core\n");
  2679. err = mlx5_ib_odp_init();
  2680. if (err)
  2681. return err;
  2682. err = mlx5_register_interface(&mlx5_ib_interface);
  2683. if (err)
  2684. goto clean_odp;
  2685. return err;
  2686. clean_odp:
  2687. mlx5_ib_odp_cleanup();
  2688. return err;
  2689. }
  2690. static void __exit mlx5_ib_cleanup(void)
  2691. {
  2692. mlx5_unregister_interface(&mlx5_ib_interface);
  2693. mlx5_ib_odp_cleanup();
  2694. }
  2695. module_init(mlx5_ib_init);
  2696. module_exit(mlx5_ib_cleanup);