fib_semantics.c 36 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549
  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. * IPv4 Forwarding Information Base: semantics.
  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. #include <asm/uaccess.h>
  16. #include <linux/bitops.h>
  17. #include <linux/types.h>
  18. #include <linux/kernel.h>
  19. #include <linux/jiffies.h>
  20. #include <linux/mm.h>
  21. #include <linux/string.h>
  22. #include <linux/socket.h>
  23. #include <linux/sockios.h>
  24. #include <linux/errno.h>
  25. #include <linux/in.h>
  26. #include <linux/inet.h>
  27. #include <linux/inetdevice.h>
  28. #include <linux/netdevice.h>
  29. #include <linux/if_arp.h>
  30. #include <linux/proc_fs.h>
  31. #include <linux/skbuff.h>
  32. #include <linux/init.h>
  33. #include <linux/slab.h>
  34. #include <net/arp.h>
  35. #include <net/ip.h>
  36. #include <net/protocol.h>
  37. #include <net/route.h>
  38. #include <net/tcp.h>
  39. #include <net/sock.h>
  40. #include <net/ip_fib.h>
  41. #include <net/netlink.h>
  42. #include <net/nexthop.h>
  43. #include <net/lwtunnel.h>
  44. #include "fib_lookup.h"
  45. static DEFINE_SPINLOCK(fib_info_lock);
  46. static struct hlist_head *fib_info_hash;
  47. static struct hlist_head *fib_info_laddrhash;
  48. static unsigned int fib_info_hash_size;
  49. static unsigned int fib_info_cnt;
  50. #define DEVINDEX_HASHBITS 8
  51. #define DEVINDEX_HASHSIZE (1U << DEVINDEX_HASHBITS)
  52. static struct hlist_head fib_info_devhash[DEVINDEX_HASHSIZE];
  53. #ifdef CONFIG_IP_ROUTE_MULTIPATH
  54. static DEFINE_SPINLOCK(fib_multipath_lock);
  55. #define for_nexthops(fi) { \
  56. int nhsel; const struct fib_nh *nh; \
  57. for (nhsel = 0, nh = (fi)->fib_nh; \
  58. nhsel < (fi)->fib_nhs; \
  59. nh++, nhsel++)
  60. #define change_nexthops(fi) { \
  61. int nhsel; struct fib_nh *nexthop_nh; \
  62. for (nhsel = 0, nexthop_nh = (struct fib_nh *)((fi)->fib_nh); \
  63. nhsel < (fi)->fib_nhs; \
  64. nexthop_nh++, nhsel++)
  65. #else /* CONFIG_IP_ROUTE_MULTIPATH */
  66. /* Hope, that gcc will optimize it to get rid of dummy loop */
  67. #define for_nexthops(fi) { \
  68. int nhsel; const struct fib_nh *nh = (fi)->fib_nh; \
  69. for (nhsel = 0; nhsel < 1; nhsel++)
  70. #define change_nexthops(fi) { \
  71. int nhsel; \
  72. struct fib_nh *nexthop_nh = (struct fib_nh *)((fi)->fib_nh); \
  73. for (nhsel = 0; nhsel < 1; nhsel++)
  74. #endif /* CONFIG_IP_ROUTE_MULTIPATH */
  75. #define endfor_nexthops(fi) }
  76. const struct fib_prop fib_props[RTN_MAX + 1] = {
  77. [RTN_UNSPEC] = {
  78. .error = 0,
  79. .scope = RT_SCOPE_NOWHERE,
  80. },
  81. [RTN_UNICAST] = {
  82. .error = 0,
  83. .scope = RT_SCOPE_UNIVERSE,
  84. },
  85. [RTN_LOCAL] = {
  86. .error = 0,
  87. .scope = RT_SCOPE_HOST,
  88. },
  89. [RTN_BROADCAST] = {
  90. .error = 0,
  91. .scope = RT_SCOPE_LINK,
  92. },
  93. [RTN_ANYCAST] = {
  94. .error = 0,
  95. .scope = RT_SCOPE_LINK,
  96. },
  97. [RTN_MULTICAST] = {
  98. .error = 0,
  99. .scope = RT_SCOPE_UNIVERSE,
  100. },
  101. [RTN_BLACKHOLE] = {
  102. .error = -EINVAL,
  103. .scope = RT_SCOPE_UNIVERSE,
  104. },
  105. [RTN_UNREACHABLE] = {
  106. .error = -EHOSTUNREACH,
  107. .scope = RT_SCOPE_UNIVERSE,
  108. },
  109. [RTN_PROHIBIT] = {
  110. .error = -EACCES,
  111. .scope = RT_SCOPE_UNIVERSE,
  112. },
  113. [RTN_THROW] = {
  114. .error = -EAGAIN,
  115. .scope = RT_SCOPE_UNIVERSE,
  116. },
  117. [RTN_NAT] = {
  118. .error = -EINVAL,
  119. .scope = RT_SCOPE_NOWHERE,
  120. },
  121. [RTN_XRESOLVE] = {
  122. .error = -EINVAL,
  123. .scope = RT_SCOPE_NOWHERE,
  124. },
  125. };
  126. static void rt_fibinfo_free(struct rtable __rcu **rtp)
  127. {
  128. struct rtable *rt = rcu_dereference_protected(*rtp, 1);
  129. if (!rt)
  130. return;
  131. /* Not even needed : RCU_INIT_POINTER(*rtp, NULL);
  132. * because we waited an RCU grace period before calling
  133. * free_fib_info_rcu()
  134. */
  135. dst_free(&rt->dst);
  136. }
  137. static void free_nh_exceptions(struct fib_nh *nh)
  138. {
  139. struct fnhe_hash_bucket *hash;
  140. int i;
  141. hash = rcu_dereference_protected(nh->nh_exceptions, 1);
  142. if (!hash)
  143. return;
  144. for (i = 0; i < FNHE_HASH_SIZE; i++) {
  145. struct fib_nh_exception *fnhe;
  146. fnhe = rcu_dereference_protected(hash[i].chain, 1);
  147. while (fnhe) {
  148. struct fib_nh_exception *next;
  149. next = rcu_dereference_protected(fnhe->fnhe_next, 1);
  150. rt_fibinfo_free(&fnhe->fnhe_rth_input);
  151. rt_fibinfo_free(&fnhe->fnhe_rth_output);
  152. kfree(fnhe);
  153. fnhe = next;
  154. }
  155. }
  156. kfree(hash);
  157. }
  158. static void rt_fibinfo_free_cpus(struct rtable __rcu * __percpu *rtp)
  159. {
  160. int cpu;
  161. if (!rtp)
  162. return;
  163. for_each_possible_cpu(cpu) {
  164. struct rtable *rt;
  165. rt = rcu_dereference_protected(*per_cpu_ptr(rtp, cpu), 1);
  166. if (rt)
  167. dst_free(&rt->dst);
  168. }
  169. free_percpu(rtp);
  170. }
  171. /* Release a nexthop info record */
  172. static void free_fib_info_rcu(struct rcu_head *head)
  173. {
  174. struct fib_info *fi = container_of(head, struct fib_info, rcu);
  175. change_nexthops(fi) {
  176. if (nexthop_nh->nh_dev)
  177. dev_put(nexthop_nh->nh_dev);
  178. lwtstate_put(nexthop_nh->nh_lwtstate);
  179. free_nh_exceptions(nexthop_nh);
  180. rt_fibinfo_free_cpus(nexthop_nh->nh_pcpu_rth_output);
  181. rt_fibinfo_free(&nexthop_nh->nh_rth_input);
  182. } endfor_nexthops(fi);
  183. if (fi->fib_metrics != (u32 *) dst_default_metrics)
  184. kfree(fi->fib_metrics);
  185. kfree(fi);
  186. }
  187. void free_fib_info(struct fib_info *fi)
  188. {
  189. if (fi->fib_dead == 0) {
  190. pr_warn("Freeing alive fib_info %p\n", fi);
  191. return;
  192. }
  193. fib_info_cnt--;
  194. #ifdef CONFIG_IP_ROUTE_CLASSID
  195. change_nexthops(fi) {
  196. if (nexthop_nh->nh_tclassid)
  197. fi->fib_net->ipv4.fib_num_tclassid_users--;
  198. } endfor_nexthops(fi);
  199. #endif
  200. call_rcu(&fi->rcu, free_fib_info_rcu);
  201. }
  202. void fib_release_info(struct fib_info *fi)
  203. {
  204. spin_lock_bh(&fib_info_lock);
  205. if (fi && --fi->fib_treeref == 0) {
  206. hlist_del(&fi->fib_hash);
  207. if (fi->fib_prefsrc)
  208. hlist_del(&fi->fib_lhash);
  209. change_nexthops(fi) {
  210. if (!nexthop_nh->nh_dev)
  211. continue;
  212. hlist_del(&nexthop_nh->nh_hash);
  213. } endfor_nexthops(fi)
  214. fi->fib_dead = 1;
  215. fib_info_put(fi);
  216. }
  217. spin_unlock_bh(&fib_info_lock);
  218. }
  219. static inline int nh_comp(const struct fib_info *fi, const struct fib_info *ofi)
  220. {
  221. const struct fib_nh *onh = ofi->fib_nh;
  222. for_nexthops(fi) {
  223. if (nh->nh_oif != onh->nh_oif ||
  224. nh->nh_gw != onh->nh_gw ||
  225. nh->nh_scope != onh->nh_scope ||
  226. #ifdef CONFIG_IP_ROUTE_MULTIPATH
  227. nh->nh_weight != onh->nh_weight ||
  228. #endif
  229. #ifdef CONFIG_IP_ROUTE_CLASSID
  230. nh->nh_tclassid != onh->nh_tclassid ||
  231. #endif
  232. lwtunnel_cmp_encap(nh->nh_lwtstate, onh->nh_lwtstate) ||
  233. ((nh->nh_flags ^ onh->nh_flags) & ~RTNH_COMPARE_MASK))
  234. return -1;
  235. onh++;
  236. } endfor_nexthops(fi);
  237. return 0;
  238. }
  239. static inline unsigned int fib_devindex_hashfn(unsigned int val)
  240. {
  241. unsigned int mask = DEVINDEX_HASHSIZE - 1;
  242. return (val ^
  243. (val >> DEVINDEX_HASHBITS) ^
  244. (val >> (DEVINDEX_HASHBITS * 2))) & mask;
  245. }
  246. static inline unsigned int fib_info_hashfn(const struct fib_info *fi)
  247. {
  248. unsigned int mask = (fib_info_hash_size - 1);
  249. unsigned int val = fi->fib_nhs;
  250. val ^= (fi->fib_protocol << 8) | fi->fib_scope;
  251. val ^= (__force u32)fi->fib_prefsrc;
  252. val ^= fi->fib_priority;
  253. for_nexthops(fi) {
  254. val ^= fib_devindex_hashfn(nh->nh_oif);
  255. } endfor_nexthops(fi)
  256. return (val ^ (val >> 7) ^ (val >> 12)) & mask;
  257. }
  258. static struct fib_info *fib_find_info(const struct fib_info *nfi)
  259. {
  260. struct hlist_head *head;
  261. struct fib_info *fi;
  262. unsigned int hash;
  263. hash = fib_info_hashfn(nfi);
  264. head = &fib_info_hash[hash];
  265. hlist_for_each_entry(fi, head, fib_hash) {
  266. if (!net_eq(fi->fib_net, nfi->fib_net))
  267. continue;
  268. if (fi->fib_nhs != nfi->fib_nhs)
  269. continue;
  270. if (nfi->fib_protocol == fi->fib_protocol &&
  271. nfi->fib_scope == fi->fib_scope &&
  272. nfi->fib_prefsrc == fi->fib_prefsrc &&
  273. nfi->fib_priority == fi->fib_priority &&
  274. nfi->fib_type == fi->fib_type &&
  275. memcmp(nfi->fib_metrics, fi->fib_metrics,
  276. sizeof(u32) * RTAX_MAX) == 0 &&
  277. !((nfi->fib_flags ^ fi->fib_flags) & ~RTNH_COMPARE_MASK) &&
  278. (nfi->fib_nhs == 0 || nh_comp(fi, nfi) == 0))
  279. return fi;
  280. }
  281. return NULL;
  282. }
  283. /* Check, that the gateway is already configured.
  284. * Used only by redirect accept routine.
  285. */
  286. int ip_fib_check_default(__be32 gw, struct net_device *dev)
  287. {
  288. struct hlist_head *head;
  289. struct fib_nh *nh;
  290. unsigned int hash;
  291. spin_lock(&fib_info_lock);
  292. hash = fib_devindex_hashfn(dev->ifindex);
  293. head = &fib_info_devhash[hash];
  294. hlist_for_each_entry(nh, head, nh_hash) {
  295. if (nh->nh_dev == dev &&
  296. nh->nh_gw == gw &&
  297. !(nh->nh_flags & RTNH_F_DEAD)) {
  298. spin_unlock(&fib_info_lock);
  299. return 0;
  300. }
  301. }
  302. spin_unlock(&fib_info_lock);
  303. return -1;
  304. }
  305. static inline size_t fib_nlmsg_size(struct fib_info *fi)
  306. {
  307. size_t payload = NLMSG_ALIGN(sizeof(struct rtmsg))
  308. + nla_total_size(4) /* RTA_TABLE */
  309. + nla_total_size(4) /* RTA_DST */
  310. + nla_total_size(4) /* RTA_PRIORITY */
  311. + nla_total_size(4) /* RTA_PREFSRC */
  312. + nla_total_size(TCP_CA_NAME_MAX); /* RTAX_CC_ALGO */
  313. /* space for nested metrics */
  314. payload += nla_total_size((RTAX_MAX * nla_total_size(4)));
  315. if (fi->fib_nhs) {
  316. size_t nh_encapsize = 0;
  317. /* Also handles the special case fib_nhs == 1 */
  318. /* each nexthop is packed in an attribute */
  319. size_t nhsize = nla_total_size(sizeof(struct rtnexthop));
  320. /* may contain flow and gateway attribute */
  321. nhsize += 2 * nla_total_size(4);
  322. /* grab encap info */
  323. for_nexthops(fi) {
  324. if (nh->nh_lwtstate) {
  325. /* RTA_ENCAP_TYPE */
  326. nh_encapsize += lwtunnel_get_encap_size(
  327. nh->nh_lwtstate);
  328. /* RTA_ENCAP */
  329. nh_encapsize += nla_total_size(2);
  330. }
  331. } endfor_nexthops(fi);
  332. /* all nexthops are packed in a nested attribute */
  333. payload += nla_total_size((fi->fib_nhs * nhsize) +
  334. nh_encapsize);
  335. }
  336. return payload;
  337. }
  338. void rtmsg_fib(int event, __be32 key, struct fib_alias *fa,
  339. int dst_len, u32 tb_id, const struct nl_info *info,
  340. unsigned int nlm_flags)
  341. {
  342. struct sk_buff *skb;
  343. u32 seq = info->nlh ? info->nlh->nlmsg_seq : 0;
  344. int err = -ENOBUFS;
  345. skb = nlmsg_new(fib_nlmsg_size(fa->fa_info), GFP_KERNEL);
  346. if (!skb)
  347. goto errout;
  348. err = fib_dump_info(skb, info->portid, seq, event, tb_id,
  349. fa->fa_type, key, dst_len,
  350. fa->fa_tos, fa->fa_info, nlm_flags);
  351. if (err < 0) {
  352. /* -EMSGSIZE implies BUG in fib_nlmsg_size() */
  353. WARN_ON(err == -EMSGSIZE);
  354. kfree_skb(skb);
  355. goto errout;
  356. }
  357. rtnl_notify(skb, info->nl_net, info->portid, RTNLGRP_IPV4_ROUTE,
  358. info->nlh, GFP_KERNEL);
  359. return;
  360. errout:
  361. if (err < 0)
  362. rtnl_set_sk_err(info->nl_net, RTNLGRP_IPV4_ROUTE, err);
  363. }
  364. static int fib_detect_death(struct fib_info *fi, int order,
  365. struct fib_info **last_resort, int *last_idx,
  366. int dflt)
  367. {
  368. struct neighbour *n;
  369. int state = NUD_NONE;
  370. n = neigh_lookup(&arp_tbl, &fi->fib_nh[0].nh_gw, fi->fib_dev);
  371. if (n) {
  372. state = n->nud_state;
  373. neigh_release(n);
  374. } else {
  375. return 0;
  376. }
  377. if (state == NUD_REACHABLE)
  378. return 0;
  379. if ((state & NUD_VALID) && order != dflt)
  380. return 0;
  381. if ((state & NUD_VALID) ||
  382. (*last_idx < 0 && order > dflt && state != NUD_INCOMPLETE)) {
  383. *last_resort = fi;
  384. *last_idx = order;
  385. }
  386. return 1;
  387. }
  388. #ifdef CONFIG_IP_ROUTE_MULTIPATH
  389. static int fib_count_nexthops(struct rtnexthop *rtnh, int remaining)
  390. {
  391. int nhs = 0;
  392. while (rtnh_ok(rtnh, remaining)) {
  393. nhs++;
  394. rtnh = rtnh_next(rtnh, &remaining);
  395. }
  396. /* leftover implies invalid nexthop configuration, discard it */
  397. return remaining > 0 ? 0 : nhs;
  398. }
  399. static int fib_get_nhs(struct fib_info *fi, struct rtnexthop *rtnh,
  400. int remaining, struct fib_config *cfg)
  401. {
  402. struct net *net = cfg->fc_nlinfo.nl_net;
  403. int ret;
  404. change_nexthops(fi) {
  405. int attrlen;
  406. if (!rtnh_ok(rtnh, remaining))
  407. return -EINVAL;
  408. nexthop_nh->nh_flags =
  409. (cfg->fc_flags & ~0xFF) | rtnh->rtnh_flags;
  410. nexthop_nh->nh_oif = rtnh->rtnh_ifindex;
  411. nexthop_nh->nh_weight = rtnh->rtnh_hops + 1;
  412. attrlen = rtnh_attrlen(rtnh);
  413. if (attrlen > 0) {
  414. struct nlattr *nla, *attrs = rtnh_attrs(rtnh);
  415. nla = nla_find(attrs, attrlen, RTA_GATEWAY);
  416. nexthop_nh->nh_gw = nla ? nla_get_in_addr(nla) : 0;
  417. #ifdef CONFIG_IP_ROUTE_CLASSID
  418. nla = nla_find(attrs, attrlen, RTA_FLOW);
  419. nexthop_nh->nh_tclassid = nla ? nla_get_u32(nla) : 0;
  420. if (nexthop_nh->nh_tclassid)
  421. fi->fib_net->ipv4.fib_num_tclassid_users++;
  422. #endif
  423. nla = nla_find(attrs, attrlen, RTA_ENCAP);
  424. if (nla) {
  425. struct lwtunnel_state *lwtstate;
  426. struct net_device *dev = NULL;
  427. struct nlattr *nla_entype;
  428. nla_entype = nla_find(attrs, attrlen,
  429. RTA_ENCAP_TYPE);
  430. if (!nla_entype)
  431. goto err_inval;
  432. if (cfg->fc_oif)
  433. dev = __dev_get_by_index(net, cfg->fc_oif);
  434. ret = lwtunnel_build_state(dev, nla_get_u16(
  435. nla_entype),
  436. nla, AF_INET, cfg,
  437. &lwtstate);
  438. if (ret)
  439. goto errout;
  440. nexthop_nh->nh_lwtstate =
  441. lwtstate_get(lwtstate);
  442. }
  443. }
  444. rtnh = rtnh_next(rtnh, &remaining);
  445. } endfor_nexthops(fi);
  446. return 0;
  447. err_inval:
  448. ret = -EINVAL;
  449. errout:
  450. return ret;
  451. }
  452. #endif
  453. static int fib_encap_match(struct net *net, u16 encap_type,
  454. struct nlattr *encap,
  455. int oif, const struct fib_nh *nh,
  456. const struct fib_config *cfg)
  457. {
  458. struct lwtunnel_state *lwtstate;
  459. struct net_device *dev = NULL;
  460. int ret, result = 0;
  461. if (encap_type == LWTUNNEL_ENCAP_NONE)
  462. return 0;
  463. if (oif)
  464. dev = __dev_get_by_index(net, oif);
  465. ret = lwtunnel_build_state(dev, encap_type, encap,
  466. AF_INET, cfg, &lwtstate);
  467. if (!ret) {
  468. result = lwtunnel_cmp_encap(lwtstate, nh->nh_lwtstate);
  469. lwtstate_free(lwtstate);
  470. }
  471. return result;
  472. }
  473. int fib_nh_match(struct fib_config *cfg, struct fib_info *fi)
  474. {
  475. struct net *net = cfg->fc_nlinfo.nl_net;
  476. #ifdef CONFIG_IP_ROUTE_MULTIPATH
  477. struct rtnexthop *rtnh;
  478. int remaining;
  479. #endif
  480. if (cfg->fc_priority && cfg->fc_priority != fi->fib_priority)
  481. return 1;
  482. if (cfg->fc_oif || cfg->fc_gw) {
  483. if (cfg->fc_encap) {
  484. if (fib_encap_match(net, cfg->fc_encap_type,
  485. cfg->fc_encap, cfg->fc_oif,
  486. fi->fib_nh, cfg))
  487. return 1;
  488. }
  489. if ((!cfg->fc_oif || cfg->fc_oif == fi->fib_nh->nh_oif) &&
  490. (!cfg->fc_gw || cfg->fc_gw == fi->fib_nh->nh_gw))
  491. return 0;
  492. return 1;
  493. }
  494. #ifdef CONFIG_IP_ROUTE_MULTIPATH
  495. if (!cfg->fc_mp)
  496. return 0;
  497. rtnh = cfg->fc_mp;
  498. remaining = cfg->fc_mp_len;
  499. for_nexthops(fi) {
  500. int attrlen;
  501. if (!rtnh_ok(rtnh, remaining))
  502. return -EINVAL;
  503. if (rtnh->rtnh_ifindex && rtnh->rtnh_ifindex != nh->nh_oif)
  504. return 1;
  505. attrlen = rtnh_attrlen(rtnh);
  506. if (attrlen > 0) {
  507. struct nlattr *nla, *attrs = rtnh_attrs(rtnh);
  508. nla = nla_find(attrs, attrlen, RTA_GATEWAY);
  509. if (nla && nla_get_in_addr(nla) != nh->nh_gw)
  510. return 1;
  511. #ifdef CONFIG_IP_ROUTE_CLASSID
  512. nla = nla_find(attrs, attrlen, RTA_FLOW);
  513. if (nla && nla_get_u32(nla) != nh->nh_tclassid)
  514. return 1;
  515. #endif
  516. }
  517. rtnh = rtnh_next(rtnh, &remaining);
  518. } endfor_nexthops(fi);
  519. #endif
  520. return 0;
  521. }
  522. /*
  523. * Picture
  524. * -------
  525. *
  526. * Semantics of nexthop is very messy by historical reasons.
  527. * We have to take into account, that:
  528. * a) gateway can be actually local interface address,
  529. * so that gatewayed route is direct.
  530. * b) gateway must be on-link address, possibly
  531. * described not by an ifaddr, but also by a direct route.
  532. * c) If both gateway and interface are specified, they should not
  533. * contradict.
  534. * d) If we use tunnel routes, gateway could be not on-link.
  535. *
  536. * Attempt to reconcile all of these (alas, self-contradictory) conditions
  537. * results in pretty ugly and hairy code with obscure logic.
  538. *
  539. * I chose to generalized it instead, so that the size
  540. * of code does not increase practically, but it becomes
  541. * much more general.
  542. * Every prefix is assigned a "scope" value: "host" is local address,
  543. * "link" is direct route,
  544. * [ ... "site" ... "interior" ... ]
  545. * and "universe" is true gateway route with global meaning.
  546. *
  547. * Every prefix refers to a set of "nexthop"s (gw, oif),
  548. * where gw must have narrower scope. This recursion stops
  549. * when gw has LOCAL scope or if "nexthop" is declared ONLINK,
  550. * which means that gw is forced to be on link.
  551. *
  552. * Code is still hairy, but now it is apparently logically
  553. * consistent and very flexible. F.e. as by-product it allows
  554. * to co-exists in peace independent exterior and interior
  555. * routing processes.
  556. *
  557. * Normally it looks as following.
  558. *
  559. * {universe prefix} -> (gw, oif) [scope link]
  560. * |
  561. * |-> {link prefix} -> (gw, oif) [scope local]
  562. * |
  563. * |-> {local prefix} (terminal node)
  564. */
  565. static int fib_check_nh(struct fib_config *cfg, struct fib_info *fi,
  566. struct fib_nh *nh)
  567. {
  568. int err = 0;
  569. struct net *net;
  570. struct net_device *dev;
  571. net = cfg->fc_nlinfo.nl_net;
  572. if (nh->nh_gw) {
  573. struct fib_result res;
  574. if (nh->nh_flags & RTNH_F_ONLINK) {
  575. unsigned int addr_type;
  576. if (cfg->fc_scope >= RT_SCOPE_LINK)
  577. return -EINVAL;
  578. dev = __dev_get_by_index(net, nh->nh_oif);
  579. if (!dev)
  580. return -ENODEV;
  581. if (!(dev->flags & IFF_UP))
  582. return -ENETDOWN;
  583. addr_type = inet_addr_type_dev_table(net, dev, nh->nh_gw);
  584. if (addr_type != RTN_UNICAST)
  585. return -EINVAL;
  586. if (!netif_carrier_ok(dev))
  587. nh->nh_flags |= RTNH_F_LINKDOWN;
  588. nh->nh_dev = dev;
  589. dev_hold(dev);
  590. nh->nh_scope = RT_SCOPE_LINK;
  591. return 0;
  592. }
  593. rcu_read_lock();
  594. {
  595. struct fib_table *tbl = NULL;
  596. struct flowi4 fl4 = {
  597. .daddr = nh->nh_gw,
  598. .flowi4_scope = cfg->fc_scope + 1,
  599. .flowi4_oif = nh->nh_oif,
  600. .flowi4_iif = LOOPBACK_IFINDEX,
  601. };
  602. /* It is not necessary, but requires a bit of thinking */
  603. if (fl4.flowi4_scope < RT_SCOPE_LINK)
  604. fl4.flowi4_scope = RT_SCOPE_LINK;
  605. if (cfg->fc_table)
  606. tbl = fib_get_table(net, cfg->fc_table);
  607. if (tbl)
  608. err = fib_table_lookup(tbl, &fl4, &res,
  609. FIB_LOOKUP_IGNORE_LINKSTATE |
  610. FIB_LOOKUP_NOREF);
  611. /* on error or if no table given do full lookup. This
  612. * is needed for example when nexthops are in the local
  613. * table rather than the given table
  614. */
  615. if (!tbl || err) {
  616. err = fib_lookup(net, &fl4, &res,
  617. FIB_LOOKUP_IGNORE_LINKSTATE);
  618. }
  619. if (err) {
  620. rcu_read_unlock();
  621. return err;
  622. }
  623. }
  624. err = -EINVAL;
  625. if (res.type != RTN_UNICAST && res.type != RTN_LOCAL)
  626. goto out;
  627. nh->nh_scope = res.scope;
  628. nh->nh_oif = FIB_RES_OIF(res);
  629. nh->nh_dev = dev = FIB_RES_DEV(res);
  630. if (!dev)
  631. goto out;
  632. dev_hold(dev);
  633. if (!netif_carrier_ok(dev))
  634. nh->nh_flags |= RTNH_F_LINKDOWN;
  635. err = (dev->flags & IFF_UP) ? 0 : -ENETDOWN;
  636. } else {
  637. struct in_device *in_dev;
  638. if (nh->nh_flags & (RTNH_F_PERVASIVE | RTNH_F_ONLINK))
  639. return -EINVAL;
  640. rcu_read_lock();
  641. err = -ENODEV;
  642. in_dev = inetdev_by_index(net, nh->nh_oif);
  643. if (!in_dev)
  644. goto out;
  645. err = -ENETDOWN;
  646. if (!(in_dev->dev->flags & IFF_UP))
  647. goto out;
  648. nh->nh_dev = in_dev->dev;
  649. dev_hold(nh->nh_dev);
  650. nh->nh_scope = RT_SCOPE_HOST;
  651. if (!netif_carrier_ok(nh->nh_dev))
  652. nh->nh_flags |= RTNH_F_LINKDOWN;
  653. err = 0;
  654. }
  655. out:
  656. rcu_read_unlock();
  657. return err;
  658. }
  659. static inline unsigned int fib_laddr_hashfn(__be32 val)
  660. {
  661. unsigned int mask = (fib_info_hash_size - 1);
  662. return ((__force u32)val ^
  663. ((__force u32)val >> 7) ^
  664. ((__force u32)val >> 14)) & mask;
  665. }
  666. static struct hlist_head *fib_info_hash_alloc(int bytes)
  667. {
  668. if (bytes <= PAGE_SIZE)
  669. return kzalloc(bytes, GFP_KERNEL);
  670. else
  671. return (struct hlist_head *)
  672. __get_free_pages(GFP_KERNEL | __GFP_ZERO,
  673. get_order(bytes));
  674. }
  675. static void fib_info_hash_free(struct hlist_head *hash, int bytes)
  676. {
  677. if (!hash)
  678. return;
  679. if (bytes <= PAGE_SIZE)
  680. kfree(hash);
  681. else
  682. free_pages((unsigned long) hash, get_order(bytes));
  683. }
  684. static void fib_info_hash_move(struct hlist_head *new_info_hash,
  685. struct hlist_head *new_laddrhash,
  686. unsigned int new_size)
  687. {
  688. struct hlist_head *old_info_hash, *old_laddrhash;
  689. unsigned int old_size = fib_info_hash_size;
  690. unsigned int i, bytes;
  691. spin_lock_bh(&fib_info_lock);
  692. old_info_hash = fib_info_hash;
  693. old_laddrhash = fib_info_laddrhash;
  694. fib_info_hash_size = new_size;
  695. for (i = 0; i < old_size; i++) {
  696. struct hlist_head *head = &fib_info_hash[i];
  697. struct hlist_node *n;
  698. struct fib_info *fi;
  699. hlist_for_each_entry_safe(fi, n, head, fib_hash) {
  700. struct hlist_head *dest;
  701. unsigned int new_hash;
  702. new_hash = fib_info_hashfn(fi);
  703. dest = &new_info_hash[new_hash];
  704. hlist_add_head(&fi->fib_hash, dest);
  705. }
  706. }
  707. fib_info_hash = new_info_hash;
  708. for (i = 0; i < old_size; i++) {
  709. struct hlist_head *lhead = &fib_info_laddrhash[i];
  710. struct hlist_node *n;
  711. struct fib_info *fi;
  712. hlist_for_each_entry_safe(fi, n, lhead, fib_lhash) {
  713. struct hlist_head *ldest;
  714. unsigned int new_hash;
  715. new_hash = fib_laddr_hashfn(fi->fib_prefsrc);
  716. ldest = &new_laddrhash[new_hash];
  717. hlist_add_head(&fi->fib_lhash, ldest);
  718. }
  719. }
  720. fib_info_laddrhash = new_laddrhash;
  721. spin_unlock_bh(&fib_info_lock);
  722. bytes = old_size * sizeof(struct hlist_head *);
  723. fib_info_hash_free(old_info_hash, bytes);
  724. fib_info_hash_free(old_laddrhash, bytes);
  725. }
  726. __be32 fib_info_update_nh_saddr(struct net *net, struct fib_nh *nh)
  727. {
  728. nh->nh_saddr = inet_select_addr(nh->nh_dev,
  729. nh->nh_gw,
  730. nh->nh_parent->fib_scope);
  731. nh->nh_saddr_genid = atomic_read(&net->ipv4.dev_addr_genid);
  732. return nh->nh_saddr;
  733. }
  734. static bool fib_valid_prefsrc(struct fib_config *cfg, __be32 fib_prefsrc)
  735. {
  736. if (cfg->fc_type != RTN_LOCAL || !cfg->fc_dst ||
  737. fib_prefsrc != cfg->fc_dst) {
  738. u32 tb_id = cfg->fc_table;
  739. if (tb_id == RT_TABLE_MAIN)
  740. tb_id = RT_TABLE_LOCAL;
  741. if (inet_addr_type_table(cfg->fc_nlinfo.nl_net,
  742. fib_prefsrc, tb_id) != RTN_LOCAL) {
  743. return false;
  744. }
  745. }
  746. return true;
  747. }
  748. static int
  749. fib_convert_metrics(struct fib_info *fi, const struct fib_config *cfg)
  750. {
  751. bool ecn_ca = false;
  752. struct nlattr *nla;
  753. int remaining;
  754. if (!cfg->fc_mx)
  755. return 0;
  756. nla_for_each_attr(nla, cfg->fc_mx, cfg->fc_mx_len, remaining) {
  757. int type = nla_type(nla);
  758. u32 val;
  759. if (!type)
  760. continue;
  761. if (type > RTAX_MAX)
  762. return -EINVAL;
  763. if (type == RTAX_CC_ALGO) {
  764. char tmp[TCP_CA_NAME_MAX];
  765. nla_strlcpy(tmp, nla, sizeof(tmp));
  766. val = tcp_ca_get_key_by_name(tmp, &ecn_ca);
  767. if (val == TCP_CA_UNSPEC)
  768. return -EINVAL;
  769. } else {
  770. val = nla_get_u32(nla);
  771. }
  772. if (type == RTAX_ADVMSS && val > 65535 - 40)
  773. val = 65535 - 40;
  774. if (type == RTAX_MTU && val > 65535 - 15)
  775. val = 65535 - 15;
  776. if (type == RTAX_FEATURES && (val & ~RTAX_FEATURE_MASK))
  777. return -EINVAL;
  778. fi->fib_metrics[type - 1] = val;
  779. }
  780. if (ecn_ca)
  781. fi->fib_metrics[RTAX_FEATURES - 1] |= DST_FEATURE_ECN_CA;
  782. return 0;
  783. }
  784. struct fib_info *fib_create_info(struct fib_config *cfg)
  785. {
  786. int err;
  787. struct fib_info *fi = NULL;
  788. struct fib_info *ofi;
  789. int nhs = 1;
  790. struct net *net = cfg->fc_nlinfo.nl_net;
  791. if (cfg->fc_type > RTN_MAX)
  792. goto err_inval;
  793. /* Fast check to catch the most weird cases */
  794. if (fib_props[cfg->fc_type].scope > cfg->fc_scope)
  795. goto err_inval;
  796. #ifdef CONFIG_IP_ROUTE_MULTIPATH
  797. if (cfg->fc_mp) {
  798. nhs = fib_count_nexthops(cfg->fc_mp, cfg->fc_mp_len);
  799. if (nhs == 0)
  800. goto err_inval;
  801. }
  802. #endif
  803. err = -ENOBUFS;
  804. if (fib_info_cnt >= fib_info_hash_size) {
  805. unsigned int new_size = fib_info_hash_size << 1;
  806. struct hlist_head *new_info_hash;
  807. struct hlist_head *new_laddrhash;
  808. unsigned int bytes;
  809. if (!new_size)
  810. new_size = 16;
  811. bytes = new_size * sizeof(struct hlist_head *);
  812. new_info_hash = fib_info_hash_alloc(bytes);
  813. new_laddrhash = fib_info_hash_alloc(bytes);
  814. if (!new_info_hash || !new_laddrhash) {
  815. fib_info_hash_free(new_info_hash, bytes);
  816. fib_info_hash_free(new_laddrhash, bytes);
  817. } else
  818. fib_info_hash_move(new_info_hash, new_laddrhash, new_size);
  819. if (!fib_info_hash_size)
  820. goto failure;
  821. }
  822. fi = kzalloc(sizeof(*fi)+nhs*sizeof(struct fib_nh), GFP_KERNEL);
  823. if (!fi)
  824. goto failure;
  825. fib_info_cnt++;
  826. if (cfg->fc_mx) {
  827. fi->fib_metrics = kzalloc(sizeof(u32) * RTAX_MAX, GFP_KERNEL);
  828. if (!fi->fib_metrics)
  829. goto failure;
  830. } else
  831. fi->fib_metrics = (u32 *) dst_default_metrics;
  832. fi->fib_net = net;
  833. fi->fib_protocol = cfg->fc_protocol;
  834. fi->fib_scope = cfg->fc_scope;
  835. fi->fib_flags = cfg->fc_flags;
  836. fi->fib_priority = cfg->fc_priority;
  837. fi->fib_prefsrc = cfg->fc_prefsrc;
  838. fi->fib_type = cfg->fc_type;
  839. fi->fib_nhs = nhs;
  840. change_nexthops(fi) {
  841. nexthop_nh->nh_parent = fi;
  842. nexthop_nh->nh_pcpu_rth_output = alloc_percpu(struct rtable __rcu *);
  843. if (!nexthop_nh->nh_pcpu_rth_output)
  844. goto failure;
  845. } endfor_nexthops(fi)
  846. err = fib_convert_metrics(fi, cfg);
  847. if (err)
  848. goto failure;
  849. if (cfg->fc_mp) {
  850. #ifdef CONFIG_IP_ROUTE_MULTIPATH
  851. err = fib_get_nhs(fi, cfg->fc_mp, cfg->fc_mp_len, cfg);
  852. if (err != 0)
  853. goto failure;
  854. if (cfg->fc_oif && fi->fib_nh->nh_oif != cfg->fc_oif)
  855. goto err_inval;
  856. if (cfg->fc_gw && fi->fib_nh->nh_gw != cfg->fc_gw)
  857. goto err_inval;
  858. #ifdef CONFIG_IP_ROUTE_CLASSID
  859. if (cfg->fc_flow && fi->fib_nh->nh_tclassid != cfg->fc_flow)
  860. goto err_inval;
  861. #endif
  862. #else
  863. goto err_inval;
  864. #endif
  865. } else {
  866. struct fib_nh *nh = fi->fib_nh;
  867. if (cfg->fc_encap) {
  868. struct lwtunnel_state *lwtstate;
  869. struct net_device *dev = NULL;
  870. if (cfg->fc_encap_type == LWTUNNEL_ENCAP_NONE)
  871. goto err_inval;
  872. if (cfg->fc_oif)
  873. dev = __dev_get_by_index(net, cfg->fc_oif);
  874. err = lwtunnel_build_state(dev, cfg->fc_encap_type,
  875. cfg->fc_encap, AF_INET, cfg,
  876. &lwtstate);
  877. if (err)
  878. goto failure;
  879. nh->nh_lwtstate = lwtstate_get(lwtstate);
  880. }
  881. nh->nh_oif = cfg->fc_oif;
  882. nh->nh_gw = cfg->fc_gw;
  883. nh->nh_flags = cfg->fc_flags;
  884. #ifdef CONFIG_IP_ROUTE_CLASSID
  885. nh->nh_tclassid = cfg->fc_flow;
  886. if (nh->nh_tclassid)
  887. fi->fib_net->ipv4.fib_num_tclassid_users++;
  888. #endif
  889. #ifdef CONFIG_IP_ROUTE_MULTIPATH
  890. nh->nh_weight = 1;
  891. #endif
  892. }
  893. if (fib_props[cfg->fc_type].error) {
  894. if (cfg->fc_gw || cfg->fc_oif || cfg->fc_mp)
  895. goto err_inval;
  896. goto link_it;
  897. } else {
  898. switch (cfg->fc_type) {
  899. case RTN_UNICAST:
  900. case RTN_LOCAL:
  901. case RTN_BROADCAST:
  902. case RTN_ANYCAST:
  903. case RTN_MULTICAST:
  904. break;
  905. default:
  906. goto err_inval;
  907. }
  908. }
  909. if (cfg->fc_scope > RT_SCOPE_HOST)
  910. goto err_inval;
  911. if (cfg->fc_scope == RT_SCOPE_HOST) {
  912. struct fib_nh *nh = fi->fib_nh;
  913. /* Local address is added. */
  914. if (nhs != 1 || nh->nh_gw)
  915. goto err_inval;
  916. nh->nh_scope = RT_SCOPE_NOWHERE;
  917. nh->nh_dev = dev_get_by_index(net, fi->fib_nh->nh_oif);
  918. err = -ENODEV;
  919. if (!nh->nh_dev)
  920. goto failure;
  921. } else {
  922. int linkdown = 0;
  923. change_nexthops(fi) {
  924. err = fib_check_nh(cfg, fi, nexthop_nh);
  925. if (err != 0)
  926. goto failure;
  927. if (nexthop_nh->nh_flags & RTNH_F_LINKDOWN)
  928. linkdown++;
  929. } endfor_nexthops(fi)
  930. if (linkdown == fi->fib_nhs)
  931. fi->fib_flags |= RTNH_F_LINKDOWN;
  932. }
  933. if (fi->fib_prefsrc && !fib_valid_prefsrc(cfg, fi->fib_prefsrc))
  934. goto err_inval;
  935. change_nexthops(fi) {
  936. fib_info_update_nh_saddr(net, nexthop_nh);
  937. } endfor_nexthops(fi)
  938. link_it:
  939. ofi = fib_find_info(fi);
  940. if (ofi) {
  941. fi->fib_dead = 1;
  942. free_fib_info(fi);
  943. ofi->fib_treeref++;
  944. return ofi;
  945. }
  946. fi->fib_treeref++;
  947. atomic_inc(&fi->fib_clntref);
  948. spin_lock_bh(&fib_info_lock);
  949. hlist_add_head(&fi->fib_hash,
  950. &fib_info_hash[fib_info_hashfn(fi)]);
  951. if (fi->fib_prefsrc) {
  952. struct hlist_head *head;
  953. head = &fib_info_laddrhash[fib_laddr_hashfn(fi->fib_prefsrc)];
  954. hlist_add_head(&fi->fib_lhash, head);
  955. }
  956. change_nexthops(fi) {
  957. struct hlist_head *head;
  958. unsigned int hash;
  959. if (!nexthop_nh->nh_dev)
  960. continue;
  961. hash = fib_devindex_hashfn(nexthop_nh->nh_dev->ifindex);
  962. head = &fib_info_devhash[hash];
  963. hlist_add_head(&nexthop_nh->nh_hash, head);
  964. } endfor_nexthops(fi)
  965. spin_unlock_bh(&fib_info_lock);
  966. return fi;
  967. err_inval:
  968. err = -EINVAL;
  969. failure:
  970. if (fi) {
  971. fi->fib_dead = 1;
  972. free_fib_info(fi);
  973. }
  974. return ERR_PTR(err);
  975. }
  976. int fib_dump_info(struct sk_buff *skb, u32 portid, u32 seq, int event,
  977. u32 tb_id, u8 type, __be32 dst, int dst_len, u8 tos,
  978. struct fib_info *fi, unsigned int flags)
  979. {
  980. struct nlmsghdr *nlh;
  981. struct rtmsg *rtm;
  982. nlh = nlmsg_put(skb, portid, seq, event, sizeof(*rtm), flags);
  983. if (!nlh)
  984. return -EMSGSIZE;
  985. rtm = nlmsg_data(nlh);
  986. rtm->rtm_family = AF_INET;
  987. rtm->rtm_dst_len = dst_len;
  988. rtm->rtm_src_len = 0;
  989. rtm->rtm_tos = tos;
  990. if (tb_id < 256)
  991. rtm->rtm_table = tb_id;
  992. else
  993. rtm->rtm_table = RT_TABLE_COMPAT;
  994. if (nla_put_u32(skb, RTA_TABLE, tb_id))
  995. goto nla_put_failure;
  996. rtm->rtm_type = type;
  997. rtm->rtm_flags = fi->fib_flags;
  998. rtm->rtm_scope = fi->fib_scope;
  999. rtm->rtm_protocol = fi->fib_protocol;
  1000. if (rtm->rtm_dst_len &&
  1001. nla_put_in_addr(skb, RTA_DST, dst))
  1002. goto nla_put_failure;
  1003. if (fi->fib_priority &&
  1004. nla_put_u32(skb, RTA_PRIORITY, fi->fib_priority))
  1005. goto nla_put_failure;
  1006. if (rtnetlink_put_metrics(skb, fi->fib_metrics) < 0)
  1007. goto nla_put_failure;
  1008. if (fi->fib_prefsrc &&
  1009. nla_put_in_addr(skb, RTA_PREFSRC, fi->fib_prefsrc))
  1010. goto nla_put_failure;
  1011. if (fi->fib_nhs == 1) {
  1012. struct in_device *in_dev;
  1013. if (fi->fib_nh->nh_gw &&
  1014. nla_put_in_addr(skb, RTA_GATEWAY, fi->fib_nh->nh_gw))
  1015. goto nla_put_failure;
  1016. if (fi->fib_nh->nh_oif &&
  1017. nla_put_u32(skb, RTA_OIF, fi->fib_nh->nh_oif))
  1018. goto nla_put_failure;
  1019. if (fi->fib_nh->nh_flags & RTNH_F_LINKDOWN) {
  1020. in_dev = __in_dev_get_rtnl(fi->fib_nh->nh_dev);
  1021. if (in_dev &&
  1022. IN_DEV_IGNORE_ROUTES_WITH_LINKDOWN(in_dev))
  1023. rtm->rtm_flags |= RTNH_F_DEAD;
  1024. }
  1025. #ifdef CONFIG_IP_ROUTE_CLASSID
  1026. if (fi->fib_nh[0].nh_tclassid &&
  1027. nla_put_u32(skb, RTA_FLOW, fi->fib_nh[0].nh_tclassid))
  1028. goto nla_put_failure;
  1029. #endif
  1030. if (fi->fib_nh->nh_lwtstate)
  1031. lwtunnel_fill_encap(skb, fi->fib_nh->nh_lwtstate);
  1032. }
  1033. #ifdef CONFIG_IP_ROUTE_MULTIPATH
  1034. if (fi->fib_nhs > 1) {
  1035. struct rtnexthop *rtnh;
  1036. struct nlattr *mp;
  1037. mp = nla_nest_start(skb, RTA_MULTIPATH);
  1038. if (!mp)
  1039. goto nla_put_failure;
  1040. for_nexthops(fi) {
  1041. struct in_device *in_dev;
  1042. rtnh = nla_reserve_nohdr(skb, sizeof(*rtnh));
  1043. if (!rtnh)
  1044. goto nla_put_failure;
  1045. rtnh->rtnh_flags = nh->nh_flags & 0xFF;
  1046. if (nh->nh_flags & RTNH_F_LINKDOWN) {
  1047. in_dev = __in_dev_get_rtnl(nh->nh_dev);
  1048. if (in_dev &&
  1049. IN_DEV_IGNORE_ROUTES_WITH_LINKDOWN(in_dev))
  1050. rtnh->rtnh_flags |= RTNH_F_DEAD;
  1051. }
  1052. rtnh->rtnh_hops = nh->nh_weight - 1;
  1053. rtnh->rtnh_ifindex = nh->nh_oif;
  1054. if (nh->nh_gw &&
  1055. nla_put_in_addr(skb, RTA_GATEWAY, nh->nh_gw))
  1056. goto nla_put_failure;
  1057. #ifdef CONFIG_IP_ROUTE_CLASSID
  1058. if (nh->nh_tclassid &&
  1059. nla_put_u32(skb, RTA_FLOW, nh->nh_tclassid))
  1060. goto nla_put_failure;
  1061. #endif
  1062. if (nh->nh_lwtstate)
  1063. lwtunnel_fill_encap(skb, nh->nh_lwtstate);
  1064. /* length of rtnetlink header + attributes */
  1065. rtnh->rtnh_len = nlmsg_get_pos(skb) - (void *) rtnh;
  1066. } endfor_nexthops(fi);
  1067. nla_nest_end(skb, mp);
  1068. }
  1069. #endif
  1070. nlmsg_end(skb, nlh);
  1071. return 0;
  1072. nla_put_failure:
  1073. nlmsg_cancel(skb, nlh);
  1074. return -EMSGSIZE;
  1075. }
  1076. /*
  1077. * Update FIB if:
  1078. * - local address disappeared -> we must delete all the entries
  1079. * referring to it.
  1080. * - device went down -> we must shutdown all nexthops going via it.
  1081. */
  1082. int fib_sync_down_addr(struct net *net, __be32 local)
  1083. {
  1084. int ret = 0;
  1085. unsigned int hash = fib_laddr_hashfn(local);
  1086. struct hlist_head *head = &fib_info_laddrhash[hash];
  1087. struct fib_info *fi;
  1088. if (!fib_info_laddrhash || local == 0)
  1089. return 0;
  1090. hlist_for_each_entry(fi, head, fib_lhash) {
  1091. if (!net_eq(fi->fib_net, net))
  1092. continue;
  1093. if (fi->fib_prefsrc == local) {
  1094. fi->fib_flags |= RTNH_F_DEAD;
  1095. ret++;
  1096. }
  1097. }
  1098. return ret;
  1099. }
  1100. int fib_sync_down_dev(struct net_device *dev, unsigned long event)
  1101. {
  1102. int ret = 0;
  1103. int scope = RT_SCOPE_NOWHERE;
  1104. struct fib_info *prev_fi = NULL;
  1105. unsigned int hash = fib_devindex_hashfn(dev->ifindex);
  1106. struct hlist_head *head = &fib_info_devhash[hash];
  1107. struct fib_nh *nh;
  1108. if (event == NETDEV_UNREGISTER ||
  1109. event == NETDEV_DOWN)
  1110. scope = -1;
  1111. hlist_for_each_entry(nh, head, nh_hash) {
  1112. struct fib_info *fi = nh->nh_parent;
  1113. int dead;
  1114. BUG_ON(!fi->fib_nhs);
  1115. if (nh->nh_dev != dev || fi == prev_fi)
  1116. continue;
  1117. prev_fi = fi;
  1118. dead = 0;
  1119. change_nexthops(fi) {
  1120. if (nexthop_nh->nh_flags & RTNH_F_DEAD)
  1121. dead++;
  1122. else if (nexthop_nh->nh_dev == dev &&
  1123. nexthop_nh->nh_scope != scope) {
  1124. switch (event) {
  1125. case NETDEV_DOWN:
  1126. case NETDEV_UNREGISTER:
  1127. nexthop_nh->nh_flags |= RTNH_F_DEAD;
  1128. /* fall through */
  1129. case NETDEV_CHANGE:
  1130. nexthop_nh->nh_flags |= RTNH_F_LINKDOWN;
  1131. break;
  1132. }
  1133. #ifdef CONFIG_IP_ROUTE_MULTIPATH
  1134. spin_lock_bh(&fib_multipath_lock);
  1135. fi->fib_power -= nexthop_nh->nh_power;
  1136. nexthop_nh->nh_power = 0;
  1137. spin_unlock_bh(&fib_multipath_lock);
  1138. #endif
  1139. dead++;
  1140. }
  1141. #ifdef CONFIG_IP_ROUTE_MULTIPATH
  1142. if (event == NETDEV_UNREGISTER &&
  1143. nexthop_nh->nh_dev == dev) {
  1144. dead = fi->fib_nhs;
  1145. break;
  1146. }
  1147. #endif
  1148. } endfor_nexthops(fi)
  1149. if (dead == fi->fib_nhs) {
  1150. switch (event) {
  1151. case NETDEV_DOWN:
  1152. case NETDEV_UNREGISTER:
  1153. fi->fib_flags |= RTNH_F_DEAD;
  1154. /* fall through */
  1155. case NETDEV_CHANGE:
  1156. fi->fib_flags |= RTNH_F_LINKDOWN;
  1157. break;
  1158. }
  1159. ret++;
  1160. }
  1161. }
  1162. return ret;
  1163. }
  1164. /* Must be invoked inside of an RCU protected region. */
  1165. void fib_select_default(const struct flowi4 *flp, struct fib_result *res)
  1166. {
  1167. struct fib_info *fi = NULL, *last_resort = NULL;
  1168. struct hlist_head *fa_head = res->fa_head;
  1169. struct fib_table *tb = res->table;
  1170. u8 slen = 32 - res->prefixlen;
  1171. int order = -1, last_idx = -1;
  1172. struct fib_alias *fa, *fa1 = NULL;
  1173. u32 last_prio = res->fi->fib_priority;
  1174. u8 last_tos = 0;
  1175. hlist_for_each_entry_rcu(fa, fa_head, fa_list) {
  1176. struct fib_info *next_fi = fa->fa_info;
  1177. if (fa->fa_slen != slen)
  1178. continue;
  1179. if (fa->fa_tos && fa->fa_tos != flp->flowi4_tos)
  1180. continue;
  1181. if (fa->tb_id != tb->tb_id)
  1182. continue;
  1183. if (next_fi->fib_priority > last_prio &&
  1184. fa->fa_tos == last_tos) {
  1185. if (last_tos)
  1186. continue;
  1187. break;
  1188. }
  1189. if (next_fi->fib_flags & RTNH_F_DEAD)
  1190. continue;
  1191. last_tos = fa->fa_tos;
  1192. last_prio = next_fi->fib_priority;
  1193. if (next_fi->fib_scope != res->scope ||
  1194. fa->fa_type != RTN_UNICAST)
  1195. continue;
  1196. if (!next_fi->fib_nh[0].nh_gw ||
  1197. next_fi->fib_nh[0].nh_scope != RT_SCOPE_LINK)
  1198. continue;
  1199. fib_alias_accessed(fa);
  1200. if (!fi) {
  1201. if (next_fi != res->fi)
  1202. break;
  1203. fa1 = fa;
  1204. } else if (!fib_detect_death(fi, order, &last_resort,
  1205. &last_idx, fa1->fa_default)) {
  1206. fib_result_assign(res, fi);
  1207. fa1->fa_default = order;
  1208. goto out;
  1209. }
  1210. fi = next_fi;
  1211. order++;
  1212. }
  1213. if (order <= 0 || !fi) {
  1214. if (fa1)
  1215. fa1->fa_default = -1;
  1216. goto out;
  1217. }
  1218. if (!fib_detect_death(fi, order, &last_resort, &last_idx,
  1219. fa1->fa_default)) {
  1220. fib_result_assign(res, fi);
  1221. fa1->fa_default = order;
  1222. goto out;
  1223. }
  1224. if (last_idx >= 0)
  1225. fib_result_assign(res, last_resort);
  1226. fa1->fa_default = last_idx;
  1227. out:
  1228. return;
  1229. }
  1230. /*
  1231. * Dead device goes up. We wake up dead nexthops.
  1232. * It takes sense only on multipath routes.
  1233. */
  1234. int fib_sync_up(struct net_device *dev, unsigned int nh_flags)
  1235. {
  1236. struct fib_info *prev_fi;
  1237. unsigned int hash;
  1238. struct hlist_head *head;
  1239. struct fib_nh *nh;
  1240. int ret;
  1241. if (!(dev->flags & IFF_UP))
  1242. return 0;
  1243. prev_fi = NULL;
  1244. hash = fib_devindex_hashfn(dev->ifindex);
  1245. head = &fib_info_devhash[hash];
  1246. ret = 0;
  1247. hlist_for_each_entry(nh, head, nh_hash) {
  1248. struct fib_info *fi = nh->nh_parent;
  1249. int alive;
  1250. BUG_ON(!fi->fib_nhs);
  1251. if (nh->nh_dev != dev || fi == prev_fi)
  1252. continue;
  1253. prev_fi = fi;
  1254. alive = 0;
  1255. change_nexthops(fi) {
  1256. if (!(nexthop_nh->nh_flags & nh_flags)) {
  1257. alive++;
  1258. continue;
  1259. }
  1260. if (!nexthop_nh->nh_dev ||
  1261. !(nexthop_nh->nh_dev->flags & IFF_UP))
  1262. continue;
  1263. if (nexthop_nh->nh_dev != dev ||
  1264. !__in_dev_get_rtnl(dev))
  1265. continue;
  1266. alive++;
  1267. #ifdef CONFIG_IP_ROUTE_MULTIPATH
  1268. spin_lock_bh(&fib_multipath_lock);
  1269. nexthop_nh->nh_power = 0;
  1270. nexthop_nh->nh_flags &= ~nh_flags;
  1271. spin_unlock_bh(&fib_multipath_lock);
  1272. #else
  1273. nexthop_nh->nh_flags &= ~nh_flags;
  1274. #endif
  1275. } endfor_nexthops(fi)
  1276. if (alive > 0) {
  1277. fi->fib_flags &= ~nh_flags;
  1278. ret++;
  1279. }
  1280. }
  1281. return ret;
  1282. }
  1283. #ifdef CONFIG_IP_ROUTE_MULTIPATH
  1284. /*
  1285. * The algorithm is suboptimal, but it provides really
  1286. * fair weighted route distribution.
  1287. */
  1288. void fib_select_multipath(struct fib_result *res)
  1289. {
  1290. struct fib_info *fi = res->fi;
  1291. struct in_device *in_dev;
  1292. int w;
  1293. spin_lock_bh(&fib_multipath_lock);
  1294. if (fi->fib_power <= 0) {
  1295. int power = 0;
  1296. change_nexthops(fi) {
  1297. in_dev = __in_dev_get_rcu(nexthop_nh->nh_dev);
  1298. if (nexthop_nh->nh_flags & RTNH_F_DEAD)
  1299. continue;
  1300. if (in_dev &&
  1301. IN_DEV_IGNORE_ROUTES_WITH_LINKDOWN(in_dev) &&
  1302. nexthop_nh->nh_flags & RTNH_F_LINKDOWN)
  1303. continue;
  1304. power += nexthop_nh->nh_weight;
  1305. nexthop_nh->nh_power = nexthop_nh->nh_weight;
  1306. } endfor_nexthops(fi);
  1307. fi->fib_power = power;
  1308. if (power <= 0) {
  1309. spin_unlock_bh(&fib_multipath_lock);
  1310. /* Race condition: route has just become dead. */
  1311. res->nh_sel = 0;
  1312. return;
  1313. }
  1314. }
  1315. /* w should be random number [0..fi->fib_power-1],
  1316. * it is pretty bad approximation.
  1317. */
  1318. w = jiffies % fi->fib_power;
  1319. change_nexthops(fi) {
  1320. if (!(nexthop_nh->nh_flags & RTNH_F_DEAD) &&
  1321. nexthop_nh->nh_power) {
  1322. w -= nexthop_nh->nh_power;
  1323. if (w <= 0) {
  1324. nexthop_nh->nh_power--;
  1325. fi->fib_power--;
  1326. res->nh_sel = nhsel;
  1327. spin_unlock_bh(&fib_multipath_lock);
  1328. return;
  1329. }
  1330. }
  1331. } endfor_nexthops(fi);
  1332. /* Race condition: route has just become dead. */
  1333. res->nh_sel = 0;
  1334. spin_unlock_bh(&fib_multipath_lock);
  1335. }
  1336. #endif