| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | /* | 
|  | 2 | * DECnet       An implementation of the DECnet protocol suite for the LINUX | 
|  | 3 | *              operating system.  DECnet is implemented using the  BSD Socket | 
|  | 4 | *              interface as the means of communication with the user level. | 
|  | 5 | * | 
|  | 6 | *              DECnet Routing Forwarding Information Base (Glue/Info List) | 
|  | 7 | * | 
|  | 8 | * Author:      Steve Whitehouse <SteveW@ACM.org> | 
|  | 9 | * | 
|  | 10 | * | 
|  | 11 | * Changes: | 
|  | 12 | *              Alexey Kuznetsov : SMP locking changes | 
|  | 13 | *              Steve Whitehouse : Rewrote it... Well to be more correct, I | 
|  | 14 | *                                 copied most of it from the ipv4 fib code. | 
|  | 15 | *              Steve Whitehouse : Updated it in style and fixed a few bugs | 
|  | 16 | *                                 which were fixed in the ipv4 code since | 
|  | 17 | *                                 this code was copied from it. | 
|  | 18 | * | 
|  | 19 | */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 20 | #include <linux/string.h> | 
|  | 21 | #include <linux/net.h> | 
|  | 22 | #include <linux/socket.h> | 
|  | 23 | #include <linux/sockios.h> | 
|  | 24 | #include <linux/init.h> | 
|  | 25 | #include <linux/skbuff.h> | 
|  | 26 | #include <linux/netlink.h> | 
|  | 27 | #include <linux/rtnetlink.h> | 
|  | 28 | #include <linux/proc_fs.h> | 
|  | 29 | #include <linux/netdevice.h> | 
|  | 30 | #include <linux/timer.h> | 
|  | 31 | #include <linux/spinlock.h> | 
|  | 32 | #include <asm/atomic.h> | 
|  | 33 | #include <asm/uaccess.h> | 
|  | 34 | #include <net/neighbour.h> | 
|  | 35 | #include <net/dst.h> | 
|  | 36 | #include <net/flow.h> | 
| Steven Whitehouse | a8731cb | 2006-08-09 15:56:46 -0700 | [diff] [blame] | 37 | #include <net/fib_rules.h> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 38 | #include <net/dn.h> | 
|  | 39 | #include <net/dn_route.h> | 
|  | 40 | #include <net/dn_fib.h> | 
|  | 41 | #include <net/dn_neigh.h> | 
|  | 42 | #include <net/dn_dev.h> | 
|  | 43 |  | 
|  | 44 | #define RT_MIN_TABLE 1 | 
|  | 45 |  | 
|  | 46 | #define for_fib_info() { struct dn_fib_info *fi;\ | 
|  | 47 | for(fi = dn_fib_info_list; fi; fi = fi->fib_next) | 
|  | 48 | #define endfor_fib_info() } | 
|  | 49 |  | 
|  | 50 | #define for_nexthops(fi) { int nhsel; const struct dn_fib_nh *nh;\ | 
|  | 51 | for(nhsel = 0, nh = (fi)->fib_nh; nhsel < (fi)->fib_nhs; nh++, nhsel++) | 
|  | 52 |  | 
|  | 53 | #define change_nexthops(fi) { int nhsel; struct dn_fib_nh *nh;\ | 
|  | 54 | for(nhsel = 0, nh = (struct dn_fib_nh *)((fi)->fib_nh); nhsel < (fi)->fib_nhs; nh++, nhsel++) | 
|  | 55 |  | 
|  | 56 | #define endfor_nexthops(fi) } | 
|  | 57 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 58 | static DEFINE_SPINLOCK(dn_fib_multipath_lock); | 
|  | 59 | static struct dn_fib_info *dn_fib_info_list; | 
| Steven Whitehouse | a22ec36 | 2006-08-09 16:00:57 -0700 | [diff] [blame] | 60 | static DEFINE_SPINLOCK(dn_fib_info_lock); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 61 |  | 
|  | 62 | static struct | 
|  | 63 | { | 
|  | 64 | int error; | 
|  | 65 | u8 scope; | 
|  | 66 | } dn_fib_props[RTA_MAX+1] = { | 
|  | 67 | [RTN_UNSPEC] =      { .error = 0,       .scope = RT_SCOPE_NOWHERE }, | 
|  | 68 | [RTN_UNICAST] =     { .error = 0,       .scope = RT_SCOPE_UNIVERSE }, | 
|  | 69 | [RTN_LOCAL] =       { .error = 0,       .scope = RT_SCOPE_HOST }, | 
|  | 70 | [RTN_BROADCAST] =   { .error = -EINVAL, .scope = RT_SCOPE_NOWHERE }, | 
|  | 71 | [RTN_ANYCAST] =     { .error = -EINVAL, .scope = RT_SCOPE_NOWHERE }, | 
|  | 72 | [RTN_MULTICAST] =   { .error = -EINVAL, .scope = RT_SCOPE_NOWHERE }, | 
|  | 73 | [RTN_BLACKHOLE] =   { .error = -EINVAL, .scope = RT_SCOPE_UNIVERSE }, | 
|  | 74 | [RTN_UNREACHABLE] = { .error = -EHOSTUNREACH, .scope = RT_SCOPE_UNIVERSE }, | 
|  | 75 | [RTN_PROHIBIT] =    { .error = -EACCES, .scope = RT_SCOPE_UNIVERSE }, | 
|  | 76 | [RTN_THROW] =       { .error = -EAGAIN, .scope = RT_SCOPE_UNIVERSE }, | 
|  | 77 | [RTN_NAT] =         { .error = 0,       .scope = RT_SCOPE_NOWHERE }, | 
|  | 78 | [RTN_XRESOLVE] =    { .error = -EINVAL, .scope = RT_SCOPE_NOWHERE }, | 
|  | 79 | }; | 
|  | 80 |  | 
| Adrian Bunk | 2aa7f36 | 2006-08-14 23:55:20 -0700 | [diff] [blame] | 81 | static int dn_fib_sync_down(__le16 local, struct net_device *dev, int force); | 
|  | 82 | static int dn_fib_sync_up(struct net_device *dev); | 
|  | 83 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 84 | void dn_fib_free_info(struct dn_fib_info *fi) | 
|  | 85 | { | 
|  | 86 | if (fi->fib_dead == 0) { | 
|  | 87 | printk(KERN_DEBUG "DECnet: BUG! Attempt to free alive dn_fib_info\n"); | 
|  | 88 | return; | 
|  | 89 | } | 
|  | 90 |  | 
|  | 91 | change_nexthops(fi) { | 
|  | 92 | if (nh->nh_dev) | 
|  | 93 | dev_put(nh->nh_dev); | 
|  | 94 | nh->nh_dev = NULL; | 
|  | 95 | } endfor_nexthops(fi); | 
|  | 96 | kfree(fi); | 
|  | 97 | } | 
|  | 98 |  | 
|  | 99 | void dn_fib_release_info(struct dn_fib_info *fi) | 
|  | 100 | { | 
| Steven Whitehouse | a22ec36 | 2006-08-09 16:00:57 -0700 | [diff] [blame] | 101 | spin_lock(&dn_fib_info_lock); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 102 | if (fi && --fi->fib_treeref == 0) { | 
|  | 103 | if (fi->fib_next) | 
|  | 104 | fi->fib_next->fib_prev = fi->fib_prev; | 
|  | 105 | if (fi->fib_prev) | 
|  | 106 | fi->fib_prev->fib_next = fi->fib_next; | 
|  | 107 | if (fi == dn_fib_info_list) | 
|  | 108 | dn_fib_info_list = fi->fib_next; | 
|  | 109 | fi->fib_dead = 1; | 
|  | 110 | dn_fib_info_put(fi); | 
|  | 111 | } | 
| Steven Whitehouse | a22ec36 | 2006-08-09 16:00:57 -0700 | [diff] [blame] | 112 | spin_unlock(&dn_fib_info_lock); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 113 | } | 
|  | 114 |  | 
|  | 115 | static inline int dn_fib_nh_comp(const struct dn_fib_info *fi, const struct dn_fib_info *ofi) | 
|  | 116 | { | 
|  | 117 | const struct dn_fib_nh *onh = ofi->fib_nh; | 
|  | 118 |  | 
|  | 119 | for_nexthops(fi) { | 
|  | 120 | if (nh->nh_oif != onh->nh_oif || | 
|  | 121 | nh->nh_gw != onh->nh_gw || | 
|  | 122 | nh->nh_scope != onh->nh_scope || | 
|  | 123 | nh->nh_weight != onh->nh_weight || | 
|  | 124 | ((nh->nh_flags^onh->nh_flags)&~RTNH_F_DEAD)) | 
|  | 125 | return -1; | 
|  | 126 | onh++; | 
|  | 127 | } endfor_nexthops(fi); | 
|  | 128 | return 0; | 
|  | 129 | } | 
|  | 130 |  | 
|  | 131 | static inline struct dn_fib_info *dn_fib_find_info(const struct dn_fib_info *nfi) | 
|  | 132 | { | 
|  | 133 | for_fib_info() { | 
|  | 134 | if (fi->fib_nhs != nfi->fib_nhs) | 
|  | 135 | continue; | 
|  | 136 | if (nfi->fib_protocol == fi->fib_protocol && | 
|  | 137 | nfi->fib_prefsrc == fi->fib_prefsrc && | 
|  | 138 | nfi->fib_priority == fi->fib_priority && | 
|  | 139 | memcmp(nfi->fib_metrics, fi->fib_metrics, sizeof(fi->fib_metrics)) == 0 && | 
|  | 140 | ((nfi->fib_flags^fi->fib_flags)&~RTNH_F_DEAD) == 0 && | 
|  | 141 | (nfi->fib_nhs == 0 || dn_fib_nh_comp(fi, nfi) == 0)) | 
|  | 142 | return fi; | 
|  | 143 | } endfor_fib_info(); | 
|  | 144 | return NULL; | 
|  | 145 | } | 
|  | 146 |  | 
| Steven Whitehouse | c4ea94a | 2006-03-20 22:42:39 -0800 | [diff] [blame] | 147 | __le16 dn_fib_get_attr16(struct rtattr *attr, int attrlen, int type) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 148 | { | 
|  | 149 | while(RTA_OK(attr,attrlen)) { | 
|  | 150 | if (attr->rta_type == type) | 
| Steven Whitehouse | c4ea94a | 2006-03-20 22:42:39 -0800 | [diff] [blame] | 151 | return *(__le16*)RTA_DATA(attr); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 152 | attr = RTA_NEXT(attr, attrlen); | 
|  | 153 | } | 
|  | 154 |  | 
|  | 155 | return 0; | 
|  | 156 | } | 
|  | 157 |  | 
|  | 158 | static int dn_fib_count_nhs(struct rtattr *rta) | 
|  | 159 | { | 
|  | 160 | int nhs = 0; | 
|  | 161 | struct rtnexthop *nhp = RTA_DATA(rta); | 
|  | 162 | int nhlen = RTA_PAYLOAD(rta); | 
|  | 163 |  | 
|  | 164 | while(nhlen >= (int)sizeof(struct rtnexthop)) { | 
|  | 165 | if ((nhlen -= nhp->rtnh_len) < 0) | 
|  | 166 | return 0; | 
|  | 167 | nhs++; | 
|  | 168 | nhp = RTNH_NEXT(nhp); | 
|  | 169 | } | 
|  | 170 |  | 
|  | 171 | return nhs; | 
|  | 172 | } | 
|  | 173 |  | 
|  | 174 | static int dn_fib_get_nhs(struct dn_fib_info *fi, const struct rtattr *rta, const struct rtmsg *r) | 
|  | 175 | { | 
|  | 176 | struct rtnexthop *nhp = RTA_DATA(rta); | 
|  | 177 | int nhlen = RTA_PAYLOAD(rta); | 
|  | 178 |  | 
|  | 179 | change_nexthops(fi) { | 
|  | 180 | int attrlen = nhlen - sizeof(struct rtnexthop); | 
|  | 181 | if (attrlen < 0 || (nhlen -= nhp->rtnh_len) < 0) | 
|  | 182 | return -EINVAL; | 
|  | 183 |  | 
|  | 184 | nh->nh_flags  = (r->rtm_flags&~0xFF) | nhp->rtnh_flags; | 
|  | 185 | nh->nh_oif    = nhp->rtnh_ifindex; | 
|  | 186 | nh->nh_weight = nhp->rtnh_hops + 1; | 
|  | 187 |  | 
|  | 188 | if (attrlen) { | 
|  | 189 | nh->nh_gw = dn_fib_get_attr16(RTNH_DATA(nhp), attrlen, RTA_GATEWAY); | 
|  | 190 | } | 
|  | 191 | nhp = RTNH_NEXT(nhp); | 
|  | 192 | } endfor_nexthops(fi); | 
|  | 193 |  | 
|  | 194 | return 0; | 
|  | 195 | } | 
|  | 196 |  | 
|  | 197 |  | 
|  | 198 | static int dn_fib_check_nh(const struct rtmsg *r, struct dn_fib_info *fi, struct dn_fib_nh *nh) | 
|  | 199 | { | 
|  | 200 | int err; | 
|  | 201 |  | 
|  | 202 | if (nh->nh_gw) { | 
|  | 203 | struct flowi fl; | 
|  | 204 | struct dn_fib_res res; | 
|  | 205 |  | 
|  | 206 | memset(&fl, 0, sizeof(fl)); | 
|  | 207 |  | 
|  | 208 | if (nh->nh_flags&RTNH_F_ONLINK) { | 
|  | 209 | struct net_device *dev; | 
|  | 210 |  | 
|  | 211 | if (r->rtm_scope >= RT_SCOPE_LINK) | 
|  | 212 | return -EINVAL; | 
|  | 213 | if (dnet_addr_type(nh->nh_gw) != RTN_UNICAST) | 
|  | 214 | return -EINVAL; | 
|  | 215 | if ((dev = __dev_get_by_index(nh->nh_oif)) == NULL) | 
|  | 216 | return -ENODEV; | 
|  | 217 | if (!(dev->flags&IFF_UP)) | 
|  | 218 | return -ENETDOWN; | 
|  | 219 | nh->nh_dev = dev; | 
|  | 220 | dev_hold(dev); | 
|  | 221 | nh->nh_scope = RT_SCOPE_LINK; | 
|  | 222 | return 0; | 
|  | 223 | } | 
|  | 224 |  | 
|  | 225 | memset(&fl, 0, sizeof(fl)); | 
|  | 226 | fl.fld_dst = nh->nh_gw; | 
|  | 227 | fl.oif = nh->nh_oif; | 
|  | 228 | fl.fld_scope = r->rtm_scope + 1; | 
|  | 229 |  | 
|  | 230 | if (fl.fld_scope < RT_SCOPE_LINK) | 
|  | 231 | fl.fld_scope = RT_SCOPE_LINK; | 
|  | 232 |  | 
|  | 233 | if ((err = dn_fib_lookup(&fl, &res)) != 0) | 
|  | 234 | return err; | 
|  | 235 |  | 
|  | 236 | err = -EINVAL; | 
|  | 237 | if (res.type != RTN_UNICAST && res.type != RTN_LOCAL) | 
|  | 238 | goto out; | 
|  | 239 | nh->nh_scope = res.scope; | 
|  | 240 | nh->nh_oif = DN_FIB_RES_OIF(res); | 
|  | 241 | nh->nh_dev = DN_FIB_RES_DEV(res); | 
|  | 242 | if (nh->nh_dev == NULL) | 
|  | 243 | goto out; | 
|  | 244 | dev_hold(nh->nh_dev); | 
|  | 245 | err = -ENETDOWN; | 
|  | 246 | if (!(nh->nh_dev->flags & IFF_UP)) | 
|  | 247 | goto out; | 
|  | 248 | err = 0; | 
|  | 249 | out: | 
|  | 250 | dn_fib_res_put(&res); | 
|  | 251 | return err; | 
|  | 252 | } else { | 
|  | 253 | struct net_device *dev; | 
|  | 254 |  | 
|  | 255 | if (nh->nh_flags&(RTNH_F_PERVASIVE|RTNH_F_ONLINK)) | 
|  | 256 | return -EINVAL; | 
|  | 257 |  | 
|  | 258 | dev = __dev_get_by_index(nh->nh_oif); | 
|  | 259 | if (dev == NULL || dev->dn_ptr == NULL) | 
|  | 260 | return -ENODEV; | 
|  | 261 | if (!(dev->flags&IFF_UP)) | 
|  | 262 | return -ENETDOWN; | 
|  | 263 | nh->nh_dev = dev; | 
|  | 264 | dev_hold(nh->nh_dev); | 
|  | 265 | nh->nh_scope = RT_SCOPE_HOST; | 
|  | 266 | } | 
|  | 267 |  | 
|  | 268 | return 0; | 
|  | 269 | } | 
|  | 270 |  | 
|  | 271 |  | 
|  | 272 | struct dn_fib_info *dn_fib_create_info(const struct rtmsg *r, struct dn_kern_rta *rta, const struct nlmsghdr *nlh, int *errp) | 
|  | 273 | { | 
|  | 274 | int err; | 
|  | 275 | struct dn_fib_info *fi = NULL; | 
|  | 276 | struct dn_fib_info *ofi; | 
|  | 277 | int nhs = 1; | 
|  | 278 |  | 
|  | 279 | if (dn_fib_props[r->rtm_type].scope > r->rtm_scope) | 
|  | 280 | goto err_inval; | 
|  | 281 |  | 
|  | 282 | if (rta->rta_mp) { | 
|  | 283 | nhs = dn_fib_count_nhs(rta->rta_mp); | 
|  | 284 | if (nhs == 0) | 
|  | 285 | goto err_inval; | 
|  | 286 | } | 
|  | 287 |  | 
| Panagiotis Issaris | 0da974f | 2006-07-21 14:51:30 -0700 | [diff] [blame] | 288 | fi = kzalloc(sizeof(*fi)+nhs*sizeof(struct dn_fib_nh), GFP_KERNEL); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 289 | err = -ENOBUFS; | 
|  | 290 | if (fi == NULL) | 
|  | 291 | goto failure; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 292 |  | 
|  | 293 | fi->fib_protocol = r->rtm_protocol; | 
|  | 294 | fi->fib_nhs = nhs; | 
|  | 295 | fi->fib_flags = r->rtm_flags; | 
|  | 296 | if (rta->rta_priority) | 
|  | 297 | fi->fib_priority = *rta->rta_priority; | 
|  | 298 | if (rta->rta_mx) { | 
|  | 299 | int attrlen = RTA_PAYLOAD(rta->rta_mx); | 
|  | 300 | struct rtattr *attr = RTA_DATA(rta->rta_mx); | 
|  | 301 |  | 
|  | 302 | while(RTA_OK(attr, attrlen)) { | 
|  | 303 | unsigned flavour = attr->rta_type; | 
|  | 304 | if (flavour) { | 
|  | 305 | if (flavour > RTAX_MAX) | 
|  | 306 | goto err_inval; | 
|  | 307 | fi->fib_metrics[flavour-1] = *(unsigned*)RTA_DATA(attr); | 
|  | 308 | } | 
|  | 309 | attr = RTA_NEXT(attr, attrlen); | 
|  | 310 | } | 
|  | 311 | } | 
|  | 312 | if (rta->rta_prefsrc) | 
|  | 313 | memcpy(&fi->fib_prefsrc, rta->rta_prefsrc, 2); | 
|  | 314 |  | 
|  | 315 | if (rta->rta_mp) { | 
|  | 316 | if ((err = dn_fib_get_nhs(fi, rta->rta_mp, r)) != 0) | 
|  | 317 | goto failure; | 
|  | 318 | if (rta->rta_oif && fi->fib_nh->nh_oif != *rta->rta_oif) | 
|  | 319 | goto err_inval; | 
|  | 320 | if (rta->rta_gw && memcmp(&fi->fib_nh->nh_gw, rta->rta_gw, 2)) | 
|  | 321 | goto err_inval; | 
|  | 322 | } else { | 
|  | 323 | struct dn_fib_nh *nh = fi->fib_nh; | 
|  | 324 | if (rta->rta_oif) | 
|  | 325 | nh->nh_oif = *rta->rta_oif; | 
|  | 326 | if (rta->rta_gw) | 
|  | 327 | memcpy(&nh->nh_gw, rta->rta_gw, 2); | 
|  | 328 | nh->nh_flags = r->rtm_flags; | 
|  | 329 | nh->nh_weight = 1; | 
|  | 330 | } | 
|  | 331 |  | 
|  | 332 | if (r->rtm_type == RTN_NAT) { | 
|  | 333 | if (rta->rta_gw == NULL || nhs != 1 || rta->rta_oif) | 
|  | 334 | goto err_inval; | 
|  | 335 | memcpy(&fi->fib_nh->nh_gw, rta->rta_gw, 2); | 
|  | 336 | goto link_it; | 
|  | 337 | } | 
|  | 338 |  | 
|  | 339 | if (dn_fib_props[r->rtm_type].error) { | 
|  | 340 | if (rta->rta_gw || rta->rta_oif || rta->rta_mp) | 
|  | 341 | goto err_inval; | 
|  | 342 | goto link_it; | 
|  | 343 | } | 
|  | 344 |  | 
|  | 345 | if (r->rtm_scope > RT_SCOPE_HOST) | 
|  | 346 | goto err_inval; | 
|  | 347 |  | 
|  | 348 | if (r->rtm_scope == RT_SCOPE_HOST) { | 
|  | 349 | struct dn_fib_nh *nh = fi->fib_nh; | 
|  | 350 |  | 
|  | 351 | /* Local address is added */ | 
|  | 352 | if (nhs != 1 || nh->nh_gw) | 
|  | 353 | goto err_inval; | 
|  | 354 | nh->nh_scope = RT_SCOPE_NOWHERE; | 
|  | 355 | nh->nh_dev = dev_get_by_index(fi->fib_nh->nh_oif); | 
|  | 356 | err = -ENODEV; | 
|  | 357 | if (nh->nh_dev == NULL) | 
|  | 358 | goto failure; | 
|  | 359 | } else { | 
|  | 360 | change_nexthops(fi) { | 
|  | 361 | if ((err = dn_fib_check_nh(r, fi, nh)) != 0) | 
|  | 362 | goto failure; | 
|  | 363 | } endfor_nexthops(fi) | 
|  | 364 | } | 
|  | 365 |  | 
|  | 366 | if (fi->fib_prefsrc) { | 
|  | 367 | if (r->rtm_type != RTN_LOCAL || rta->rta_dst == NULL || | 
|  | 368 | memcmp(&fi->fib_prefsrc, rta->rta_dst, 2)) | 
|  | 369 | if (dnet_addr_type(fi->fib_prefsrc) != RTN_LOCAL) | 
|  | 370 | goto err_inval; | 
|  | 371 | } | 
|  | 372 |  | 
|  | 373 | link_it: | 
|  | 374 | if ((ofi = dn_fib_find_info(fi)) != NULL) { | 
|  | 375 | fi->fib_dead = 1; | 
|  | 376 | dn_fib_free_info(fi); | 
|  | 377 | ofi->fib_treeref++; | 
|  | 378 | return ofi; | 
|  | 379 | } | 
|  | 380 |  | 
|  | 381 | fi->fib_treeref++; | 
|  | 382 | atomic_inc(&fi->fib_clntref); | 
| Steven Whitehouse | a22ec36 | 2006-08-09 16:00:57 -0700 | [diff] [blame] | 383 | spin_lock(&dn_fib_info_lock); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 384 | fi->fib_next = dn_fib_info_list; | 
|  | 385 | fi->fib_prev = NULL; | 
|  | 386 | if (dn_fib_info_list) | 
|  | 387 | dn_fib_info_list->fib_prev = fi; | 
|  | 388 | dn_fib_info_list = fi; | 
| Steven Whitehouse | a22ec36 | 2006-08-09 16:00:57 -0700 | [diff] [blame] | 389 | spin_unlock(&dn_fib_info_lock); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 390 | return fi; | 
|  | 391 |  | 
|  | 392 | err_inval: | 
|  | 393 | err = -EINVAL; | 
|  | 394 |  | 
|  | 395 | failure: | 
|  | 396 | *errp = err; | 
|  | 397 | if (fi) { | 
|  | 398 | fi->fib_dead = 1; | 
|  | 399 | dn_fib_free_info(fi); | 
|  | 400 | } | 
|  | 401 |  | 
|  | 402 | return NULL; | 
|  | 403 | } | 
|  | 404 |  | 
|  | 405 | int dn_fib_semantic_match(int type, struct dn_fib_info *fi, const struct flowi *fl, struct dn_fib_res *res) | 
|  | 406 | { | 
|  | 407 | int err = dn_fib_props[type].error; | 
|  | 408 |  | 
|  | 409 | if (err == 0) { | 
|  | 410 | if (fi->fib_flags & RTNH_F_DEAD) | 
|  | 411 | return 1; | 
|  | 412 |  | 
|  | 413 | res->fi = fi; | 
|  | 414 |  | 
|  | 415 | switch(type) { | 
|  | 416 | case RTN_NAT: | 
|  | 417 | DN_FIB_RES_RESET(*res); | 
|  | 418 | atomic_inc(&fi->fib_clntref); | 
|  | 419 | return 0; | 
|  | 420 | case RTN_UNICAST: | 
|  | 421 | case RTN_LOCAL: | 
|  | 422 | for_nexthops(fi) { | 
|  | 423 | if (nh->nh_flags & RTNH_F_DEAD) | 
|  | 424 | continue; | 
|  | 425 | if (!fl->oif || fl->oif == nh->nh_oif) | 
|  | 426 | break; | 
|  | 427 | } | 
|  | 428 | if (nhsel < fi->fib_nhs) { | 
|  | 429 | res->nh_sel = nhsel; | 
|  | 430 | atomic_inc(&fi->fib_clntref); | 
|  | 431 | return 0; | 
|  | 432 | } | 
|  | 433 | endfor_nexthops(fi); | 
|  | 434 | res->fi = NULL; | 
|  | 435 | return 1; | 
|  | 436 | default: | 
|  | 437 | if (net_ratelimit()) | 
|  | 438 | printk("DECnet: impossible routing event : dn_fib_semantic_match type=%d\n", type); | 
|  | 439 | res->fi = NULL; | 
|  | 440 | return -EINVAL; | 
|  | 441 | } | 
|  | 442 | } | 
|  | 443 | return err; | 
|  | 444 | } | 
|  | 445 |  | 
|  | 446 | void dn_fib_select_multipath(const struct flowi *fl, struct dn_fib_res *res) | 
|  | 447 | { | 
|  | 448 | struct dn_fib_info *fi = res->fi; | 
|  | 449 | int w; | 
|  | 450 |  | 
|  | 451 | spin_lock_bh(&dn_fib_multipath_lock); | 
|  | 452 | if (fi->fib_power <= 0) { | 
|  | 453 | int power = 0; | 
|  | 454 | change_nexthops(fi) { | 
|  | 455 | if (!(nh->nh_flags&RTNH_F_DEAD)) { | 
|  | 456 | power += nh->nh_weight; | 
|  | 457 | nh->nh_power = nh->nh_weight; | 
|  | 458 | } | 
|  | 459 | } endfor_nexthops(fi); | 
|  | 460 | fi->fib_power = power; | 
|  | 461 | if (power < 0) { | 
|  | 462 | spin_unlock_bh(&dn_fib_multipath_lock); | 
|  | 463 | res->nh_sel = 0; | 
|  | 464 | return; | 
|  | 465 | } | 
|  | 466 | } | 
|  | 467 |  | 
|  | 468 | w = jiffies % fi->fib_power; | 
|  | 469 |  | 
|  | 470 | change_nexthops(fi) { | 
|  | 471 | if (!(nh->nh_flags&RTNH_F_DEAD) && nh->nh_power) { | 
|  | 472 | if ((w -= nh->nh_power) <= 0) { | 
|  | 473 | nh->nh_power--; | 
|  | 474 | fi->fib_power--; | 
|  | 475 | res->nh_sel = nhsel; | 
|  | 476 | spin_unlock_bh(&dn_fib_multipath_lock); | 
|  | 477 | return; | 
|  | 478 | } | 
|  | 479 | } | 
|  | 480 | } endfor_nexthops(fi); | 
|  | 481 | res->nh_sel = 0; | 
|  | 482 | spin_unlock_bh(&dn_fib_multipath_lock); | 
|  | 483 | } | 
|  | 484 |  | 
|  | 485 |  | 
|  | 486 | static int dn_fib_check_attr(struct rtmsg *r, struct rtattr **rta) | 
|  | 487 | { | 
|  | 488 | int i; | 
|  | 489 |  | 
|  | 490 | for(i = 1; i <= RTA_MAX; i++) { | 
|  | 491 | struct rtattr *attr = rta[i-1]; | 
|  | 492 | if (attr) { | 
|  | 493 | if (RTA_PAYLOAD(attr) < 4 && RTA_PAYLOAD(attr) != 2) | 
|  | 494 | return -EINVAL; | 
| Patrick McHardy | 9e762a4 | 2006-08-10 23:09:48 -0700 | [diff] [blame] | 495 | if (i != RTA_MULTIPATH && i != RTA_METRICS && | 
|  | 496 | i != RTA_TABLE) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 497 | rta[i-1] = (struct rtattr *)RTA_DATA(attr); | 
|  | 498 | } | 
|  | 499 | } | 
|  | 500 |  | 
|  | 501 | return 0; | 
|  | 502 | } | 
|  | 503 |  | 
|  | 504 | int dn_fib_rtm_delroute(struct sk_buff *skb, struct nlmsghdr *nlh, void *arg) | 
|  | 505 | { | 
|  | 506 | struct dn_fib_table *tb; | 
|  | 507 | struct rtattr **rta = arg; | 
|  | 508 | struct rtmsg *r = NLMSG_DATA(nlh); | 
|  | 509 |  | 
|  | 510 | if (dn_fib_check_attr(r, rta)) | 
|  | 511 | return -EINVAL; | 
|  | 512 |  | 
| Patrick McHardy | 9e762a4 | 2006-08-10 23:09:48 -0700 | [diff] [blame] | 513 | tb = dn_fib_get_table(rtm_get_table(rta, r->rtm_table), 0); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 514 | if (tb) | 
|  | 515 | return tb->delete(tb, r, (struct dn_kern_rta *)rta, nlh, &NETLINK_CB(skb)); | 
|  | 516 |  | 
|  | 517 | return -ESRCH; | 
|  | 518 | } | 
|  | 519 |  | 
|  | 520 | int dn_fib_rtm_newroute(struct sk_buff *skb, struct nlmsghdr *nlh, void *arg) | 
|  | 521 | { | 
|  | 522 | struct dn_fib_table *tb; | 
|  | 523 | struct rtattr **rta = arg; | 
|  | 524 | struct rtmsg *r = NLMSG_DATA(nlh); | 
|  | 525 |  | 
|  | 526 | if (dn_fib_check_attr(r, rta)) | 
|  | 527 | return -EINVAL; | 
|  | 528 |  | 
| Patrick McHardy | 9e762a4 | 2006-08-10 23:09:48 -0700 | [diff] [blame] | 529 | tb = dn_fib_get_table(rtm_get_table(rta, r->rtm_table), 1); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 530 | if (tb) | 
|  | 531 | return tb->insert(tb, r, (struct dn_kern_rta *)rta, nlh, &NETLINK_CB(skb)); | 
|  | 532 |  | 
|  | 533 | return -ENOBUFS; | 
|  | 534 | } | 
|  | 535 |  | 
| Steven Whitehouse | c4ea94a | 2006-03-20 22:42:39 -0800 | [diff] [blame] | 536 | static void fib_magic(int cmd, int type, __le16 dst, int dst_len, struct dn_ifaddr *ifa) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 537 | { | 
|  | 538 | struct dn_fib_table *tb; | 
|  | 539 | struct { | 
|  | 540 | struct nlmsghdr nlh; | 
|  | 541 | struct rtmsg rtm; | 
|  | 542 | } req; | 
|  | 543 | struct dn_kern_rta rta; | 
|  | 544 |  | 
|  | 545 | memset(&req.rtm, 0, sizeof(req.rtm)); | 
|  | 546 | memset(&rta, 0, sizeof(rta)); | 
|  | 547 |  | 
|  | 548 | if (type == RTN_UNICAST) | 
|  | 549 | tb = dn_fib_get_table(RT_MIN_TABLE, 1); | 
|  | 550 | else | 
|  | 551 | tb = dn_fib_get_table(RT_TABLE_LOCAL, 1); | 
|  | 552 |  | 
|  | 553 | if (tb == NULL) | 
|  | 554 | return; | 
|  | 555 |  | 
|  | 556 | req.nlh.nlmsg_len = sizeof(req); | 
|  | 557 | req.nlh.nlmsg_type = cmd; | 
|  | 558 | req.nlh.nlmsg_flags = NLM_F_REQUEST|NLM_F_CREATE|NLM_F_APPEND; | 
|  | 559 | req.nlh.nlmsg_pid = 0; | 
|  | 560 | req.nlh.nlmsg_seq = 0; | 
|  | 561 |  | 
|  | 562 | req.rtm.rtm_dst_len = dst_len; | 
|  | 563 | req.rtm.rtm_table = tb->n; | 
|  | 564 | req.rtm.rtm_protocol = RTPROT_KERNEL; | 
|  | 565 | req.rtm.rtm_scope = (type != RTN_LOCAL ? RT_SCOPE_LINK : RT_SCOPE_HOST); | 
|  | 566 | req.rtm.rtm_type = type; | 
|  | 567 |  | 
|  | 568 | rta.rta_dst = &dst; | 
|  | 569 | rta.rta_prefsrc = &ifa->ifa_local; | 
|  | 570 | rta.rta_oif = &ifa->ifa_dev->dev->ifindex; | 
|  | 571 |  | 
|  | 572 | if (cmd == RTM_NEWROUTE) | 
|  | 573 | tb->insert(tb, &req.rtm, &rta, &req.nlh, NULL); | 
|  | 574 | else | 
|  | 575 | tb->delete(tb, &req.rtm, &rta, &req.nlh, NULL); | 
|  | 576 | } | 
|  | 577 |  | 
|  | 578 | static void dn_fib_add_ifaddr(struct dn_ifaddr *ifa) | 
|  | 579 | { | 
|  | 580 |  | 
|  | 581 | fib_magic(RTM_NEWROUTE, RTN_LOCAL, ifa->ifa_local, 16, ifa); | 
|  | 582 |  | 
|  | 583 | #if 0 | 
|  | 584 | if (!(dev->flags&IFF_UP)) | 
|  | 585 | return; | 
|  | 586 | /* In the future, we will want to add default routes here */ | 
|  | 587 |  | 
|  | 588 | #endif | 
|  | 589 | } | 
|  | 590 |  | 
|  | 591 | static void dn_fib_del_ifaddr(struct dn_ifaddr *ifa) | 
|  | 592 | { | 
|  | 593 | int found_it = 0; | 
|  | 594 | struct net_device *dev; | 
|  | 595 | struct dn_dev *dn_db; | 
|  | 596 | struct dn_ifaddr *ifa2; | 
|  | 597 |  | 
|  | 598 | ASSERT_RTNL(); | 
|  | 599 |  | 
|  | 600 | /* Scan device list */ | 
|  | 601 | read_lock(&dev_base_lock); | 
|  | 602 | for(dev = dev_base; dev; dev = dev->next) { | 
|  | 603 | dn_db = dev->dn_ptr; | 
|  | 604 | if (dn_db == NULL) | 
|  | 605 | continue; | 
|  | 606 | for(ifa2 = dn_db->ifa_list; ifa2; ifa2 = ifa2->ifa_next) { | 
|  | 607 | if (ifa2->ifa_local == ifa->ifa_local) { | 
|  | 608 | found_it = 1; | 
|  | 609 | break; | 
|  | 610 | } | 
|  | 611 | } | 
|  | 612 | } | 
|  | 613 | read_unlock(&dev_base_lock); | 
|  | 614 |  | 
|  | 615 | if (found_it == 0) { | 
|  | 616 | fib_magic(RTM_DELROUTE, RTN_LOCAL, ifa->ifa_local, 16, ifa); | 
|  | 617 |  | 
|  | 618 | if (dnet_addr_type(ifa->ifa_local) != RTN_LOCAL) { | 
|  | 619 | if (dn_fib_sync_down(ifa->ifa_local, NULL, 0)) | 
|  | 620 | dn_fib_flush(); | 
|  | 621 | } | 
|  | 622 | } | 
|  | 623 | } | 
|  | 624 |  | 
|  | 625 | static void dn_fib_disable_addr(struct net_device *dev, int force) | 
|  | 626 | { | 
|  | 627 | if (dn_fib_sync_down(0, dev, force)) | 
|  | 628 | dn_fib_flush(); | 
|  | 629 | dn_rt_cache_flush(0); | 
|  | 630 | neigh_ifdown(&dn_neigh_table, dev); | 
|  | 631 | } | 
|  | 632 |  | 
|  | 633 | static int dn_fib_dnaddr_event(struct notifier_block *this, unsigned long event, void *ptr) | 
|  | 634 | { | 
|  | 635 | struct dn_ifaddr *ifa = (struct dn_ifaddr *)ptr; | 
|  | 636 |  | 
|  | 637 | switch(event) { | 
|  | 638 | case NETDEV_UP: | 
|  | 639 | dn_fib_add_ifaddr(ifa); | 
|  | 640 | dn_fib_sync_up(ifa->ifa_dev->dev); | 
|  | 641 | dn_rt_cache_flush(-1); | 
|  | 642 | break; | 
|  | 643 | case NETDEV_DOWN: | 
|  | 644 | dn_fib_del_ifaddr(ifa); | 
|  | 645 | if (ifa->ifa_dev && ifa->ifa_dev->ifa_list == NULL) { | 
|  | 646 | dn_fib_disable_addr(ifa->ifa_dev->dev, 1); | 
|  | 647 | } else { | 
|  | 648 | dn_rt_cache_flush(-1); | 
|  | 649 | } | 
|  | 650 | break; | 
|  | 651 | } | 
|  | 652 | return NOTIFY_DONE; | 
|  | 653 | } | 
|  | 654 |  | 
| Adrian Bunk | 2aa7f36 | 2006-08-14 23:55:20 -0700 | [diff] [blame] | 655 | static int dn_fib_sync_down(__le16 local, struct net_device *dev, int force) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 656 | { | 
|  | 657 | int ret = 0; | 
|  | 658 | int scope = RT_SCOPE_NOWHERE; | 
|  | 659 |  | 
|  | 660 | if (force) | 
|  | 661 | scope = -1; | 
|  | 662 |  | 
|  | 663 | for_fib_info() { | 
|  | 664 | /* | 
|  | 665 | * This makes no sense for DECnet.... we will almost | 
|  | 666 | * certainly have more than one local address the same | 
|  | 667 | * over all our interfaces. It needs thinking about | 
|  | 668 | * some more. | 
|  | 669 | */ | 
|  | 670 | if (local && fi->fib_prefsrc == local) { | 
|  | 671 | fi->fib_flags |= RTNH_F_DEAD; | 
|  | 672 | ret++; | 
|  | 673 | } else if (dev && fi->fib_nhs) { | 
|  | 674 | int dead = 0; | 
|  | 675 |  | 
|  | 676 | change_nexthops(fi) { | 
|  | 677 | if (nh->nh_flags&RTNH_F_DEAD) | 
|  | 678 | dead++; | 
|  | 679 | else if (nh->nh_dev == dev && | 
|  | 680 | nh->nh_scope != scope) { | 
|  | 681 | spin_lock_bh(&dn_fib_multipath_lock); | 
|  | 682 | nh->nh_flags |= RTNH_F_DEAD; | 
|  | 683 | fi->fib_power -= nh->nh_power; | 
|  | 684 | nh->nh_power = 0; | 
|  | 685 | spin_unlock_bh(&dn_fib_multipath_lock); | 
|  | 686 | dead++; | 
|  | 687 | } | 
|  | 688 | } endfor_nexthops(fi) | 
|  | 689 | if (dead == fi->fib_nhs) { | 
|  | 690 | fi->fib_flags |= RTNH_F_DEAD; | 
|  | 691 | ret++; | 
|  | 692 | } | 
|  | 693 | } | 
|  | 694 | } endfor_fib_info(); | 
|  | 695 | return ret; | 
|  | 696 | } | 
|  | 697 |  | 
|  | 698 |  | 
| Adrian Bunk | 2aa7f36 | 2006-08-14 23:55:20 -0700 | [diff] [blame] | 699 | static int dn_fib_sync_up(struct net_device *dev) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 700 | { | 
|  | 701 | int ret = 0; | 
|  | 702 |  | 
|  | 703 | if (!(dev->flags&IFF_UP)) | 
|  | 704 | return 0; | 
|  | 705 |  | 
|  | 706 | for_fib_info() { | 
|  | 707 | int alive = 0; | 
|  | 708 |  | 
|  | 709 | change_nexthops(fi) { | 
|  | 710 | if (!(nh->nh_flags&RTNH_F_DEAD)) { | 
|  | 711 | alive++; | 
|  | 712 | continue; | 
|  | 713 | } | 
|  | 714 | if (nh->nh_dev == NULL || !(nh->nh_dev->flags&IFF_UP)) | 
|  | 715 | continue; | 
|  | 716 | if (nh->nh_dev != dev || dev->dn_ptr == NULL) | 
|  | 717 | continue; | 
|  | 718 | alive++; | 
|  | 719 | spin_lock_bh(&dn_fib_multipath_lock); | 
|  | 720 | nh->nh_power = 0; | 
|  | 721 | nh->nh_flags &= ~RTNH_F_DEAD; | 
|  | 722 | spin_unlock_bh(&dn_fib_multipath_lock); | 
|  | 723 | } endfor_nexthops(fi); | 
|  | 724 |  | 
|  | 725 | if (alive > 0) { | 
|  | 726 | fi->fib_flags &= ~RTNH_F_DEAD; | 
|  | 727 | ret++; | 
|  | 728 | } | 
|  | 729 | } endfor_fib_info(); | 
|  | 730 | return ret; | 
|  | 731 | } | 
|  | 732 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 733 | static struct notifier_block dn_fib_dnaddr_notifier = { | 
|  | 734 | .notifier_call = dn_fib_dnaddr_event, | 
|  | 735 | }; | 
|  | 736 |  | 
|  | 737 | void __exit dn_fib_cleanup(void) | 
|  | 738 | { | 
|  | 739 | dn_fib_table_cleanup(); | 
|  | 740 | dn_fib_rules_cleanup(); | 
|  | 741 |  | 
|  | 742 | unregister_dnaddr_notifier(&dn_fib_dnaddr_notifier); | 
|  | 743 | } | 
|  | 744 |  | 
|  | 745 |  | 
|  | 746 | void __init dn_fib_init(void) | 
|  | 747 | { | 
|  | 748 |  | 
|  | 749 | dn_fib_table_init(); | 
|  | 750 | dn_fib_rules_init(); | 
|  | 751 |  | 
|  | 752 | register_dnaddr_notifier(&dn_fib_dnaddr_notifier); | 
|  | 753 | } | 
|  | 754 |  | 
|  | 755 |  |