rtnetlink.c 52 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913191419151916191719181919192019211922192319241925192619271928192919301931193219331934193519361937193819391940194119421943194419451946194719481949195019511952195319541955195619571958195919601961196219631964196519661967196819691970197119721973197419751976197719781979198019811982198319841985198619871988198919901991199219931994199519961997199819992000200120022003200420052006200720082009201020112012201320142015201620172018201920202021202220232024202520262027202820292030203120322033203420352036203720382039204020412042204320442045204620472048204920502051205220532054205520562057205820592060206120622063206420652066206720682069207020712072207320742075207620772078207920802081208220832084208520862087208820892090209120922093209420952096209720982099210021012102210321042105210621072108210921102111211221132114211521162117211821192120212121222123212421252126212721282129213021312132213321342135213621372138213921402141214221432144214521462147214821492150215121522153215421552156215721582159216021612162216321642165216621672168216921702171
  1. /*
  2. * INET An implementation of the TCP/IP protocol suite for the LINUX
  3. * operating system. INET is implemented using the BSD Socket
  4. * interface as the means of communication with the user level.
  5. *
  6. * Routing netlink socket interface: protocol independent part.
  7. *
  8. * Authors: Alexey Kuznetsov, <kuznet@ms2.inr.ac.ru>
  9. *
  10. * This program is free software; you can redistribute it and/or
  11. * modify it under the terms of the GNU General Public License
  12. * as published by the Free Software Foundation; either version
  13. * 2 of the License, or (at your option) any later version.
  14. *
  15. * Fixes:
  16. * Vitaly E. Lavrov RTA_OK arithmetics was wrong.
  17. */
  18. #include <linux/errno.h>
  19. #include <linux/module.h>
  20. #include <linux/types.h>
  21. #include <linux/socket.h>
  22. #include <linux/kernel.h>
  23. #include <linux/timer.h>
  24. #include <linux/string.h>
  25. #include <linux/sockios.h>
  26. #include <linux/net.h>
  27. #include <linux/fcntl.h>
  28. #include <linux/mm.h>
  29. #include <linux/slab.h>
  30. #include <linux/interrupt.h>
  31. #include <linux/capability.h>
  32. #include <linux/skbuff.h>
  33. #include <linux/init.h>
  34. #include <linux/security.h>
  35. #include <linux/mutex.h>
  36. #include <linux/if_addr.h>
  37. #include <linux/pci.h>
  38. #include <asm/uaccess.h>
  39. #include <linux/inet.h>
  40. #include <linux/netdevice.h>
  41. #include <net/ip.h>
  42. #include <net/protocol.h>
  43. #include <net/arp.h>
  44. #include <net/route.h>
  45. #include <net/udp.h>
  46. #include <net/sock.h>
  47. #include <net/pkt_sched.h>
  48. #include <net/fib_rules.h>
  49. #include <net/rtnetlink.h>
  50. #include <net/net_namespace.h>
  51. struct rtnl_link {
  52. rtnl_doit_func doit;
  53. rtnl_dumpit_func dumpit;
  54. rtnl_calcit_func calcit;
  55. };
  56. static DEFINE_MUTEX(rtnl_mutex);
  57. void rtnl_lock(void)
  58. {
  59. mutex_lock(&rtnl_mutex);
  60. }
  61. EXPORT_SYMBOL(rtnl_lock);
  62. void __rtnl_unlock(void)
  63. {
  64. mutex_unlock(&rtnl_mutex);
  65. }
  66. void rtnl_unlock(void)
  67. {
  68. /* This fellow will unlock it for us. */
  69. netdev_run_todo();
  70. }
  71. EXPORT_SYMBOL(rtnl_unlock);
  72. int rtnl_trylock(void)
  73. {
  74. return mutex_trylock(&rtnl_mutex);
  75. }
  76. EXPORT_SYMBOL(rtnl_trylock);
  77. int rtnl_is_locked(void)
  78. {
  79. return mutex_is_locked(&rtnl_mutex);
  80. }
  81. EXPORT_SYMBOL(rtnl_is_locked);
  82. #ifdef CONFIG_PROVE_LOCKING
  83. int lockdep_rtnl_is_held(void)
  84. {
  85. return lockdep_is_held(&rtnl_mutex);
  86. }
  87. EXPORT_SYMBOL(lockdep_rtnl_is_held);
  88. #endif /* #ifdef CONFIG_PROVE_LOCKING */
  89. static struct rtnl_link *rtnl_msg_handlers[RTNL_FAMILY_MAX + 1];
  90. static inline int rtm_msgindex(int msgtype)
  91. {
  92. int msgindex = msgtype - RTM_BASE;
  93. /*
  94. * msgindex < 0 implies someone tried to register a netlink
  95. * control code. msgindex >= RTM_NR_MSGTYPES may indicate that
  96. * the message type has not been added to linux/rtnetlink.h
  97. */
  98. BUG_ON(msgindex < 0 || msgindex >= RTM_NR_MSGTYPES);
  99. return msgindex;
  100. }
  101. static rtnl_doit_func rtnl_get_doit(int protocol, int msgindex)
  102. {
  103. struct rtnl_link *tab;
  104. if (protocol <= RTNL_FAMILY_MAX)
  105. tab = rtnl_msg_handlers[protocol];
  106. else
  107. tab = NULL;
  108. if (tab == NULL || tab[msgindex].doit == NULL)
  109. tab = rtnl_msg_handlers[PF_UNSPEC];
  110. return tab ? tab[msgindex].doit : NULL;
  111. }
  112. static rtnl_dumpit_func rtnl_get_dumpit(int protocol, int msgindex)
  113. {
  114. struct rtnl_link *tab;
  115. if (protocol <= RTNL_FAMILY_MAX)
  116. tab = rtnl_msg_handlers[protocol];
  117. else
  118. tab = NULL;
  119. if (tab == NULL || tab[msgindex].dumpit == NULL)
  120. tab = rtnl_msg_handlers[PF_UNSPEC];
  121. return tab ? tab[msgindex].dumpit : NULL;
  122. }
  123. static rtnl_calcit_func rtnl_get_calcit(int protocol, int msgindex)
  124. {
  125. struct rtnl_link *tab;
  126. if (protocol <= RTNL_FAMILY_MAX)
  127. tab = rtnl_msg_handlers[protocol];
  128. else
  129. tab = NULL;
  130. if (tab == NULL || tab[msgindex].calcit == NULL)
  131. tab = rtnl_msg_handlers[PF_UNSPEC];
  132. return tab ? tab[msgindex].calcit : NULL;
  133. }
  134. /**
  135. * __rtnl_register - Register a rtnetlink message type
  136. * @protocol: Protocol family or PF_UNSPEC
  137. * @msgtype: rtnetlink message type
  138. * @doit: Function pointer called for each request message
  139. * @dumpit: Function pointer called for each dump request (NLM_F_DUMP) message
  140. * @calcit: Function pointer to calc size of dump message
  141. *
  142. * Registers the specified function pointers (at least one of them has
  143. * to be non-NULL) to be called whenever a request message for the
  144. * specified protocol family and message type is received.
  145. *
  146. * The special protocol family PF_UNSPEC may be used to define fallback
  147. * function pointers for the case when no entry for the specific protocol
  148. * family exists.
  149. *
  150. * Returns 0 on success or a negative error code.
  151. */
  152. int __rtnl_register(int protocol, int msgtype,
  153. rtnl_doit_func doit, rtnl_dumpit_func dumpit,
  154. rtnl_calcit_func calcit)
  155. {
  156. struct rtnl_link *tab;
  157. int msgindex;
  158. BUG_ON(protocol < 0 || protocol > RTNL_FAMILY_MAX);
  159. msgindex = rtm_msgindex(msgtype);
  160. tab = rtnl_msg_handlers[protocol];
  161. if (tab == NULL) {
  162. tab = kcalloc(RTM_NR_MSGTYPES, sizeof(*tab), GFP_KERNEL);
  163. if (tab == NULL)
  164. return -ENOBUFS;
  165. rtnl_msg_handlers[protocol] = tab;
  166. }
  167. if (doit)
  168. tab[msgindex].doit = doit;
  169. if (dumpit)
  170. tab[msgindex].dumpit = dumpit;
  171. if (calcit)
  172. tab[msgindex].calcit = calcit;
  173. return 0;
  174. }
  175. EXPORT_SYMBOL_GPL(__rtnl_register);
  176. /**
  177. * rtnl_register - Register a rtnetlink message type
  178. *
  179. * Identical to __rtnl_register() but panics on failure. This is useful
  180. * as failure of this function is very unlikely, it can only happen due
  181. * to lack of memory when allocating the chain to store all message
  182. * handlers for a protocol. Meant for use in init functions where lack
  183. * of memory implies no sense in continuing.
  184. */
  185. void rtnl_register(int protocol, int msgtype,
  186. rtnl_doit_func doit, rtnl_dumpit_func dumpit,
  187. rtnl_calcit_func calcit)
  188. {
  189. if (__rtnl_register(protocol, msgtype, doit, dumpit, calcit) < 0)
  190. panic("Unable to register rtnetlink message handler, "
  191. "protocol = %d, message type = %d\n",
  192. protocol, msgtype);
  193. }
  194. EXPORT_SYMBOL_GPL(rtnl_register);
  195. /**
  196. * rtnl_unregister - Unregister a rtnetlink message type
  197. * @protocol: Protocol family or PF_UNSPEC
  198. * @msgtype: rtnetlink message type
  199. *
  200. * Returns 0 on success or a negative error code.
  201. */
  202. int rtnl_unregister(int protocol, int msgtype)
  203. {
  204. int msgindex;
  205. BUG_ON(protocol < 0 || protocol > RTNL_FAMILY_MAX);
  206. msgindex = rtm_msgindex(msgtype);
  207. if (rtnl_msg_handlers[protocol] == NULL)
  208. return -ENOENT;
  209. rtnl_msg_handlers[protocol][msgindex].doit = NULL;
  210. rtnl_msg_handlers[protocol][msgindex].dumpit = NULL;
  211. rtnl_msg_handlers[protocol][msgindex].calcit = NULL;
  212. return 0;
  213. }
  214. EXPORT_SYMBOL_GPL(rtnl_unregister);
  215. /**
  216. * rtnl_unregister_all - Unregister all rtnetlink message type of a protocol
  217. * @protocol : Protocol family or PF_UNSPEC
  218. *
  219. * Identical to calling rtnl_unregster() for all registered message types
  220. * of a certain protocol family.
  221. */
  222. void rtnl_unregister_all(int protocol)
  223. {
  224. BUG_ON(protocol < 0 || protocol > RTNL_FAMILY_MAX);
  225. kfree(rtnl_msg_handlers[protocol]);
  226. rtnl_msg_handlers[protocol] = NULL;
  227. }
  228. EXPORT_SYMBOL_GPL(rtnl_unregister_all);
  229. static LIST_HEAD(link_ops);
  230. static const struct rtnl_link_ops *rtnl_link_ops_get(const char *kind)
  231. {
  232. const struct rtnl_link_ops *ops;
  233. list_for_each_entry(ops, &link_ops, list) {
  234. if (!strcmp(ops->kind, kind))
  235. return ops;
  236. }
  237. return NULL;
  238. }
  239. /**
  240. * __rtnl_link_register - Register rtnl_link_ops with rtnetlink.
  241. * @ops: struct rtnl_link_ops * to register
  242. *
  243. * The caller must hold the rtnl_mutex. This function should be used
  244. * by drivers that create devices during module initialization. It
  245. * must be called before registering the devices.
  246. *
  247. * Returns 0 on success or a negative error code.
  248. */
  249. int __rtnl_link_register(struct rtnl_link_ops *ops)
  250. {
  251. if (rtnl_link_ops_get(ops->kind))
  252. return -EEXIST;
  253. if (!ops->dellink)
  254. ops->dellink = unregister_netdevice_queue;
  255. list_add_tail(&ops->list, &link_ops);
  256. return 0;
  257. }
  258. EXPORT_SYMBOL_GPL(__rtnl_link_register);
  259. /**
  260. * rtnl_link_register - Register rtnl_link_ops with rtnetlink.
  261. * @ops: struct rtnl_link_ops * to register
  262. *
  263. * Returns 0 on success or a negative error code.
  264. */
  265. int rtnl_link_register(struct rtnl_link_ops *ops)
  266. {
  267. int err;
  268. rtnl_lock();
  269. err = __rtnl_link_register(ops);
  270. rtnl_unlock();
  271. return err;
  272. }
  273. EXPORT_SYMBOL_GPL(rtnl_link_register);
  274. static void __rtnl_kill_links(struct net *net, struct rtnl_link_ops *ops)
  275. {
  276. struct net_device *dev;
  277. LIST_HEAD(list_kill);
  278. for_each_netdev(net, dev) {
  279. if (dev->rtnl_link_ops == ops)
  280. ops->dellink(dev, &list_kill);
  281. }
  282. unregister_netdevice_many(&list_kill);
  283. }
  284. /**
  285. * __rtnl_link_unregister - Unregister rtnl_link_ops from rtnetlink.
  286. * @ops: struct rtnl_link_ops * to unregister
  287. *
  288. * The caller must hold the rtnl_mutex.
  289. */
  290. void __rtnl_link_unregister(struct rtnl_link_ops *ops)
  291. {
  292. struct net *net;
  293. for_each_net(net) {
  294. __rtnl_kill_links(net, ops);
  295. }
  296. list_del(&ops->list);
  297. }
  298. EXPORT_SYMBOL_GPL(__rtnl_link_unregister);
  299. /**
  300. * rtnl_link_unregister - Unregister rtnl_link_ops from rtnetlink.
  301. * @ops: struct rtnl_link_ops * to unregister
  302. */
  303. void rtnl_link_unregister(struct rtnl_link_ops *ops)
  304. {
  305. rtnl_lock();
  306. __rtnl_link_unregister(ops);
  307. rtnl_unlock();
  308. }
  309. EXPORT_SYMBOL_GPL(rtnl_link_unregister);
  310. static size_t rtnl_link_get_size(const struct net_device *dev)
  311. {
  312. const struct rtnl_link_ops *ops = dev->rtnl_link_ops;
  313. size_t size;
  314. if (!ops)
  315. return 0;
  316. size = nla_total_size(sizeof(struct nlattr)) + /* IFLA_LINKINFO */
  317. nla_total_size(strlen(ops->kind) + 1); /* IFLA_INFO_KIND */
  318. if (ops->get_size)
  319. /* IFLA_INFO_DATA + nested data */
  320. size += nla_total_size(sizeof(struct nlattr)) +
  321. ops->get_size(dev);
  322. if (ops->get_xstats_size)
  323. /* IFLA_INFO_XSTATS */
  324. size += nla_total_size(ops->get_xstats_size(dev));
  325. return size;
  326. }
  327. static LIST_HEAD(rtnl_af_ops);
  328. static const struct rtnl_af_ops *rtnl_af_lookup(const int family)
  329. {
  330. const struct rtnl_af_ops *ops;
  331. list_for_each_entry(ops, &rtnl_af_ops, list) {
  332. if (ops->family == family)
  333. return ops;
  334. }
  335. return NULL;
  336. }
  337. /**
  338. * __rtnl_af_register - Register rtnl_af_ops with rtnetlink.
  339. * @ops: struct rtnl_af_ops * to register
  340. *
  341. * The caller must hold the rtnl_mutex.
  342. *
  343. * Returns 0 on success or a negative error code.
  344. */
  345. int __rtnl_af_register(struct rtnl_af_ops *ops)
  346. {
  347. list_add_tail(&ops->list, &rtnl_af_ops);
  348. return 0;
  349. }
  350. EXPORT_SYMBOL_GPL(__rtnl_af_register);
  351. /**
  352. * rtnl_af_register - Register rtnl_af_ops with rtnetlink.
  353. * @ops: struct rtnl_af_ops * to register
  354. *
  355. * Returns 0 on success or a negative error code.
  356. */
  357. int rtnl_af_register(struct rtnl_af_ops *ops)
  358. {
  359. int err;
  360. rtnl_lock();
  361. err = __rtnl_af_register(ops);
  362. rtnl_unlock();
  363. return err;
  364. }
  365. EXPORT_SYMBOL_GPL(rtnl_af_register);
  366. /**
  367. * __rtnl_af_unregister - Unregister rtnl_af_ops from rtnetlink.
  368. * @ops: struct rtnl_af_ops * to unregister
  369. *
  370. * The caller must hold the rtnl_mutex.
  371. */
  372. void __rtnl_af_unregister(struct rtnl_af_ops *ops)
  373. {
  374. list_del(&ops->list);
  375. }
  376. EXPORT_SYMBOL_GPL(__rtnl_af_unregister);
  377. /**
  378. * rtnl_af_unregister - Unregister rtnl_af_ops from rtnetlink.
  379. * @ops: struct rtnl_af_ops * to unregister
  380. */
  381. void rtnl_af_unregister(struct rtnl_af_ops *ops)
  382. {
  383. rtnl_lock();
  384. __rtnl_af_unregister(ops);
  385. rtnl_unlock();
  386. }
  387. EXPORT_SYMBOL_GPL(rtnl_af_unregister);
  388. static size_t rtnl_link_get_af_size(const struct net_device *dev)
  389. {
  390. struct rtnl_af_ops *af_ops;
  391. size_t size;
  392. /* IFLA_AF_SPEC */
  393. size = nla_total_size(sizeof(struct nlattr));
  394. list_for_each_entry(af_ops, &rtnl_af_ops, list) {
  395. if (af_ops->get_link_af_size) {
  396. /* AF_* + nested data */
  397. size += nla_total_size(sizeof(struct nlattr)) +
  398. af_ops->get_link_af_size(dev);
  399. }
  400. }
  401. return size;
  402. }
  403. static int rtnl_link_fill(struct sk_buff *skb, const struct net_device *dev)
  404. {
  405. const struct rtnl_link_ops *ops = dev->rtnl_link_ops;
  406. struct nlattr *linkinfo, *data;
  407. int err = -EMSGSIZE;
  408. linkinfo = nla_nest_start(skb, IFLA_LINKINFO);
  409. if (linkinfo == NULL)
  410. goto out;
  411. if (nla_put_string(skb, IFLA_INFO_KIND, ops->kind) < 0)
  412. goto err_cancel_link;
  413. if (ops->fill_xstats) {
  414. err = ops->fill_xstats(skb, dev);
  415. if (err < 0)
  416. goto err_cancel_link;
  417. }
  418. if (ops->fill_info) {
  419. data = nla_nest_start(skb, IFLA_INFO_DATA);
  420. if (data == NULL) {
  421. err = -EMSGSIZE;
  422. goto err_cancel_link;
  423. }
  424. err = ops->fill_info(skb, dev);
  425. if (err < 0)
  426. goto err_cancel_data;
  427. nla_nest_end(skb, data);
  428. }
  429. nla_nest_end(skb, linkinfo);
  430. return 0;
  431. err_cancel_data:
  432. nla_nest_cancel(skb, data);
  433. err_cancel_link:
  434. nla_nest_cancel(skb, linkinfo);
  435. out:
  436. return err;
  437. }
  438. static const int rtm_min[RTM_NR_FAMILIES] =
  439. {
  440. [RTM_FAM(RTM_NEWLINK)] = NLMSG_LENGTH(sizeof(struct ifinfomsg)),
  441. [RTM_FAM(RTM_NEWADDR)] = NLMSG_LENGTH(sizeof(struct ifaddrmsg)),
  442. [RTM_FAM(RTM_NEWROUTE)] = NLMSG_LENGTH(sizeof(struct rtmsg)),
  443. [RTM_FAM(RTM_NEWRULE)] = NLMSG_LENGTH(sizeof(struct fib_rule_hdr)),
  444. [RTM_FAM(RTM_NEWQDISC)] = NLMSG_LENGTH(sizeof(struct tcmsg)),
  445. [RTM_FAM(RTM_NEWTCLASS)] = NLMSG_LENGTH(sizeof(struct tcmsg)),
  446. [RTM_FAM(RTM_NEWTFILTER)] = NLMSG_LENGTH(sizeof(struct tcmsg)),
  447. [RTM_FAM(RTM_NEWACTION)] = NLMSG_LENGTH(sizeof(struct tcamsg)),
  448. [RTM_FAM(RTM_GETMULTICAST)] = NLMSG_LENGTH(sizeof(struct rtgenmsg)),
  449. [RTM_FAM(RTM_GETANYCAST)] = NLMSG_LENGTH(sizeof(struct rtgenmsg)),
  450. };
  451. static const int rta_max[RTM_NR_FAMILIES] =
  452. {
  453. [RTM_FAM(RTM_NEWLINK)] = IFLA_MAX,
  454. [RTM_FAM(RTM_NEWADDR)] = IFA_MAX,
  455. [RTM_FAM(RTM_NEWROUTE)] = RTA_MAX,
  456. [RTM_FAM(RTM_NEWRULE)] = FRA_MAX,
  457. [RTM_FAM(RTM_NEWQDISC)] = TCA_MAX,
  458. [RTM_FAM(RTM_NEWTCLASS)] = TCA_MAX,
  459. [RTM_FAM(RTM_NEWTFILTER)] = TCA_MAX,
  460. [RTM_FAM(RTM_NEWACTION)] = TCAA_MAX,
  461. };
  462. void __rta_fill(struct sk_buff *skb, int attrtype, int attrlen, const void *data)
  463. {
  464. struct rtattr *rta;
  465. int size = RTA_LENGTH(attrlen);
  466. rta = (struct rtattr *)skb_put(skb, RTA_ALIGN(size));
  467. rta->rta_type = attrtype;
  468. rta->rta_len = size;
  469. memcpy(RTA_DATA(rta), data, attrlen);
  470. memset(RTA_DATA(rta) + attrlen, 0, RTA_ALIGN(size) - size);
  471. }
  472. EXPORT_SYMBOL(__rta_fill);
  473. int rtnetlink_send(struct sk_buff *skb, struct net *net, u32 pid, unsigned int group, int echo)
  474. {
  475. struct sock *rtnl = net->rtnl;
  476. int err = 0;
  477. NETLINK_CB(skb).dst_group = group;
  478. if (echo)
  479. atomic_inc(&skb->users);
  480. netlink_broadcast(rtnl, skb, pid, group, GFP_KERNEL);
  481. if (echo)
  482. err = netlink_unicast(rtnl, skb, pid, MSG_DONTWAIT);
  483. return err;
  484. }
  485. int rtnl_unicast(struct sk_buff *skb, struct net *net, u32 pid)
  486. {
  487. struct sock *rtnl = net->rtnl;
  488. return nlmsg_unicast(rtnl, skb, pid);
  489. }
  490. EXPORT_SYMBOL(rtnl_unicast);
  491. void rtnl_notify(struct sk_buff *skb, struct net *net, u32 pid, u32 group,
  492. struct nlmsghdr *nlh, gfp_t flags)
  493. {
  494. struct sock *rtnl = net->rtnl;
  495. int report = 0;
  496. if (nlh)
  497. report = nlmsg_report(nlh);
  498. nlmsg_notify(rtnl, skb, pid, group, report, flags);
  499. }
  500. EXPORT_SYMBOL(rtnl_notify);
  501. void rtnl_set_sk_err(struct net *net, u32 group, int error)
  502. {
  503. struct sock *rtnl = net->rtnl;
  504. netlink_set_err(rtnl, 0, group, error);
  505. }
  506. EXPORT_SYMBOL(rtnl_set_sk_err);
  507. int rtnetlink_put_metrics(struct sk_buff *skb, u32 *metrics)
  508. {
  509. struct nlattr *mx;
  510. int i, valid = 0;
  511. mx = nla_nest_start(skb, RTA_METRICS);
  512. if (mx == NULL)
  513. return -ENOBUFS;
  514. for (i = 0; i < RTAX_MAX; i++) {
  515. if (metrics[i]) {
  516. valid++;
  517. NLA_PUT_U32(skb, i+1, metrics[i]);
  518. }
  519. }
  520. if (!valid) {
  521. nla_nest_cancel(skb, mx);
  522. return 0;
  523. }
  524. return nla_nest_end(skb, mx);
  525. nla_put_failure:
  526. nla_nest_cancel(skb, mx);
  527. return -EMSGSIZE;
  528. }
  529. EXPORT_SYMBOL(rtnetlink_put_metrics);
  530. int rtnl_put_cacheinfo(struct sk_buff *skb, struct dst_entry *dst, u32 id,
  531. u32 ts, u32 tsage, long expires, u32 error)
  532. {
  533. struct rta_cacheinfo ci = {
  534. .rta_lastuse = jiffies_to_clock_t(jiffies - dst->lastuse),
  535. .rta_used = dst->__use,
  536. .rta_clntref = atomic_read(&(dst->__refcnt)),
  537. .rta_error = error,
  538. .rta_id = id,
  539. .rta_ts = ts,
  540. .rta_tsage = tsage,
  541. };
  542. if (expires)
  543. ci.rta_expires = jiffies_to_clock_t(expires);
  544. return nla_put(skb, RTA_CACHEINFO, sizeof(ci), &ci);
  545. }
  546. EXPORT_SYMBOL_GPL(rtnl_put_cacheinfo);
  547. static void set_operstate(struct net_device *dev, unsigned char transition)
  548. {
  549. unsigned char operstate = dev->operstate;
  550. switch (transition) {
  551. case IF_OPER_UP:
  552. if ((operstate == IF_OPER_DORMANT ||
  553. operstate == IF_OPER_UNKNOWN) &&
  554. !netif_dormant(dev))
  555. operstate = IF_OPER_UP;
  556. break;
  557. case IF_OPER_DORMANT:
  558. if (operstate == IF_OPER_UP ||
  559. operstate == IF_OPER_UNKNOWN)
  560. operstate = IF_OPER_DORMANT;
  561. break;
  562. }
  563. if (dev->operstate != operstate) {
  564. write_lock_bh(&dev_base_lock);
  565. dev->operstate = operstate;
  566. write_unlock_bh(&dev_base_lock);
  567. netdev_state_change(dev);
  568. }
  569. }
  570. static unsigned int rtnl_dev_get_flags(const struct net_device *dev)
  571. {
  572. return (dev->flags & ~(IFF_PROMISC | IFF_ALLMULTI)) |
  573. (dev->gflags & (IFF_PROMISC | IFF_ALLMULTI));
  574. }
  575. static unsigned int rtnl_dev_combine_flags(const struct net_device *dev,
  576. const struct ifinfomsg *ifm)
  577. {
  578. unsigned int flags = ifm->ifi_flags;
  579. /* bugwards compatibility: ifi_change == 0 is treated as ~0 */
  580. if (ifm->ifi_change)
  581. flags = (flags & ifm->ifi_change) |
  582. (rtnl_dev_get_flags(dev) & ~ifm->ifi_change);
  583. return flags;
  584. }
  585. static void copy_rtnl_link_stats(struct rtnl_link_stats *a,
  586. const struct rtnl_link_stats64 *b)
  587. {
  588. a->rx_packets = b->rx_packets;
  589. a->tx_packets = b->tx_packets;
  590. a->rx_bytes = b->rx_bytes;
  591. a->tx_bytes = b->tx_bytes;
  592. a->rx_errors = b->rx_errors;
  593. a->tx_errors = b->tx_errors;
  594. a->rx_dropped = b->rx_dropped;
  595. a->tx_dropped = b->tx_dropped;
  596. a->multicast = b->multicast;
  597. a->collisions = b->collisions;
  598. a->rx_length_errors = b->rx_length_errors;
  599. a->rx_over_errors = b->rx_over_errors;
  600. a->rx_crc_errors = b->rx_crc_errors;
  601. a->rx_frame_errors = b->rx_frame_errors;
  602. a->rx_fifo_errors = b->rx_fifo_errors;
  603. a->rx_missed_errors = b->rx_missed_errors;
  604. a->tx_aborted_errors = b->tx_aborted_errors;
  605. a->tx_carrier_errors = b->tx_carrier_errors;
  606. a->tx_fifo_errors = b->tx_fifo_errors;
  607. a->tx_heartbeat_errors = b->tx_heartbeat_errors;
  608. a->tx_window_errors = b->tx_window_errors;
  609. a->rx_compressed = b->rx_compressed;
  610. a->tx_compressed = b->tx_compressed;
  611. }
  612. static void copy_rtnl_link_stats64(void *v, const struct rtnl_link_stats64 *b)
  613. {
  614. memcpy(v, b, sizeof(*b));
  615. }
  616. /* All VF info */
  617. static inline int rtnl_vfinfo_size(const struct net_device *dev,
  618. u32 ext_filter_mask)
  619. {
  620. if (dev->dev.parent && dev_is_pci(dev->dev.parent) &&
  621. (ext_filter_mask & RTEXT_FILTER_VF)) {
  622. int num_vfs = dev_num_vf(dev->dev.parent);
  623. size_t size = nla_total_size(sizeof(struct nlattr));
  624. size += nla_total_size(num_vfs * sizeof(struct nlattr));
  625. size += num_vfs *
  626. (nla_total_size(sizeof(struct ifla_vf_mac)) +
  627. nla_total_size(sizeof(struct ifla_vf_vlan)) +
  628. nla_total_size(sizeof(struct ifla_vf_tx_rate)) +
  629. nla_total_size(sizeof(struct ifla_vf_spoofchk)));
  630. return size;
  631. } else
  632. return 0;
  633. }
  634. static size_t rtnl_port_size(const struct net_device *dev,
  635. u32 ext_filter_mask)
  636. {
  637. size_t port_size = nla_total_size(4) /* PORT_VF */
  638. + nla_total_size(PORT_PROFILE_MAX) /* PORT_PROFILE */
  639. + nla_total_size(sizeof(struct ifla_port_vsi))
  640. /* PORT_VSI_TYPE */
  641. + nla_total_size(PORT_UUID_MAX) /* PORT_INSTANCE_UUID */
  642. + nla_total_size(PORT_UUID_MAX) /* PORT_HOST_UUID */
  643. + nla_total_size(1) /* PROT_VDP_REQUEST */
  644. + nla_total_size(2); /* PORT_VDP_RESPONSE */
  645. size_t vf_ports_size = nla_total_size(sizeof(struct nlattr));
  646. size_t vf_port_size = nla_total_size(sizeof(struct nlattr))
  647. + port_size;
  648. size_t port_self_size = nla_total_size(sizeof(struct nlattr))
  649. + port_size;
  650. if (!dev->netdev_ops->ndo_get_vf_port || !dev->dev.parent ||
  651. !(ext_filter_mask & RTEXT_FILTER_VF))
  652. return 0;
  653. if (dev_num_vf(dev->dev.parent))
  654. return port_self_size + vf_ports_size +
  655. vf_port_size * dev_num_vf(dev->dev.parent);
  656. else
  657. return port_self_size;
  658. }
  659. static noinline size_t if_nlmsg_size(const struct net_device *dev,
  660. u32 ext_filter_mask)
  661. {
  662. return NLMSG_ALIGN(sizeof(struct ifinfomsg))
  663. + nla_total_size(IFNAMSIZ) /* IFLA_IFNAME */
  664. + nla_total_size(IFALIASZ) /* IFLA_IFALIAS */
  665. + nla_total_size(IFNAMSIZ) /* IFLA_QDISC */
  666. + nla_total_size(sizeof(struct rtnl_link_ifmap))
  667. + nla_total_size(sizeof(struct rtnl_link_stats))
  668. + nla_total_size(sizeof(struct rtnl_link_stats64))
  669. + nla_total_size(MAX_ADDR_LEN) /* IFLA_ADDRESS */
  670. + nla_total_size(MAX_ADDR_LEN) /* IFLA_BROADCAST */
  671. + nla_total_size(4) /* IFLA_TXQLEN */
  672. + nla_total_size(4) /* IFLA_WEIGHT */
  673. + nla_total_size(4) /* IFLA_MTU */
  674. + nla_total_size(4) /* IFLA_LINK */
  675. + nla_total_size(4) /* IFLA_MASTER */
  676. + nla_total_size(1) /* IFLA_OPERSTATE */
  677. + nla_total_size(1) /* IFLA_LINKMODE */
  678. + nla_total_size(ext_filter_mask
  679. & RTEXT_FILTER_VF ? 4 : 0) /* IFLA_NUM_VF */
  680. + rtnl_vfinfo_size(dev, ext_filter_mask) /* IFLA_VFINFO_LIST */
  681. + rtnl_port_size(dev, ext_filter_mask) /* IFLA_VF_PORTS + IFLA_PORT_SELF */
  682. + rtnl_link_get_size(dev) /* IFLA_LINKINFO */
  683. + rtnl_link_get_af_size(dev); /* IFLA_AF_SPEC */
  684. }
  685. static int rtnl_vf_ports_fill(struct sk_buff *skb, struct net_device *dev)
  686. {
  687. struct nlattr *vf_ports;
  688. struct nlattr *vf_port;
  689. int vf;
  690. int err;
  691. vf_ports = nla_nest_start(skb, IFLA_VF_PORTS);
  692. if (!vf_ports)
  693. return -EMSGSIZE;
  694. for (vf = 0; vf < dev_num_vf(dev->dev.parent); vf++) {
  695. vf_port = nla_nest_start(skb, IFLA_VF_PORT);
  696. if (!vf_port)
  697. goto nla_put_failure;
  698. NLA_PUT_U32(skb, IFLA_PORT_VF, vf);
  699. err = dev->netdev_ops->ndo_get_vf_port(dev, vf, skb);
  700. if (err == -EMSGSIZE)
  701. goto nla_put_failure;
  702. if (err) {
  703. nla_nest_cancel(skb, vf_port);
  704. continue;
  705. }
  706. nla_nest_end(skb, vf_port);
  707. }
  708. nla_nest_end(skb, vf_ports);
  709. return 0;
  710. nla_put_failure:
  711. nla_nest_cancel(skb, vf_ports);
  712. return -EMSGSIZE;
  713. }
  714. static int rtnl_port_self_fill(struct sk_buff *skb, struct net_device *dev)
  715. {
  716. struct nlattr *port_self;
  717. int err;
  718. port_self = nla_nest_start(skb, IFLA_PORT_SELF);
  719. if (!port_self)
  720. return -EMSGSIZE;
  721. err = dev->netdev_ops->ndo_get_vf_port(dev, PORT_SELF_VF, skb);
  722. if (err) {
  723. nla_nest_cancel(skb, port_self);
  724. return (err == -EMSGSIZE) ? err : 0;
  725. }
  726. nla_nest_end(skb, port_self);
  727. return 0;
  728. }
  729. static int rtnl_port_fill(struct sk_buff *skb, struct net_device *dev,
  730. u32 ext_filter_mask)
  731. {
  732. int err;
  733. if (!dev->netdev_ops->ndo_get_vf_port || !dev->dev.parent ||
  734. !(ext_filter_mask & RTEXT_FILTER_VF))
  735. return 0;
  736. err = rtnl_port_self_fill(skb, dev);
  737. if (err)
  738. return err;
  739. if (dev_num_vf(dev->dev.parent)) {
  740. err = rtnl_vf_ports_fill(skb, dev);
  741. if (err)
  742. return err;
  743. }
  744. return 0;
  745. }
  746. static int rtnl_fill_ifinfo(struct sk_buff *skb, struct net_device *dev,
  747. int type, u32 pid, u32 seq, u32 change,
  748. unsigned int flags, u32 ext_filter_mask)
  749. {
  750. struct ifinfomsg *ifm;
  751. struct nlmsghdr *nlh;
  752. struct rtnl_link_stats64 temp;
  753. const struct rtnl_link_stats64 *stats;
  754. struct nlattr *attr, *af_spec;
  755. struct rtnl_af_ops *af_ops;
  756. ASSERT_RTNL();
  757. nlh = nlmsg_put(skb, pid, seq, type, sizeof(*ifm), flags);
  758. if (nlh == NULL)
  759. return -EMSGSIZE;
  760. ifm = nlmsg_data(nlh);
  761. ifm->ifi_family = AF_UNSPEC;
  762. ifm->__ifi_pad = 0;
  763. ifm->ifi_type = dev->type;
  764. ifm->ifi_index = dev->ifindex;
  765. ifm->ifi_flags = dev_get_flags(dev);
  766. ifm->ifi_change = change;
  767. NLA_PUT_STRING(skb, IFLA_IFNAME, dev->name);
  768. NLA_PUT_U32(skb, IFLA_TXQLEN, dev->tx_queue_len);
  769. NLA_PUT_U8(skb, IFLA_OPERSTATE,
  770. netif_running(dev) ? dev->operstate : IF_OPER_DOWN);
  771. NLA_PUT_U8(skb, IFLA_LINKMODE, dev->link_mode);
  772. NLA_PUT_U32(skb, IFLA_MTU, dev->mtu);
  773. NLA_PUT_U32(skb, IFLA_GROUP, dev->group);
  774. if (dev->ifindex != dev->iflink)
  775. NLA_PUT_U32(skb, IFLA_LINK, dev->iflink);
  776. if (dev->master)
  777. NLA_PUT_U32(skb, IFLA_MASTER, dev->master->ifindex);
  778. if (dev->qdisc)
  779. NLA_PUT_STRING(skb, IFLA_QDISC, dev->qdisc->ops->id);
  780. if (dev->ifalias)
  781. NLA_PUT_STRING(skb, IFLA_IFALIAS, dev->ifalias);
  782. if (1) {
  783. struct rtnl_link_ifmap map;
  784. memset(&map, 0, sizeof(map));
  785. map.mem_start = dev->mem_start;
  786. map.mem_end = dev->mem_end;
  787. map.base_addr = dev->base_addr;
  788. map.irq = dev->irq;
  789. map.dma = dev->dma;
  790. map.port = dev->if_port;
  791. NLA_PUT(skb, IFLA_MAP, sizeof(map), &map);
  792. }
  793. if (dev->addr_len) {
  794. NLA_PUT(skb, IFLA_ADDRESS, dev->addr_len, dev->dev_addr);
  795. NLA_PUT(skb, IFLA_BROADCAST, dev->addr_len, dev->broadcast);
  796. }
  797. attr = nla_reserve(skb, IFLA_STATS,
  798. sizeof(struct rtnl_link_stats));
  799. if (attr == NULL)
  800. goto nla_put_failure;
  801. stats = dev_get_stats(dev, &temp);
  802. copy_rtnl_link_stats(nla_data(attr), stats);
  803. attr = nla_reserve(skb, IFLA_STATS64,
  804. sizeof(struct rtnl_link_stats64));
  805. if (attr == NULL)
  806. goto nla_put_failure;
  807. copy_rtnl_link_stats64(nla_data(attr), stats);
  808. if (dev->dev.parent && (ext_filter_mask & RTEXT_FILTER_VF))
  809. NLA_PUT_U32(skb, IFLA_NUM_VF, dev_num_vf(dev->dev.parent));
  810. if (dev->netdev_ops->ndo_get_vf_config && dev->dev.parent
  811. && (ext_filter_mask & RTEXT_FILTER_VF)) {
  812. int i;
  813. struct nlattr *vfinfo, *vf;
  814. int num_vfs = dev_num_vf(dev->dev.parent);
  815. vfinfo = nla_nest_start(skb, IFLA_VFINFO_LIST);
  816. if (!vfinfo)
  817. goto nla_put_failure;
  818. for (i = 0; i < num_vfs; i++) {
  819. struct ifla_vf_info ivi;
  820. struct ifla_vf_mac vf_mac;
  821. struct ifla_vf_vlan vf_vlan;
  822. struct ifla_vf_tx_rate vf_tx_rate;
  823. struct ifla_vf_spoofchk vf_spoofchk;
  824. /*
  825. * Not all SR-IOV capable drivers support the
  826. * spoofcheck query. Preset to -1 so the user
  827. * space tool can detect that the driver didn't
  828. * report anything.
  829. */
  830. ivi.spoofchk = -1;
  831. memset(ivi.mac, 0, sizeof(ivi.mac));
  832. if (dev->netdev_ops->ndo_get_vf_config(dev, i, &ivi))
  833. break;
  834. vf_mac.vf =
  835. vf_vlan.vf =
  836. vf_tx_rate.vf =
  837. vf_spoofchk.vf = ivi.vf;
  838. memcpy(vf_mac.mac, ivi.mac, sizeof(ivi.mac));
  839. vf_vlan.vlan = ivi.vlan;
  840. vf_vlan.qos = ivi.qos;
  841. vf_tx_rate.rate = ivi.tx_rate;
  842. vf_spoofchk.setting = ivi.spoofchk;
  843. vf = nla_nest_start(skb, IFLA_VF_INFO);
  844. if (!vf) {
  845. nla_nest_cancel(skb, vfinfo);
  846. goto nla_put_failure;
  847. }
  848. NLA_PUT(skb, IFLA_VF_MAC, sizeof(vf_mac), &vf_mac);
  849. NLA_PUT(skb, IFLA_VF_VLAN, sizeof(vf_vlan), &vf_vlan);
  850. NLA_PUT(skb, IFLA_VF_TX_RATE, sizeof(vf_tx_rate),
  851. &vf_tx_rate);
  852. NLA_PUT(skb, IFLA_VF_SPOOFCHK, sizeof(vf_spoofchk),
  853. &vf_spoofchk);
  854. nla_nest_end(skb, vf);
  855. }
  856. nla_nest_end(skb, vfinfo);
  857. }
  858. if (rtnl_port_fill(skb, dev, ext_filter_mask))
  859. goto nla_put_failure;
  860. if (dev->rtnl_link_ops) {
  861. if (rtnl_link_fill(skb, dev) < 0)
  862. goto nla_put_failure;
  863. }
  864. if (!(af_spec = nla_nest_start(skb, IFLA_AF_SPEC)))
  865. goto nla_put_failure;
  866. list_for_each_entry(af_ops, &rtnl_af_ops, list) {
  867. if (af_ops->fill_link_af) {
  868. struct nlattr *af;
  869. int err;
  870. if (!(af = nla_nest_start(skb, af_ops->family)))
  871. goto nla_put_failure;
  872. err = af_ops->fill_link_af(skb, dev);
  873. /*
  874. * Caller may return ENODATA to indicate that there
  875. * was no data to be dumped. This is not an error, it
  876. * means we should trim the attribute header and
  877. * continue.
  878. */
  879. if (err == -ENODATA)
  880. nla_nest_cancel(skb, af);
  881. else if (err < 0)
  882. goto nla_put_failure;
  883. nla_nest_end(skb, af);
  884. }
  885. }
  886. nla_nest_end(skb, af_spec);
  887. return nlmsg_end(skb, nlh);
  888. nla_put_failure:
  889. nlmsg_cancel(skb, nlh);
  890. return -EMSGSIZE;
  891. }
  892. static int rtnl_dump_ifinfo(struct sk_buff *skb, struct netlink_callback *cb)
  893. {
  894. struct net *net = sock_net(skb->sk);
  895. int h, s_h;
  896. int idx = 0, s_idx;
  897. struct net_device *dev;
  898. struct hlist_head *head;
  899. struct hlist_node *node;
  900. struct nlattr *tb[IFLA_MAX+1];
  901. u32 ext_filter_mask = 0;
  902. int err;
  903. s_h = cb->args[0];
  904. s_idx = cb->args[1];
  905. rcu_read_lock();
  906. cb->seq = net->dev_base_seq;
  907. if (nlmsg_parse(cb->nlh, sizeof(struct ifinfomsg), tb, IFLA_MAX,
  908. ifla_policy) >= 0) {
  909. if (tb[IFLA_EXT_MASK])
  910. ext_filter_mask = nla_get_u32(tb[IFLA_EXT_MASK]);
  911. }
  912. for (h = s_h; h < NETDEV_HASHENTRIES; h++, s_idx = 0) {
  913. idx = 0;
  914. head = &net->dev_index_head[h];
  915. hlist_for_each_entry_rcu(dev, node, head, index_hlist) {
  916. if (idx < s_idx)
  917. goto cont;
  918. err = rtnl_fill_ifinfo(skb, dev, RTM_NEWLINK,
  919. NETLINK_CB(cb->skb).pid,
  920. cb->nlh->nlmsg_seq, 0,
  921. NLM_F_MULTI,
  922. ext_filter_mask);
  923. /* If we ran out of room on the first message,
  924. * we're in trouble
  925. */
  926. WARN_ON((err == -EMSGSIZE) && (skb->len == 0));
  927. if (err <= 0)
  928. goto out;
  929. nl_dump_check_consistent(cb, nlmsg_hdr(skb));
  930. cont:
  931. idx++;
  932. }
  933. }
  934. out:
  935. rcu_read_unlock();
  936. cb->args[1] = idx;
  937. cb->args[0] = h;
  938. return skb->len;
  939. }
  940. const struct nla_policy ifla_policy[IFLA_MAX+1] = {
  941. [IFLA_IFNAME] = { .type = NLA_STRING, .len = IFNAMSIZ-1 },
  942. [IFLA_ADDRESS] = { .type = NLA_BINARY, .len = MAX_ADDR_LEN },
  943. [IFLA_BROADCAST] = { .type = NLA_BINARY, .len = MAX_ADDR_LEN },
  944. [IFLA_MAP] = { .len = sizeof(struct rtnl_link_ifmap) },
  945. [IFLA_MTU] = { .type = NLA_U32 },
  946. [IFLA_LINK] = { .type = NLA_U32 },
  947. [IFLA_MASTER] = { .type = NLA_U32 },
  948. [IFLA_TXQLEN] = { .type = NLA_U32 },
  949. [IFLA_WEIGHT] = { .type = NLA_U32 },
  950. [IFLA_OPERSTATE] = { .type = NLA_U8 },
  951. [IFLA_LINKMODE] = { .type = NLA_U8 },
  952. [IFLA_LINKINFO] = { .type = NLA_NESTED },
  953. [IFLA_NET_NS_PID] = { .type = NLA_U32 },
  954. [IFLA_NET_NS_FD] = { .type = NLA_U32 },
  955. [IFLA_IFALIAS] = { .type = NLA_STRING, .len = IFALIASZ-1 },
  956. [IFLA_VFINFO_LIST] = {. type = NLA_NESTED },
  957. [IFLA_VF_PORTS] = { .type = NLA_NESTED },
  958. [IFLA_PORT_SELF] = { .type = NLA_NESTED },
  959. [IFLA_AF_SPEC] = { .type = NLA_NESTED },
  960. [IFLA_EXT_MASK] = { .type = NLA_U32 },
  961. };
  962. EXPORT_SYMBOL(ifla_policy);
  963. static const struct nla_policy ifla_info_policy[IFLA_INFO_MAX+1] = {
  964. [IFLA_INFO_KIND] = { .type = NLA_STRING },
  965. [IFLA_INFO_DATA] = { .type = NLA_NESTED },
  966. };
  967. static const struct nla_policy ifla_vf_policy[IFLA_VF_MAX+1] = {
  968. [IFLA_VF_MAC] = { .len = sizeof(struct ifla_vf_mac) },
  969. [IFLA_VF_VLAN] = { .len = sizeof(struct ifla_vf_vlan) },
  970. [IFLA_VF_TX_RATE] = { .len = sizeof(struct ifla_vf_tx_rate) },
  971. [IFLA_VF_SPOOFCHK] = { .len = sizeof(struct ifla_vf_spoofchk) },
  972. };
  973. static const struct nla_policy ifla_port_policy[IFLA_PORT_MAX+1] = {
  974. [IFLA_PORT_VF] = { .type = NLA_U32 },
  975. [IFLA_PORT_PROFILE] = { .type = NLA_STRING,
  976. .len = PORT_PROFILE_MAX },
  977. [IFLA_PORT_VSI_TYPE] = { .type = NLA_BINARY,
  978. .len = sizeof(struct ifla_port_vsi)},
  979. [IFLA_PORT_INSTANCE_UUID] = { .type = NLA_BINARY,
  980. .len = PORT_UUID_MAX },
  981. [IFLA_PORT_HOST_UUID] = { .type = NLA_STRING,
  982. .len = PORT_UUID_MAX },
  983. [IFLA_PORT_REQUEST] = { .type = NLA_U8, },
  984. [IFLA_PORT_RESPONSE] = { .type = NLA_U16, },
  985. };
  986. struct net *rtnl_link_get_net(struct net *src_net, struct nlattr *tb[])
  987. {
  988. struct net *net;
  989. /* Examine the link attributes and figure out which
  990. * network namespace we are talking about.
  991. */
  992. if (tb[IFLA_NET_NS_PID])
  993. net = get_net_ns_by_pid(nla_get_u32(tb[IFLA_NET_NS_PID]));
  994. else if (tb[IFLA_NET_NS_FD])
  995. net = get_net_ns_by_fd(nla_get_u32(tb[IFLA_NET_NS_FD]));
  996. else
  997. net = get_net(src_net);
  998. return net;
  999. }
  1000. EXPORT_SYMBOL(rtnl_link_get_net);
  1001. static int validate_linkmsg(struct net_device *dev, struct nlattr *tb[])
  1002. {
  1003. if (dev) {
  1004. if (tb[IFLA_ADDRESS] &&
  1005. nla_len(tb[IFLA_ADDRESS]) < dev->addr_len)
  1006. return -EINVAL;
  1007. if (tb[IFLA_BROADCAST] &&
  1008. nla_len(tb[IFLA_BROADCAST]) < dev->addr_len)
  1009. return -EINVAL;
  1010. }
  1011. if (tb[IFLA_AF_SPEC]) {
  1012. struct nlattr *af;
  1013. int rem, err;
  1014. nla_for_each_nested(af, tb[IFLA_AF_SPEC], rem) {
  1015. const struct rtnl_af_ops *af_ops;
  1016. if (!(af_ops = rtnl_af_lookup(nla_type(af))))
  1017. return -EAFNOSUPPORT;
  1018. if (!af_ops->set_link_af)
  1019. return -EOPNOTSUPP;
  1020. if (af_ops->validate_link_af) {
  1021. err = af_ops->validate_link_af(dev, af);
  1022. if (err < 0)
  1023. return err;
  1024. }
  1025. }
  1026. }
  1027. return 0;
  1028. }
  1029. static int do_setvfinfo(struct net_device *dev, struct nlattr **tb)
  1030. {
  1031. const struct net_device_ops *ops = dev->netdev_ops;
  1032. int err = -EINVAL;
  1033. if (tb[IFLA_VF_MAC]) {
  1034. struct ifla_vf_mac *ivm = nla_data(tb[IFLA_VF_MAC]);
  1035. if (ivm->vf >= INT_MAX)
  1036. return -EINVAL;
  1037. err = -EOPNOTSUPP;
  1038. if (ops->ndo_set_vf_mac)
  1039. err = ops->ndo_set_vf_mac(dev, ivm->vf,
  1040. ivm->mac);
  1041. if (err < 0)
  1042. return err;
  1043. }
  1044. if (tb[IFLA_VF_VLAN]) {
  1045. struct ifla_vf_vlan *ivv = nla_data(tb[IFLA_VF_VLAN]);
  1046. if (ivv->vf >= INT_MAX)
  1047. return -EINVAL;
  1048. err = -EOPNOTSUPP;
  1049. if (ops->ndo_set_vf_vlan)
  1050. err = ops->ndo_set_vf_vlan(dev, ivv->vf, ivv->vlan,
  1051. ivv->qos);
  1052. if (err < 0)
  1053. return err;
  1054. }
  1055. if (tb[IFLA_VF_TX_RATE]) {
  1056. struct ifla_vf_tx_rate *ivt = nla_data(tb[IFLA_VF_TX_RATE]);
  1057. if (ivt->vf >= INT_MAX)
  1058. return -EINVAL;
  1059. err = -EOPNOTSUPP;
  1060. if (ops->ndo_set_vf_tx_rate)
  1061. err = ops->ndo_set_vf_tx_rate(dev, ivt->vf,
  1062. ivt->rate);
  1063. if (err < 0)
  1064. return err;
  1065. }
  1066. if (tb[IFLA_VF_SPOOFCHK]) {
  1067. struct ifla_vf_spoofchk *ivs = nla_data(tb[IFLA_VF_SPOOFCHK]);
  1068. if (ivs->vf >= INT_MAX)
  1069. return -EINVAL;
  1070. err = -EOPNOTSUPP;
  1071. if (ops->ndo_set_vf_spoofchk)
  1072. err = ops->ndo_set_vf_spoofchk(dev, ivs->vf,
  1073. ivs->setting);
  1074. if (err < 0)
  1075. return err;
  1076. }
  1077. return err;
  1078. }
  1079. static int do_set_master(struct net_device *dev, int ifindex)
  1080. {
  1081. struct net_device *master_dev;
  1082. const struct net_device_ops *ops;
  1083. int err;
  1084. if (dev->master) {
  1085. if (dev->master->ifindex == ifindex)
  1086. return 0;
  1087. ops = dev->master->netdev_ops;
  1088. if (ops->ndo_del_slave) {
  1089. err = ops->ndo_del_slave(dev->master, dev);
  1090. if (err)
  1091. return err;
  1092. } else {
  1093. return -EOPNOTSUPP;
  1094. }
  1095. }
  1096. if (ifindex) {
  1097. master_dev = __dev_get_by_index(dev_net(dev), ifindex);
  1098. if (!master_dev)
  1099. return -EINVAL;
  1100. ops = master_dev->netdev_ops;
  1101. if (ops->ndo_add_slave) {
  1102. err = ops->ndo_add_slave(master_dev, dev);
  1103. if (err)
  1104. return err;
  1105. } else {
  1106. return -EOPNOTSUPP;
  1107. }
  1108. }
  1109. return 0;
  1110. }
  1111. static int do_setlink(struct net_device *dev, struct ifinfomsg *ifm,
  1112. struct nlattr **tb, char *ifname, int modified)
  1113. {
  1114. const struct net_device_ops *ops = dev->netdev_ops;
  1115. int send_addr_notify = 0;
  1116. int err;
  1117. if (tb[IFLA_NET_NS_PID] || tb[IFLA_NET_NS_FD]) {
  1118. struct net *net = rtnl_link_get_net(dev_net(dev), tb);
  1119. if (IS_ERR(net)) {
  1120. err = PTR_ERR(net);
  1121. goto errout;
  1122. }
  1123. err = dev_change_net_namespace(dev, net, ifname);
  1124. put_net(net);
  1125. if (err)
  1126. goto errout;
  1127. modified = 1;
  1128. }
  1129. if (tb[IFLA_MAP]) {
  1130. struct rtnl_link_ifmap *u_map;
  1131. struct ifmap k_map;
  1132. if (!ops->ndo_set_config) {
  1133. err = -EOPNOTSUPP;
  1134. goto errout;
  1135. }
  1136. if (!netif_device_present(dev)) {
  1137. err = -ENODEV;
  1138. goto errout;
  1139. }
  1140. u_map = nla_data(tb[IFLA_MAP]);
  1141. k_map.mem_start = (unsigned long) u_map->mem_start;
  1142. k_map.mem_end = (unsigned long) u_map->mem_end;
  1143. k_map.base_addr = (unsigned short) u_map->base_addr;
  1144. k_map.irq = (unsigned char) u_map->irq;
  1145. k_map.dma = (unsigned char) u_map->dma;
  1146. k_map.port = (unsigned char) u_map->port;
  1147. err = ops->ndo_set_config(dev, &k_map);
  1148. if (err < 0)
  1149. goto errout;
  1150. modified = 1;
  1151. }
  1152. if (tb[IFLA_ADDRESS]) {
  1153. struct sockaddr *sa;
  1154. int len;
  1155. if (!ops->ndo_set_mac_address) {
  1156. err = -EOPNOTSUPP;
  1157. goto errout;
  1158. }
  1159. if (!netif_device_present(dev)) {
  1160. err = -ENODEV;
  1161. goto errout;
  1162. }
  1163. len = sizeof(sa_family_t) + dev->addr_len;
  1164. sa = kmalloc(len, GFP_KERNEL);
  1165. if (!sa) {
  1166. err = -ENOMEM;
  1167. goto errout;
  1168. }
  1169. sa->sa_family = dev->type;
  1170. memcpy(sa->sa_data, nla_data(tb[IFLA_ADDRESS]),
  1171. dev->addr_len);
  1172. err = ops->ndo_set_mac_address(dev, sa);
  1173. kfree(sa);
  1174. if (err)
  1175. goto errout;
  1176. send_addr_notify = 1;
  1177. modified = 1;
  1178. add_device_randomness(dev->dev_addr, dev->addr_len);
  1179. }
  1180. if (tb[IFLA_MTU]) {
  1181. err = dev_set_mtu(dev, nla_get_u32(tb[IFLA_MTU]));
  1182. if (err < 0)
  1183. goto errout;
  1184. modified = 1;
  1185. }
  1186. if (tb[IFLA_GROUP]) {
  1187. dev_set_group(dev, nla_get_u32(tb[IFLA_GROUP]));
  1188. modified = 1;
  1189. }
  1190. /*
  1191. * Interface selected by interface index but interface
  1192. * name provided implies that a name change has been
  1193. * requested.
  1194. */
  1195. if (ifm->ifi_index > 0 && ifname[0]) {
  1196. err = dev_change_name(dev, ifname);
  1197. if (err < 0)
  1198. goto errout;
  1199. modified = 1;
  1200. }
  1201. if (tb[IFLA_IFALIAS]) {
  1202. err = dev_set_alias(dev, nla_data(tb[IFLA_IFALIAS]),
  1203. nla_len(tb[IFLA_IFALIAS]));
  1204. if (err < 0)
  1205. goto errout;
  1206. modified = 1;
  1207. }
  1208. if (tb[IFLA_BROADCAST]) {
  1209. nla_memcpy(dev->broadcast, tb[IFLA_BROADCAST], dev->addr_len);
  1210. send_addr_notify = 1;
  1211. }
  1212. if (ifm->ifi_flags || ifm->ifi_change) {
  1213. err = dev_change_flags(dev, rtnl_dev_combine_flags(dev, ifm));
  1214. if (err < 0)
  1215. goto errout;
  1216. }
  1217. if (tb[IFLA_MASTER]) {
  1218. err = do_set_master(dev, nla_get_u32(tb[IFLA_MASTER]));
  1219. if (err)
  1220. goto errout;
  1221. modified = 1;
  1222. }
  1223. if (tb[IFLA_TXQLEN])
  1224. dev->tx_queue_len = nla_get_u32(tb[IFLA_TXQLEN]);
  1225. if (tb[IFLA_OPERSTATE])
  1226. set_operstate(dev, nla_get_u8(tb[IFLA_OPERSTATE]));
  1227. if (tb[IFLA_LINKMODE]) {
  1228. write_lock_bh(&dev_base_lock);
  1229. dev->link_mode = nla_get_u8(tb[IFLA_LINKMODE]);
  1230. write_unlock_bh(&dev_base_lock);
  1231. }
  1232. if (tb[IFLA_VFINFO_LIST]) {
  1233. struct nlattr *vfinfo[IFLA_VF_MAX + 1];
  1234. struct nlattr *attr;
  1235. int rem;
  1236. nla_for_each_nested(attr, tb[IFLA_VFINFO_LIST], rem) {
  1237. if (nla_type(attr) != IFLA_VF_INFO ||
  1238. nla_len(attr) < NLA_HDRLEN) {
  1239. err = -EINVAL;
  1240. goto errout;
  1241. }
  1242. err = nla_parse_nested(vfinfo, IFLA_VF_MAX, attr,
  1243. ifla_vf_policy);
  1244. if (err < 0)
  1245. goto errout;
  1246. err = do_setvfinfo(dev, vfinfo);
  1247. if (err < 0)
  1248. goto errout;
  1249. modified = 1;
  1250. }
  1251. }
  1252. err = 0;
  1253. if (tb[IFLA_VF_PORTS]) {
  1254. struct nlattr *port[IFLA_PORT_MAX+1];
  1255. struct nlattr *attr;
  1256. int vf;
  1257. int rem;
  1258. err = -EOPNOTSUPP;
  1259. if (!ops->ndo_set_vf_port)
  1260. goto errout;
  1261. nla_for_each_nested(attr, tb[IFLA_VF_PORTS], rem) {
  1262. if (nla_type(attr) != IFLA_VF_PORT)
  1263. continue;
  1264. err = nla_parse_nested(port, IFLA_PORT_MAX,
  1265. attr, ifla_port_policy);
  1266. if (err < 0)
  1267. goto errout;
  1268. if (!port[IFLA_PORT_VF]) {
  1269. err = -EOPNOTSUPP;
  1270. goto errout;
  1271. }
  1272. vf = nla_get_u32(port[IFLA_PORT_VF]);
  1273. err = ops->ndo_set_vf_port(dev, vf, port);
  1274. if (err < 0)
  1275. goto errout;
  1276. modified = 1;
  1277. }
  1278. }
  1279. err = 0;
  1280. if (tb[IFLA_PORT_SELF]) {
  1281. struct nlattr *port[IFLA_PORT_MAX+1];
  1282. err = nla_parse_nested(port, IFLA_PORT_MAX,
  1283. tb[IFLA_PORT_SELF], ifla_port_policy);
  1284. if (err < 0)
  1285. goto errout;
  1286. err = -EOPNOTSUPP;
  1287. if (ops->ndo_set_vf_port)
  1288. err = ops->ndo_set_vf_port(dev, PORT_SELF_VF, port);
  1289. if (err < 0)
  1290. goto errout;
  1291. modified = 1;
  1292. }
  1293. if (tb[IFLA_AF_SPEC]) {
  1294. struct nlattr *af;
  1295. int rem;
  1296. nla_for_each_nested(af, tb[IFLA_AF_SPEC], rem) {
  1297. const struct rtnl_af_ops *af_ops;
  1298. if (!(af_ops = rtnl_af_lookup(nla_type(af))))
  1299. BUG();
  1300. err = af_ops->set_link_af(dev, af);
  1301. if (err < 0)
  1302. goto errout;
  1303. modified = 1;
  1304. }
  1305. }
  1306. err = 0;
  1307. errout:
  1308. if (err < 0 && modified)
  1309. net_warn_ratelimited("A link change request failed with some changes committed already. Interface %s may have been left with an inconsistent configuration, please check.\n",
  1310. dev->name);
  1311. if (send_addr_notify)
  1312. call_netdevice_notifiers(NETDEV_CHANGEADDR, dev);
  1313. return err;
  1314. }
  1315. static int rtnl_setlink(struct sk_buff *skb, struct nlmsghdr *nlh, void *arg)
  1316. {
  1317. struct net *net = sock_net(skb->sk);
  1318. struct ifinfomsg *ifm;
  1319. struct net_device *dev;
  1320. int err;
  1321. struct nlattr *tb[IFLA_MAX+1];
  1322. char ifname[IFNAMSIZ];
  1323. err = nlmsg_parse(nlh, sizeof(*ifm), tb, IFLA_MAX, ifla_policy);
  1324. if (err < 0)
  1325. goto errout;
  1326. if (tb[IFLA_IFNAME])
  1327. nla_strlcpy(ifname, tb[IFLA_IFNAME], IFNAMSIZ);
  1328. else
  1329. ifname[0] = '\0';
  1330. err = -EINVAL;
  1331. ifm = nlmsg_data(nlh);
  1332. if (ifm->ifi_index > 0)
  1333. dev = __dev_get_by_index(net, ifm->ifi_index);
  1334. else if (tb[IFLA_IFNAME])
  1335. dev = __dev_get_by_name(net, ifname);
  1336. else
  1337. goto errout;
  1338. if (dev == NULL) {
  1339. err = -ENODEV;
  1340. goto errout;
  1341. }
  1342. err = validate_linkmsg(dev, tb);
  1343. if (err < 0)
  1344. goto errout;
  1345. err = do_setlink(dev, ifm, tb, ifname, 0);
  1346. errout:
  1347. return err;
  1348. }
  1349. static int rtnl_dellink(struct sk_buff *skb, struct nlmsghdr *nlh, void *arg)
  1350. {
  1351. struct net *net = sock_net(skb->sk);
  1352. const struct rtnl_link_ops *ops;
  1353. struct net_device *dev;
  1354. struct ifinfomsg *ifm;
  1355. char ifname[IFNAMSIZ];
  1356. struct nlattr *tb[IFLA_MAX+1];
  1357. int err;
  1358. LIST_HEAD(list_kill);
  1359. err = nlmsg_parse(nlh, sizeof(*ifm), tb, IFLA_MAX, ifla_policy);
  1360. if (err < 0)
  1361. return err;
  1362. if (tb[IFLA_IFNAME])
  1363. nla_strlcpy(ifname, tb[IFLA_IFNAME], IFNAMSIZ);
  1364. ifm = nlmsg_data(nlh);
  1365. if (ifm->ifi_index > 0)
  1366. dev = __dev_get_by_index(net, ifm->ifi_index);
  1367. else if (tb[IFLA_IFNAME])
  1368. dev = __dev_get_by_name(net, ifname);
  1369. else
  1370. return -EINVAL;
  1371. if (!dev)
  1372. return -ENODEV;
  1373. ops = dev->rtnl_link_ops;
  1374. if (!ops)
  1375. return -EOPNOTSUPP;
  1376. ops->dellink(dev, &list_kill);
  1377. unregister_netdevice_many(&list_kill);
  1378. list_del(&list_kill);
  1379. return 0;
  1380. }
  1381. int rtnl_configure_link(struct net_device *dev, const struct ifinfomsg *ifm)
  1382. {
  1383. unsigned int old_flags;
  1384. int err;
  1385. old_flags = dev->flags;
  1386. if (ifm && (ifm->ifi_flags || ifm->ifi_change)) {
  1387. err = __dev_change_flags(dev, rtnl_dev_combine_flags(dev, ifm));
  1388. if (err < 0)
  1389. return err;
  1390. }
  1391. dev->rtnl_link_state = RTNL_LINK_INITIALIZED;
  1392. rtmsg_ifinfo(RTM_NEWLINK, dev, ~0U);
  1393. __dev_notify_flags(dev, old_flags);
  1394. return 0;
  1395. }
  1396. EXPORT_SYMBOL(rtnl_configure_link);
  1397. struct net_device *rtnl_create_link(struct net *src_net, struct net *net,
  1398. char *ifname, const struct rtnl_link_ops *ops, struct nlattr *tb[])
  1399. {
  1400. int err;
  1401. struct net_device *dev;
  1402. unsigned int num_queues = 1;
  1403. unsigned int real_num_queues = 1;
  1404. if (ops->get_tx_queues) {
  1405. err = ops->get_tx_queues(src_net, tb, &num_queues,
  1406. &real_num_queues);
  1407. if (err)
  1408. goto err;
  1409. }
  1410. err = -ENOMEM;
  1411. dev = alloc_netdev_mq(ops->priv_size, ifname, ops->setup, num_queues);
  1412. if (!dev)
  1413. goto err;
  1414. dev_net_set(dev, net);
  1415. dev->rtnl_link_ops = ops;
  1416. dev->rtnl_link_state = RTNL_LINK_INITIALIZING;
  1417. if (tb[IFLA_MTU])
  1418. dev->mtu = nla_get_u32(tb[IFLA_MTU]);
  1419. if (tb[IFLA_ADDRESS])
  1420. memcpy(dev->dev_addr, nla_data(tb[IFLA_ADDRESS]),
  1421. nla_len(tb[IFLA_ADDRESS]));
  1422. if (tb[IFLA_BROADCAST])
  1423. memcpy(dev->broadcast, nla_data(tb[IFLA_BROADCAST]),
  1424. nla_len(tb[IFLA_BROADCAST]));
  1425. if (tb[IFLA_TXQLEN])
  1426. dev->tx_queue_len = nla_get_u32(tb[IFLA_TXQLEN]);
  1427. if (tb[IFLA_OPERSTATE])
  1428. set_operstate(dev, nla_get_u8(tb[IFLA_OPERSTATE]));
  1429. if (tb[IFLA_LINKMODE])
  1430. dev->link_mode = nla_get_u8(tb[IFLA_LINKMODE]);
  1431. if (tb[IFLA_GROUP])
  1432. dev_set_group(dev, nla_get_u32(tb[IFLA_GROUP]));
  1433. return dev;
  1434. err:
  1435. return ERR_PTR(err);
  1436. }
  1437. EXPORT_SYMBOL(rtnl_create_link);
  1438. static int rtnl_group_changelink(struct net *net, int group,
  1439. struct ifinfomsg *ifm,
  1440. struct nlattr **tb)
  1441. {
  1442. struct net_device *dev, *aux;
  1443. int err;
  1444. for_each_netdev_safe(net, dev, aux) {
  1445. if (dev->group == group) {
  1446. err = do_setlink(dev, ifm, tb, NULL, 0);
  1447. if (err < 0)
  1448. return err;
  1449. }
  1450. }
  1451. return 0;
  1452. }
  1453. static int rtnl_newlink(struct sk_buff *skb, struct nlmsghdr *nlh, void *arg)
  1454. {
  1455. struct net *net = sock_net(skb->sk);
  1456. const struct rtnl_link_ops *ops;
  1457. struct net_device *dev;
  1458. struct ifinfomsg *ifm;
  1459. char kind[MODULE_NAME_LEN];
  1460. char ifname[IFNAMSIZ];
  1461. struct nlattr *tb[IFLA_MAX+1];
  1462. struct nlattr *linkinfo[IFLA_INFO_MAX+1];
  1463. int err;
  1464. #ifdef CONFIG_MODULES
  1465. replay:
  1466. #endif
  1467. err = nlmsg_parse(nlh, sizeof(*ifm), tb, IFLA_MAX, ifla_policy);
  1468. if (err < 0)
  1469. return err;
  1470. if (tb[IFLA_IFNAME])
  1471. nla_strlcpy(ifname, tb[IFLA_IFNAME], IFNAMSIZ);
  1472. else
  1473. ifname[0] = '\0';
  1474. ifm = nlmsg_data(nlh);
  1475. if (ifm->ifi_index > 0)
  1476. dev = __dev_get_by_index(net, ifm->ifi_index);
  1477. else {
  1478. if (ifname[0])
  1479. dev = __dev_get_by_name(net, ifname);
  1480. else
  1481. dev = NULL;
  1482. }
  1483. err = validate_linkmsg(dev, tb);
  1484. if (err < 0)
  1485. return err;
  1486. if (tb[IFLA_LINKINFO]) {
  1487. err = nla_parse_nested(linkinfo, IFLA_INFO_MAX,
  1488. tb[IFLA_LINKINFO], ifla_info_policy);
  1489. if (err < 0)
  1490. return err;
  1491. } else
  1492. memset(linkinfo, 0, sizeof(linkinfo));
  1493. if (linkinfo[IFLA_INFO_KIND]) {
  1494. nla_strlcpy(kind, linkinfo[IFLA_INFO_KIND], sizeof(kind));
  1495. ops = rtnl_link_ops_get(kind);
  1496. } else {
  1497. kind[0] = '\0';
  1498. ops = NULL;
  1499. }
  1500. if (1) {
  1501. struct nlattr *attr[ops ? ops->maxtype + 1 : 0], **data = NULL;
  1502. struct net *dest_net;
  1503. if (ops) {
  1504. if (ops->maxtype && linkinfo[IFLA_INFO_DATA]) {
  1505. err = nla_parse_nested(attr, ops->maxtype,
  1506. linkinfo[IFLA_INFO_DATA],
  1507. ops->policy);
  1508. if (err < 0)
  1509. return err;
  1510. data = attr;
  1511. }
  1512. if (ops->validate) {
  1513. err = ops->validate(tb, data);
  1514. if (err < 0)
  1515. return err;
  1516. }
  1517. }
  1518. if (dev) {
  1519. int modified = 0;
  1520. if (nlh->nlmsg_flags & NLM_F_EXCL)
  1521. return -EEXIST;
  1522. if (nlh->nlmsg_flags & NLM_F_REPLACE)
  1523. return -EOPNOTSUPP;
  1524. if (linkinfo[IFLA_INFO_DATA]) {
  1525. if (!ops || ops != dev->rtnl_link_ops ||
  1526. !ops->changelink)
  1527. return -EOPNOTSUPP;
  1528. err = ops->changelink(dev, tb, data);
  1529. if (err < 0)
  1530. return err;
  1531. modified = 1;
  1532. }
  1533. return do_setlink(dev, ifm, tb, ifname, modified);
  1534. }
  1535. if (!(nlh->nlmsg_flags & NLM_F_CREATE)) {
  1536. if (ifm->ifi_index == 0 && tb[IFLA_GROUP])
  1537. return rtnl_group_changelink(net,
  1538. nla_get_u32(tb[IFLA_GROUP]),
  1539. ifm, tb);
  1540. return -ENODEV;
  1541. }
  1542. if (ifm->ifi_index)
  1543. return -EOPNOTSUPP;
  1544. if (tb[IFLA_MAP] || tb[IFLA_MASTER] || tb[IFLA_PROTINFO])
  1545. return -EOPNOTSUPP;
  1546. if (!ops) {
  1547. #ifdef CONFIG_MODULES
  1548. if (kind[0]) {
  1549. __rtnl_unlock();
  1550. request_module("rtnl-link-%s", kind);
  1551. rtnl_lock();
  1552. ops = rtnl_link_ops_get(kind);
  1553. if (ops)
  1554. goto replay;
  1555. }
  1556. #endif
  1557. return -EOPNOTSUPP;
  1558. }
  1559. if (!ifname[0])
  1560. snprintf(ifname, IFNAMSIZ, "%s%%d", ops->kind);
  1561. dest_net = rtnl_link_get_net(net, tb);
  1562. if (IS_ERR(dest_net))
  1563. return PTR_ERR(dest_net);
  1564. dev = rtnl_create_link(net, dest_net, ifname, ops, tb);
  1565. if (IS_ERR(dev))
  1566. err = PTR_ERR(dev);
  1567. else if (ops->newlink)
  1568. err = ops->newlink(net, dev, tb, data);
  1569. else
  1570. err = register_netdevice(dev);
  1571. if (err < 0 && !IS_ERR(dev))
  1572. free_netdev(dev);
  1573. if (err < 0)
  1574. goto out;
  1575. err = rtnl_configure_link(dev, ifm);
  1576. if (err < 0)
  1577. unregister_netdevice(dev);
  1578. out:
  1579. put_net(dest_net);
  1580. return err;
  1581. }
  1582. }
  1583. static int rtnl_getlink(struct sk_buff *skb, struct nlmsghdr* nlh, void *arg)
  1584. {
  1585. struct net *net = sock_net(skb->sk);
  1586. struct ifinfomsg *ifm;
  1587. char ifname[IFNAMSIZ];
  1588. struct nlattr *tb[IFLA_MAX+1];
  1589. struct net_device *dev = NULL;
  1590. struct sk_buff *nskb;
  1591. int err;
  1592. u32 ext_filter_mask = 0;
  1593. err = nlmsg_parse(nlh, sizeof(*ifm), tb, IFLA_MAX, ifla_policy);
  1594. if (err < 0)
  1595. return err;
  1596. if (tb[IFLA_IFNAME])
  1597. nla_strlcpy(ifname, tb[IFLA_IFNAME], IFNAMSIZ);
  1598. if (tb[IFLA_EXT_MASK])
  1599. ext_filter_mask = nla_get_u32(tb[IFLA_EXT_MASK]);
  1600. ifm = nlmsg_data(nlh);
  1601. if (ifm->ifi_index > 0)
  1602. dev = __dev_get_by_index(net, ifm->ifi_index);
  1603. else if (tb[IFLA_IFNAME])
  1604. dev = __dev_get_by_name(net, ifname);
  1605. else
  1606. return -EINVAL;
  1607. if (dev == NULL)
  1608. return -ENODEV;
  1609. nskb = nlmsg_new(if_nlmsg_size(dev, ext_filter_mask), GFP_KERNEL);
  1610. if (nskb == NULL)
  1611. return -ENOBUFS;
  1612. err = rtnl_fill_ifinfo(nskb, dev, RTM_NEWLINK, NETLINK_CB(skb).pid,
  1613. nlh->nlmsg_seq, 0, 0, ext_filter_mask);
  1614. if (err < 0) {
  1615. /* -EMSGSIZE implies BUG in if_nlmsg_size */
  1616. WARN_ON(err == -EMSGSIZE);
  1617. kfree_skb(nskb);
  1618. } else
  1619. err = rtnl_unicast(nskb, net, NETLINK_CB(skb).pid);
  1620. return err;
  1621. }
  1622. static u16 rtnl_calcit(struct sk_buff *skb, struct nlmsghdr *nlh)
  1623. {
  1624. struct net *net = sock_net(skb->sk);
  1625. struct net_device *dev;
  1626. struct nlattr *tb[IFLA_MAX+1];
  1627. u32 ext_filter_mask = 0;
  1628. u16 min_ifinfo_dump_size = 0;
  1629. if (nlmsg_parse(nlh, sizeof(struct ifinfomsg), tb, IFLA_MAX,
  1630. ifla_policy) >= 0) {
  1631. if (tb[IFLA_EXT_MASK])
  1632. ext_filter_mask = nla_get_u32(tb[IFLA_EXT_MASK]);
  1633. }
  1634. if (!ext_filter_mask)
  1635. return NLMSG_GOODSIZE;
  1636. /*
  1637. * traverse the list of net devices and compute the minimum
  1638. * buffer size based upon the filter mask.
  1639. */
  1640. list_for_each_entry(dev, &net->dev_base_head, dev_list) {
  1641. min_ifinfo_dump_size = max_t(u16, min_ifinfo_dump_size,
  1642. if_nlmsg_size(dev,
  1643. ext_filter_mask));
  1644. }
  1645. return min_ifinfo_dump_size;
  1646. }
  1647. static int rtnl_dump_all(struct sk_buff *skb, struct netlink_callback *cb)
  1648. {
  1649. int idx;
  1650. int s_idx = cb->family;
  1651. if (s_idx == 0)
  1652. s_idx = 1;
  1653. for (idx = 1; idx <= RTNL_FAMILY_MAX; idx++) {
  1654. int type = cb->nlh->nlmsg_type-RTM_BASE;
  1655. if (idx < s_idx || idx == PF_PACKET)
  1656. continue;
  1657. if (rtnl_msg_handlers[idx] == NULL ||
  1658. rtnl_msg_handlers[idx][type].dumpit == NULL)
  1659. continue;
  1660. if (idx > s_idx)
  1661. memset(&cb->args[0], 0, sizeof(cb->args));
  1662. if (rtnl_msg_handlers[idx][type].dumpit(skb, cb))
  1663. break;
  1664. }
  1665. cb->family = idx;
  1666. return skb->len;
  1667. }
  1668. void rtmsg_ifinfo(int type, struct net_device *dev, unsigned int change)
  1669. {
  1670. struct net *net = dev_net(dev);
  1671. struct sk_buff *skb;
  1672. int err = -ENOBUFS;
  1673. size_t if_info_size;
  1674. skb = nlmsg_new((if_info_size = if_nlmsg_size(dev, 0)), GFP_KERNEL);
  1675. if (skb == NULL)
  1676. goto errout;
  1677. err = rtnl_fill_ifinfo(skb, dev, type, 0, 0, change, 0, 0);
  1678. if (err < 0) {
  1679. /* -EMSGSIZE implies BUG in if_nlmsg_size() */
  1680. WARN_ON(err == -EMSGSIZE);
  1681. kfree_skb(skb);
  1682. goto errout;
  1683. }
  1684. rtnl_notify(skb, net, 0, RTNLGRP_LINK, NULL, GFP_KERNEL);
  1685. return;
  1686. errout:
  1687. if (err < 0)
  1688. rtnl_set_sk_err(net, RTNLGRP_LINK, err);
  1689. }
  1690. /* Protected by RTNL sempahore. */
  1691. static struct rtattr **rta_buf;
  1692. static int rtattr_max;
  1693. /* Process one rtnetlink message. */
  1694. static int rtnetlink_rcv_msg(struct sk_buff *skb, struct nlmsghdr *nlh)
  1695. {
  1696. struct net *net = sock_net(skb->sk);
  1697. rtnl_doit_func doit;
  1698. int sz_idx, kind;
  1699. int min_len;
  1700. int family;
  1701. int type;
  1702. int err;
  1703. type = nlh->nlmsg_type;
  1704. if (type > RTM_MAX)
  1705. return -EOPNOTSUPP;
  1706. type -= RTM_BASE;
  1707. /* All the messages must have at least 1 byte length */
  1708. if (nlh->nlmsg_len < NLMSG_LENGTH(sizeof(struct rtgenmsg)))
  1709. return 0;
  1710. family = ((struct rtgenmsg *)NLMSG_DATA(nlh))->rtgen_family;
  1711. sz_idx = type>>2;
  1712. kind = type&3;
  1713. if (kind != 2 && !capable(CAP_NET_ADMIN))
  1714. return -EPERM;
  1715. if (kind == 2 && nlh->nlmsg_flags&NLM_F_DUMP) {
  1716. struct sock *rtnl;
  1717. rtnl_dumpit_func dumpit;
  1718. rtnl_calcit_func calcit;
  1719. u16 min_dump_alloc = 0;
  1720. dumpit = rtnl_get_dumpit(family, type);
  1721. if (dumpit == NULL)
  1722. return -EOPNOTSUPP;
  1723. calcit = rtnl_get_calcit(family, type);
  1724. if (calcit)
  1725. min_dump_alloc = calcit(skb, nlh);
  1726. __rtnl_unlock();
  1727. rtnl = net->rtnl;
  1728. {
  1729. struct netlink_dump_control c = {
  1730. .dump = dumpit,
  1731. .min_dump_alloc = min_dump_alloc,
  1732. };
  1733. err = netlink_dump_start(rtnl, skb, nlh, &c);
  1734. }
  1735. rtnl_lock();
  1736. return err;
  1737. }
  1738. memset(rta_buf, 0, (rtattr_max * sizeof(struct rtattr *)));
  1739. min_len = rtm_min[sz_idx];
  1740. if (nlh->nlmsg_len < min_len)
  1741. return -EINVAL;
  1742. if (nlh->nlmsg_len > min_len) {
  1743. int attrlen = nlh->nlmsg_len - NLMSG_ALIGN(min_len);
  1744. struct rtattr *attr = (void *)nlh + NLMSG_ALIGN(min_len);
  1745. while (RTA_OK(attr, attrlen)) {
  1746. unsigned int flavor = attr->rta_type & NLA_TYPE_MASK;
  1747. if (flavor) {
  1748. if (flavor > rta_max[sz_idx])
  1749. return -EINVAL;
  1750. rta_buf[flavor-1] = attr;
  1751. }
  1752. attr = RTA_NEXT(attr, attrlen);
  1753. }
  1754. }
  1755. doit = rtnl_get_doit(family, type);
  1756. if (doit == NULL)
  1757. return -EOPNOTSUPP;
  1758. return doit(skb, nlh, (void *)&rta_buf[0]);
  1759. }
  1760. static void rtnetlink_rcv(struct sk_buff *skb)
  1761. {
  1762. rtnl_lock();
  1763. netlink_rcv_skb(skb, &rtnetlink_rcv_msg);
  1764. rtnl_unlock();
  1765. }
  1766. static int rtnetlink_event(struct notifier_block *this, unsigned long event, void *ptr)
  1767. {
  1768. struct net_device *dev = ptr;
  1769. switch (event) {
  1770. case NETDEV_UP:
  1771. case NETDEV_DOWN:
  1772. case NETDEV_PRE_UP:
  1773. case NETDEV_POST_INIT:
  1774. case NETDEV_REGISTER:
  1775. case NETDEV_CHANGE:
  1776. case NETDEV_PRE_TYPE_CHANGE:
  1777. case NETDEV_GOING_DOWN:
  1778. case NETDEV_UNREGISTER:
  1779. case NETDEV_UNREGISTER_BATCH:
  1780. case NETDEV_RELEASE:
  1781. case NETDEV_JOIN:
  1782. break;
  1783. default:
  1784. rtmsg_ifinfo(RTM_NEWLINK, dev, 0);
  1785. break;
  1786. }
  1787. return NOTIFY_DONE;
  1788. }
  1789. static struct notifier_block rtnetlink_dev_notifier = {
  1790. .notifier_call = rtnetlink_event,
  1791. };
  1792. static int __net_init rtnetlink_net_init(struct net *net)
  1793. {
  1794. struct sock *sk;
  1795. sk = netlink_kernel_create(net, NETLINK_ROUTE, RTNLGRP_MAX,
  1796. rtnetlink_rcv, &rtnl_mutex, THIS_MODULE);
  1797. if (!sk)
  1798. return -ENOMEM;
  1799. net->rtnl = sk;
  1800. return 0;
  1801. }
  1802. static void __net_exit rtnetlink_net_exit(struct net *net)
  1803. {
  1804. netlink_kernel_release(net->rtnl);
  1805. net->rtnl = NULL;
  1806. }
  1807. static struct pernet_operations rtnetlink_net_ops = {
  1808. .init = rtnetlink_net_init,
  1809. .exit = rtnetlink_net_exit,
  1810. };
  1811. void __init rtnetlink_init(void)
  1812. {
  1813. int i;
  1814. rtattr_max = 0;
  1815. for (i = 0; i < ARRAY_SIZE(rta_max); i++)
  1816. if (rta_max[i] > rtattr_max)
  1817. rtattr_max = rta_max[i];
  1818. rta_buf = kmalloc(rtattr_max * sizeof(struct rtattr *), GFP_KERNEL);
  1819. if (!rta_buf)
  1820. panic("rtnetlink_init: cannot allocate rta_buf\n");
  1821. if (register_pernet_subsys(&rtnetlink_net_ops))
  1822. panic("rtnetlink_init: cannot initialize rtnetlink\n");
  1823. netlink_set_nonroot(NETLINK_ROUTE, NL_NONROOT_RECV);
  1824. register_netdevice_notifier(&rtnetlink_dev_notifier);
  1825. rtnl_register(PF_UNSPEC, RTM_GETLINK, rtnl_getlink,
  1826. rtnl_dump_ifinfo, rtnl_calcit);
  1827. rtnl_register(PF_UNSPEC, RTM_SETLINK, rtnl_setlink, NULL, NULL);
  1828. rtnl_register(PF_UNSPEC, RTM_NEWLINK, rtnl_newlink, NULL, NULL);
  1829. rtnl_register(PF_UNSPEC, RTM_DELLINK, rtnl_dellink, NULL, NULL);
  1830. rtnl_register(PF_UNSPEC, RTM_GETADDR, NULL, rtnl_dump_all, NULL);
  1831. rtnl_register(PF_UNSPEC, RTM_GETROUTE, NULL, rtnl_dump_all, NULL);
  1832. }