main.c 87 KB

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