Signed-off-by: Jukka Rissanen <jukka.rissanen@xxxxxxxxxxxxxxx>
---
net/bluetooth/6lowpan.c | 37 +++++++++++++++++++++++++++++++++++++
1 file changed, 37 insertions(+)
diff --git a/net/bluetooth/6lowpan.c b/net/bluetooth/6lowpan.c
index d33a32e..e70302a 100644
--- a/net/bluetooth/6lowpan.c
+++ b/net/bluetooth/6lowpan.c
@@ -1395,6 +1395,38 @@ static void set_dev_addr(struct net_device *net, bdaddr_t *addr,
net->dev_addr[0] ^= 2;
}
+static int add_peer_route(struct peer *dev, struct net_device *net,
+ bdaddr_t *addr, u8 addr_type)
+{
+ struct in6_addr peer_addr;
+ struct fib6_config cfg = {
+ .fc_table = RT6_TABLE_MAIN,
+ .fc_metric = IP6_RT_PRIO_ADDRCONF,
+ .fc_ifindex = net->ifindex,
+ .fc_dst_len = 128,
+ .fc_flags = RTF_ADDRCONF | RTF_UP |
+ RTF_PREF(ICMPV6_ROUTER_PREF_MEDIUM),
+ .fc_nlinfo.portid = 0,
+ .fc_nlinfo.nlh = NULL,
+ .fc_nlinfo.nl_net = dev_net(net),
+ };
+
+ memset(&peer_addr, 0, sizeof(struct in6_addr));
+
+ /* RFC 2464 ch. 5 */
+ peer_addr.s6_addr[0] = 0xFE;
+ peer_addr.s6_addr[1] = 0x80;
+ set_addr((u8 *)&peer_addr.s6_addr + 8, addr->b, addr_type);
+
+ memcpy(&dev->eui64_addr, (u8 *)&peer_addr.s6_addr + 8, EUI64_ADDR_LEN);
+
+ BT_DBG("peer address %pI6c", (u8 *)&peer_addr.s6_addr);
+
+ cfg.fc_dst = dev->peer_addr = peer_addr;
+
+ return ip6_route_add(&cfg);
+}
+
static void ifup(struct net_device *net)
{
int err;
@@ -1492,6 +1524,11 @@ add_peer:
peer_add(dev, peer);
write_unlock(&devices_lock);
+ err = add_peer_route(peer, dev->net, &conn->hcon->dst,
+ conn->hcon->dst_type);
+ if (err < 0)
+ BT_INFO("Setting route failed %d", err);
+
out:
return err;
}
--
1.8.3.1
--
To unsubscribe from this list: send the line "unsubscribe linux-bluetooth" in
the body of a message to majordomo@xxxxxxxxxxxxxxx
More majordomo info at http://vger.kernel.org/majordomo-info.html
