12874c5fdSThomas Gleixner // SPDX-License-Identifier: GPL-2.0-or-later 2f66d7490SDavid Howells /* Peer event handling, typically ICMP messages. 38c3e34a4SDavid Howells * 48c3e34a4SDavid Howells * Copyright (C) 2007 Red Hat, Inc. All Rights Reserved. 58c3e34a4SDavid Howells * Written by David Howells (dhowells@redhat.com) 68c3e34a4SDavid Howells */ 78c3e34a4SDavid Howells 88c3e34a4SDavid Howells #include <linux/module.h> 98c3e34a4SDavid Howells #include <linux/net.h> 108c3e34a4SDavid Howells #include <linux/skbuff.h> 118c3e34a4SDavid Howells #include <linux/errqueue.h> 128c3e34a4SDavid Howells #include <linux/udp.h> 138c3e34a4SDavid Howells #include <linux/in.h> 148c3e34a4SDavid Howells #include <linux/in6.h> 158c3e34a4SDavid Howells #include <linux/icmp.h> 168c3e34a4SDavid Howells #include <net/sock.h> 178c3e34a4SDavid Howells #include <net/af_rxrpc.h> 188c3e34a4SDavid Howells #include <net/ip.h> 198c3e34a4SDavid Howells #include "ar-internal.h" 208c3e34a4SDavid Howells 21f66d7490SDavid Howells static void rxrpc_store_error(struct rxrpc_peer *, struct sock_exterr_skb *); 22f3344303SDavid Howells static void rxrpc_distribute_error(struct rxrpc_peer *, int, 23f3344303SDavid Howells enum rxrpc_call_completion); 24f66d7490SDavid Howells 258c3e34a4SDavid Howells /* 26be6e6707SDavid Howells * Find the peer associated with an ICMP packet. 27be6e6707SDavid Howells */ 28be6e6707SDavid Howells static struct rxrpc_peer *rxrpc_lookup_peer_icmp_rcu(struct rxrpc_local *local, 29494337c9SDavid Howells const struct sk_buff *skb, 30494337c9SDavid Howells struct sockaddr_rxrpc *srx) 31be6e6707SDavid Howells { 32be6e6707SDavid Howells struct sock_exterr_skb *serr = SKB_EXT_ERR(skb); 33be6e6707SDavid Howells 34be6e6707SDavid Howells _enter(""); 35be6e6707SDavid Howells 36494337c9SDavid Howells memset(srx, 0, sizeof(*srx)); 37494337c9SDavid Howells srx->transport_type = local->srx.transport_type; 38494337c9SDavid Howells srx->transport_len = local->srx.transport_len; 39494337c9SDavid Howells srx->transport.family = local->srx.transport.family; 40be6e6707SDavid Howells 41be6e6707SDavid Howells /* Can we see an ICMP4 packet on an ICMP6 listening socket? and vice 42be6e6707SDavid Howells * versa? 43be6e6707SDavid Howells */ 44494337c9SDavid Howells switch (srx->transport.family) { 45be6e6707SDavid Howells case AF_INET: 4646894a13SDavid Howells srx->transport_len = sizeof(srx->transport.sin); 4746894a13SDavid Howells srx->transport.family = AF_INET; 48494337c9SDavid Howells srx->transport.sin.sin_port = serr->port; 49be6e6707SDavid Howells switch (serr->ee.ee_origin) { 50be6e6707SDavid Howells case SO_EE_ORIGIN_ICMP: 51be6e6707SDavid Howells _net("Rx ICMP"); 52494337c9SDavid Howells memcpy(&srx->transport.sin.sin_addr, 53be6e6707SDavid Howells skb_network_header(skb) + serr->addr_offset, 54be6e6707SDavid Howells sizeof(struct in_addr)); 55be6e6707SDavid Howells break; 56be6e6707SDavid Howells case SO_EE_ORIGIN_ICMP6: 57be6e6707SDavid Howells _net("Rx ICMP6 on v4 sock"); 58494337c9SDavid Howells memcpy(&srx->transport.sin.sin_addr, 59be6e6707SDavid Howells skb_network_header(skb) + serr->addr_offset + 12, 60be6e6707SDavid Howells sizeof(struct in_addr)); 61be6e6707SDavid Howells break; 62be6e6707SDavid Howells default: 63494337c9SDavid Howells memcpy(&srx->transport.sin.sin_addr, &ip_hdr(skb)->saddr, 64be6e6707SDavid Howells sizeof(struct in_addr)); 65be6e6707SDavid Howells break; 66be6e6707SDavid Howells } 67be6e6707SDavid Howells break; 68be6e6707SDavid Howells 69d1912747SDavid Howells #ifdef CONFIG_AF_RXRPC_IPV6 7075b54cb5SDavid Howells case AF_INET6: 7175b54cb5SDavid Howells switch (serr->ee.ee_origin) { 7275b54cb5SDavid Howells case SO_EE_ORIGIN_ICMP6: 7375b54cb5SDavid Howells _net("Rx ICMP6"); 7446894a13SDavid Howells srx->transport.sin6.sin6_port = serr->port; 75494337c9SDavid Howells memcpy(&srx->transport.sin6.sin6_addr, 7675b54cb5SDavid Howells skb_network_header(skb) + serr->addr_offset, 7775b54cb5SDavid Howells sizeof(struct in6_addr)); 7875b54cb5SDavid Howells break; 7975b54cb5SDavid Howells case SO_EE_ORIGIN_ICMP: 8075b54cb5SDavid Howells _net("Rx ICMP on v6 sock"); 8146894a13SDavid Howells srx->transport_len = sizeof(srx->transport.sin); 8246894a13SDavid Howells srx->transport.family = AF_INET; 8346894a13SDavid Howells srx->transport.sin.sin_port = serr->port; 8446894a13SDavid Howells memcpy(&srx->transport.sin.sin_addr, 8575b54cb5SDavid Howells skb_network_header(skb) + serr->addr_offset, 8675b54cb5SDavid Howells sizeof(struct in_addr)); 8775b54cb5SDavid Howells break; 8875b54cb5SDavid Howells default: 89494337c9SDavid Howells memcpy(&srx->transport.sin6.sin6_addr, 9075b54cb5SDavid Howells &ipv6_hdr(skb)->saddr, 9175b54cb5SDavid Howells sizeof(struct in6_addr)); 9275b54cb5SDavid Howells break; 9375b54cb5SDavid Howells } 9475b54cb5SDavid Howells break; 95d1912747SDavid Howells #endif 9675b54cb5SDavid Howells 97be6e6707SDavid Howells default: 98be6e6707SDavid Howells BUG(); 99be6e6707SDavid Howells } 100be6e6707SDavid Howells 101494337c9SDavid Howells return rxrpc_lookup_peer_rcu(local, srx); 102be6e6707SDavid Howells } 103be6e6707SDavid Howells 104be6e6707SDavid Howells /* 1051a70c05bSDavid Howells * Handle an MTU/fragmentation problem. 1061a70c05bSDavid Howells */ 1071a70c05bSDavid Howells static void rxrpc_adjust_mtu(struct rxrpc_peer *peer, struct sock_exterr_skb *serr) 1081a70c05bSDavid Howells { 1091a70c05bSDavid Howells u32 mtu = serr->ee.ee_info; 1101a70c05bSDavid Howells 1111a70c05bSDavid Howells _net("Rx ICMP Fragmentation Needed (%d)", mtu); 1121a70c05bSDavid Howells 1131a70c05bSDavid Howells /* wind down the local interface MTU */ 1141a70c05bSDavid Howells if (mtu > 0 && peer->if_mtu == 65535 && mtu < peer->if_mtu) { 1151a70c05bSDavid Howells peer->if_mtu = mtu; 1161a70c05bSDavid Howells _net("I/F MTU %u", mtu); 1171a70c05bSDavid Howells } 1181a70c05bSDavid Howells 1191a70c05bSDavid Howells if (mtu == 0) { 1201a70c05bSDavid Howells /* they didn't give us a size, estimate one */ 1211a70c05bSDavid Howells mtu = peer->if_mtu; 1221a70c05bSDavid Howells if (mtu > 1500) { 1231a70c05bSDavid Howells mtu >>= 1; 1241a70c05bSDavid Howells if (mtu < 1500) 1251a70c05bSDavid Howells mtu = 1500; 1261a70c05bSDavid Howells } else { 1271a70c05bSDavid Howells mtu -= 100; 1281a70c05bSDavid Howells if (mtu < peer->hdrsize) 1291a70c05bSDavid Howells mtu = peer->hdrsize + 4; 1301a70c05bSDavid Howells } 1311a70c05bSDavid Howells } 1321a70c05bSDavid Howells 1331a70c05bSDavid Howells if (mtu < peer->mtu) { 1341a70c05bSDavid Howells spin_lock_bh(&peer->lock); 1351a70c05bSDavid Howells peer->mtu = mtu; 1361a70c05bSDavid Howells peer->maxdata = peer->mtu - peer->hdrsize; 1371a70c05bSDavid Howells spin_unlock_bh(&peer->lock); 1381a70c05bSDavid Howells _net("Net MTU %u (maxdata %u)", 1391a70c05bSDavid Howells peer->mtu, peer->maxdata); 1401a70c05bSDavid Howells } 1411a70c05bSDavid Howells } 1421a70c05bSDavid Howells 1431a70c05bSDavid Howells /* 144f66d7490SDavid Howells * Handle an error received on the local endpoint. 1458c3e34a4SDavid Howells */ 146abe89ef0SDavid Howells void rxrpc_error_report(struct sock *sk) 1478c3e34a4SDavid Howells { 1488c3e34a4SDavid Howells struct sock_exterr_skb *serr; 149494337c9SDavid Howells struct sockaddr_rxrpc srx; 1502ca4f6caSEric Dumazet struct rxrpc_local *local; 1518c3e34a4SDavid Howells struct rxrpc_peer *peer; 1528c3e34a4SDavid Howells struct sk_buff *skb; 1538c3e34a4SDavid Howells 1542ca4f6caSEric Dumazet rcu_read_lock(); 1552ca4f6caSEric Dumazet local = rcu_dereference_sk_user_data(sk); 1562ca4f6caSEric Dumazet if (unlikely(!local)) { 1572ca4f6caSEric Dumazet rcu_read_unlock(); 158f0308fb0SDavid Howells return; 1592ca4f6caSEric Dumazet } 1608c3e34a4SDavid Howells _enter("%p{%d}", sk, local->debug_id); 1618c3e34a4SDavid Howells 16256d282d9SMarc Dionne /* Clear the outstanding error value on the socket so that it doesn't 16356d282d9SMarc Dionne * cause kernel_sendmsg() to return it later. 16456d282d9SMarc Dionne */ 16556d282d9SMarc Dionne sock_error(sk); 16656d282d9SMarc Dionne 1678c3e34a4SDavid Howells skb = sock_dequeue_err_skb(sk); 1688c3e34a4SDavid Howells if (!skb) { 1692ca4f6caSEric Dumazet rcu_read_unlock(); 1708c3e34a4SDavid Howells _leave("UDP socket errqueue empty"); 1718c3e34a4SDavid Howells return; 1728c3e34a4SDavid Howells } 173987db9f7SDavid Howells rxrpc_new_skb(skb, rxrpc_skb_received); 1748c3e34a4SDavid Howells serr = SKB_EXT_ERR(skb); 1758c3e34a4SDavid Howells if (!skb->len && serr->ee.ee_origin == SO_EE_ORIGIN_TIMESTAMPING) { 1768c3e34a4SDavid Howells _leave("UDP empty message"); 1772ca4f6caSEric Dumazet rcu_read_unlock(); 178987db9f7SDavid Howells rxrpc_free_skb(skb, rxrpc_skb_freed); 1798c3e34a4SDavid Howells return; 1808c3e34a4SDavid Howells } 1818c3e34a4SDavid Howells 182494337c9SDavid Howells peer = rxrpc_lookup_peer_icmp_rcu(local, skb, &srx); 183be6e6707SDavid Howells if (peer && !rxrpc_get_peer_maybe(peer)) 184be6e6707SDavid Howells peer = NULL; 185be6e6707SDavid Howells if (!peer) { 186be6e6707SDavid Howells rcu_read_unlock(); 187987db9f7SDavid Howells rxrpc_free_skb(skb, rxrpc_skb_freed); 1888c3e34a4SDavid Howells _leave(" [no peer]"); 1898c3e34a4SDavid Howells return; 1908c3e34a4SDavid Howells } 1918c3e34a4SDavid Howells 192494337c9SDavid Howells trace_rxrpc_rx_icmp(peer, &serr->ee, &srx); 193494337c9SDavid Howells 1941a70c05bSDavid Howells if ((serr->ee.ee_origin == SO_EE_ORIGIN_ICMP && 1958c3e34a4SDavid Howells serr->ee.ee_type == ICMP_DEST_UNREACH && 1961a70c05bSDavid Howells serr->ee.ee_code == ICMP_FRAG_NEEDED)) { 1971a70c05bSDavid Howells rxrpc_adjust_mtu(peer, serr); 198be6e6707SDavid Howells rcu_read_unlock(); 199987db9f7SDavid Howells rxrpc_free_skb(skb, rxrpc_skb_freed); 2008c3e34a4SDavid Howells rxrpc_put_peer(peer); 201f66d7490SDavid Howells _leave(" [MTU update]"); 202f66d7490SDavid Howells return; 2031a70c05bSDavid Howells } 204f66d7490SDavid Howells 205f66d7490SDavid Howells rxrpc_store_error(peer, serr); 206f66d7490SDavid Howells rcu_read_unlock(); 207987db9f7SDavid Howells rxrpc_free_skb(skb, rxrpc_skb_freed); 2081890fea7SDavid Howells rxrpc_put_peer(peer); 209f66d7490SDavid Howells 2108c3e34a4SDavid Howells _leave(""); 2118c3e34a4SDavid Howells } 2128c3e34a4SDavid Howells 2138c3e34a4SDavid Howells /* 214f66d7490SDavid Howells * Map an error report to error codes on the peer record. 2158c3e34a4SDavid Howells */ 216f66d7490SDavid Howells static void rxrpc_store_error(struct rxrpc_peer *peer, 217f66d7490SDavid Howells struct sock_exterr_skb *serr) 2188c3e34a4SDavid Howells { 219f3344303SDavid Howells enum rxrpc_call_completion compl = RXRPC_CALL_NETWORK_ERROR; 2208c3e34a4SDavid Howells struct sock_extended_err *ee; 2218c3e34a4SDavid Howells int err; 2228c3e34a4SDavid Howells 2238c3e34a4SDavid Howells _enter(""); 2248c3e34a4SDavid Howells 2258c3e34a4SDavid Howells ee = &serr->ee; 2268c3e34a4SDavid Howells 2278c3e34a4SDavid Howells err = ee->ee_errno; 2288c3e34a4SDavid Howells 2298c3e34a4SDavid Howells switch (ee->ee_origin) { 2308c3e34a4SDavid Howells case SO_EE_ORIGIN_ICMP: 2318c3e34a4SDavid Howells switch (ee->ee_type) { 2328c3e34a4SDavid Howells case ICMP_DEST_UNREACH: 2338c3e34a4SDavid Howells switch (ee->ee_code) { 2348c3e34a4SDavid Howells case ICMP_NET_UNREACH: 2358c3e34a4SDavid Howells _net("Rx Received ICMP Network Unreachable"); 2368c3e34a4SDavid Howells break; 2378c3e34a4SDavid Howells case ICMP_HOST_UNREACH: 2388c3e34a4SDavid Howells _net("Rx Received ICMP Host Unreachable"); 2398c3e34a4SDavid Howells break; 2408c3e34a4SDavid Howells case ICMP_PORT_UNREACH: 2418c3e34a4SDavid Howells _net("Rx Received ICMP Port Unreachable"); 2428c3e34a4SDavid Howells break; 2438c3e34a4SDavid Howells case ICMP_NET_UNKNOWN: 2448c3e34a4SDavid Howells _net("Rx Received ICMP Unknown Network"); 2458c3e34a4SDavid Howells break; 2468c3e34a4SDavid Howells case ICMP_HOST_UNKNOWN: 2478c3e34a4SDavid Howells _net("Rx Received ICMP Unknown Host"); 2488c3e34a4SDavid Howells break; 2498c3e34a4SDavid Howells default: 2508c3e34a4SDavid Howells _net("Rx Received ICMP DestUnreach code=%u", 2518c3e34a4SDavid Howells ee->ee_code); 2528c3e34a4SDavid Howells break; 2538c3e34a4SDavid Howells } 2548c3e34a4SDavid Howells break; 2558c3e34a4SDavid Howells 2568c3e34a4SDavid Howells case ICMP_TIME_EXCEEDED: 2578c3e34a4SDavid Howells _net("Rx Received ICMP TTL Exceeded"); 2588c3e34a4SDavid Howells break; 2598c3e34a4SDavid Howells 2608c3e34a4SDavid Howells default: 2618c3e34a4SDavid Howells _proto("Rx Received ICMP error { type=%u code=%u }", 2628c3e34a4SDavid Howells ee->ee_type, ee->ee_code); 2638c3e34a4SDavid Howells break; 2648c3e34a4SDavid Howells } 2658c3e34a4SDavid Howells break; 2668c3e34a4SDavid Howells 267f66d7490SDavid Howells case SO_EE_ORIGIN_NONE: 2688c3e34a4SDavid Howells case SO_EE_ORIGIN_LOCAL: 269fe77d5fcSDavid Howells _proto("Rx Received local error { error=%d }", err); 270f3344303SDavid Howells compl = RXRPC_CALL_LOCAL_ERROR; 2718c3e34a4SDavid Howells break; 2728c3e34a4SDavid Howells 2738c3e34a4SDavid Howells case SO_EE_ORIGIN_ICMP6: 2748c3e34a4SDavid Howells default: 275fe77d5fcSDavid Howells _proto("Rx Received error report { orig=%u }", ee->ee_origin); 2768c3e34a4SDavid Howells break; 2778c3e34a4SDavid Howells } 2788c3e34a4SDavid Howells 279f3344303SDavid Howells rxrpc_distribute_error(peer, err, compl); 280f66d7490SDavid Howells } 2818c3e34a4SDavid Howells 282f66d7490SDavid Howells /* 283f3344303SDavid Howells * Distribute an error that occurred on a peer. 284f66d7490SDavid Howells */ 285f3344303SDavid Howells static void rxrpc_distribute_error(struct rxrpc_peer *peer, int error, 286f3344303SDavid Howells enum rxrpc_call_completion compl) 287f66d7490SDavid Howells { 288f66d7490SDavid Howells struct rxrpc_call *call; 2898c3e34a4SDavid Howells 290f3344303SDavid Howells hlist_for_each_entry_rcu(call, &peer->error_targets, error_link) { 291e34d4234SDavid Howells rxrpc_see_call(call); 292f3344303SDavid Howells if (call->state < RXRPC_CALL_COMPLETE && 293f3344303SDavid Howells rxrpc_set_call_completion(call, compl, 0, -error)) 294248f219cSDavid Howells rxrpc_notify_socket(call); 2958c3e34a4SDavid Howells } 2968c3e34a4SDavid Howells } 297cf1a6474SDavid Howells 298cf1a6474SDavid Howells /* 299cf1a6474SDavid Howells * Add RTT information to cache. This is called in softirq mode and has 300cf1a6474SDavid Howells * exclusive access to the peer RTT data. 301cf1a6474SDavid Howells */ 302cf1a6474SDavid Howells void rxrpc_peer_add_rtt(struct rxrpc_call *call, enum rxrpc_rtt_rx_trace why, 303cf1a6474SDavid Howells rxrpc_serial_t send_serial, rxrpc_serial_t resp_serial, 304cf1a6474SDavid Howells ktime_t send_time, ktime_t resp_time) 305cf1a6474SDavid Howells { 306cf1a6474SDavid Howells struct rxrpc_peer *peer = call->peer; 307cf1a6474SDavid Howells s64 rtt; 308cf1a6474SDavid Howells u64 sum = peer->rtt_sum, avg; 309cf1a6474SDavid Howells u8 cursor = peer->rtt_cursor, usage = peer->rtt_usage; 310cf1a6474SDavid Howells 311cf1a6474SDavid Howells rtt = ktime_to_ns(ktime_sub(resp_time, send_time)); 312cf1a6474SDavid Howells if (rtt < 0) 313cf1a6474SDavid Howells return; 314cf1a6474SDavid Howells 315c1e15b49SDavid Howells spin_lock(&peer->rtt_input_lock); 316c1e15b49SDavid Howells 317cf1a6474SDavid Howells /* Replace the oldest datum in the RTT buffer */ 318cf1a6474SDavid Howells sum -= peer->rtt_cache[cursor]; 319cf1a6474SDavid Howells sum += rtt; 320cf1a6474SDavid Howells peer->rtt_cache[cursor] = rtt; 321cf1a6474SDavid Howells peer->rtt_cursor = (cursor + 1) & (RXRPC_RTT_CACHE_SIZE - 1); 322cf1a6474SDavid Howells peer->rtt_sum = sum; 323cf1a6474SDavid Howells if (usage < RXRPC_RTT_CACHE_SIZE) { 324cf1a6474SDavid Howells usage++; 325cf1a6474SDavid Howells peer->rtt_usage = usage; 326cf1a6474SDavid Howells } 327cf1a6474SDavid Howells 328c1e15b49SDavid Howells spin_unlock(&peer->rtt_input_lock); 329c1e15b49SDavid Howells 330cf1a6474SDavid Howells /* Now recalculate the average */ 331cf1a6474SDavid Howells if (usage == RXRPC_RTT_CACHE_SIZE) { 332cf1a6474SDavid Howells avg = sum / RXRPC_RTT_CACHE_SIZE; 333cf1a6474SDavid Howells } else { 334cf1a6474SDavid Howells avg = sum; 335cf1a6474SDavid Howells do_div(avg, usage); 336cf1a6474SDavid Howells } 337cf1a6474SDavid Howells 338c1e15b49SDavid Howells /* Don't need to update this under lock */ 339cf1a6474SDavid Howells peer->rtt = avg; 340cf1a6474SDavid Howells trace_rxrpc_rtt_rx(call, why, send_serial, resp_serial, rtt, 341cf1a6474SDavid Howells usage, avg); 342cf1a6474SDavid Howells } 343ace45becSDavid Howells 344ace45becSDavid Howells /* 345330bdcfaSDavid Howells * Perform keep-alive pings. 346330bdcfaSDavid Howells */ 347330bdcfaSDavid Howells static void rxrpc_peer_keepalive_dispatch(struct rxrpc_net *rxnet, 348330bdcfaSDavid Howells struct list_head *collector, 349330bdcfaSDavid Howells time64_t base, 350330bdcfaSDavid Howells u8 cursor) 351330bdcfaSDavid Howells { 352330bdcfaSDavid Howells struct rxrpc_peer *peer; 353330bdcfaSDavid Howells const u8 mask = ARRAY_SIZE(rxnet->peer_keepalive) - 1; 354330bdcfaSDavid Howells time64_t keepalive_at; 355330bdcfaSDavid Howells int slot; 356330bdcfaSDavid Howells 357330bdcfaSDavid Howells spin_lock_bh(&rxnet->peer_hash_lock); 358330bdcfaSDavid Howells 359330bdcfaSDavid Howells while (!list_empty(collector)) { 360330bdcfaSDavid Howells peer = list_entry(collector->next, 361330bdcfaSDavid Howells struct rxrpc_peer, keepalive_link); 362330bdcfaSDavid Howells 363330bdcfaSDavid Howells list_del_init(&peer->keepalive_link); 364330bdcfaSDavid Howells if (!rxrpc_get_peer_maybe(peer)) 365330bdcfaSDavid Howells continue; 366330bdcfaSDavid Howells 367330bdcfaSDavid Howells spin_unlock_bh(&rxnet->peer_hash_lock); 368330bdcfaSDavid Howells 369330bdcfaSDavid Howells keepalive_at = peer->last_tx_at + RXRPC_KEEPALIVE_TIME; 370330bdcfaSDavid Howells slot = keepalive_at - base; 371330bdcfaSDavid Howells _debug("%02x peer %u t=%d {%pISp}", 372330bdcfaSDavid Howells cursor, peer->debug_id, slot, &peer->srx.transport); 373330bdcfaSDavid Howells 374330bdcfaSDavid Howells if (keepalive_at <= base || 375330bdcfaSDavid Howells keepalive_at > base + RXRPC_KEEPALIVE_TIME) { 376330bdcfaSDavid Howells rxrpc_send_keepalive(peer); 377330bdcfaSDavid Howells slot = RXRPC_KEEPALIVE_TIME; 378330bdcfaSDavid Howells } 379330bdcfaSDavid Howells 380330bdcfaSDavid Howells /* A transmission to this peer occurred since last we examined 381330bdcfaSDavid Howells * it so put it into the appropriate future bucket. 382330bdcfaSDavid Howells */ 383330bdcfaSDavid Howells slot += cursor; 384330bdcfaSDavid Howells slot &= mask; 385330bdcfaSDavid Howells spin_lock_bh(&rxnet->peer_hash_lock); 386330bdcfaSDavid Howells list_add_tail(&peer->keepalive_link, 387330bdcfaSDavid Howells &rxnet->peer_keepalive[slot & mask]); 38860034d3dSDavid Howells rxrpc_put_peer_locked(peer); 389330bdcfaSDavid Howells } 390330bdcfaSDavid Howells 391330bdcfaSDavid Howells spin_unlock_bh(&rxnet->peer_hash_lock); 392330bdcfaSDavid Howells } 393330bdcfaSDavid Howells 394330bdcfaSDavid Howells /* 395ace45becSDavid Howells * Perform keep-alive pings with VERSION packets to keep any NAT alive. 396ace45becSDavid Howells */ 397ace45becSDavid Howells void rxrpc_peer_keepalive_worker(struct work_struct *work) 398ace45becSDavid Howells { 399ace45becSDavid Howells struct rxrpc_net *rxnet = 400ace45becSDavid Howells container_of(work, struct rxrpc_net, peer_keepalive_work); 401330bdcfaSDavid Howells const u8 mask = ARRAY_SIZE(rxnet->peer_keepalive) - 1; 402330bdcfaSDavid Howells time64_t base, now, delay; 403330bdcfaSDavid Howells u8 cursor, stop; 404330bdcfaSDavid Howells LIST_HEAD(collector); 405ace45becSDavid Howells 406330bdcfaSDavid Howells now = ktime_get_seconds(); 407ace45becSDavid Howells base = rxnet->peer_keepalive_base; 408ace45becSDavid Howells cursor = rxnet->peer_keepalive_cursor; 409330bdcfaSDavid Howells _enter("%lld,%u", base - now, cursor); 410ace45becSDavid Howells 411330bdcfaSDavid Howells if (!rxnet->live) 412330bdcfaSDavid Howells return; 413ace45becSDavid Howells 414330bdcfaSDavid Howells /* Remove to a temporary list all the peers that are currently lodged 415330bdcfaSDavid Howells * in expired buckets plus all new peers. 416330bdcfaSDavid Howells * 417330bdcfaSDavid Howells * Everything in the bucket at the cursor is processed this 418330bdcfaSDavid Howells * second; the bucket at cursor + 1 goes at now + 1s and so 419330bdcfaSDavid Howells * on... 420ace45becSDavid Howells */ 421ace45becSDavid Howells spin_lock_bh(&rxnet->peer_hash_lock); 422330bdcfaSDavid Howells list_splice_init(&rxnet->peer_keepalive_new, &collector); 423ace45becSDavid Howells 424330bdcfaSDavid Howells stop = cursor + ARRAY_SIZE(rxnet->peer_keepalive); 425330bdcfaSDavid Howells while (base <= now && (s8)(cursor - stop) < 0) { 426330bdcfaSDavid Howells list_splice_tail_init(&rxnet->peer_keepalive[cursor & mask], 427330bdcfaSDavid Howells &collector); 428330bdcfaSDavid Howells base++; 429ace45becSDavid Howells cursor++; 430330bdcfaSDavid Howells } 431ace45becSDavid Howells 432330bdcfaSDavid Howells base = now; 433330bdcfaSDavid Howells spin_unlock_bh(&rxnet->peer_hash_lock); 434330bdcfaSDavid Howells 435ace45becSDavid Howells rxnet->peer_keepalive_base = base; 436ace45becSDavid Howells rxnet->peer_keepalive_cursor = cursor; 437330bdcfaSDavid Howells rxrpc_peer_keepalive_dispatch(rxnet, &collector, base, cursor); 438330bdcfaSDavid Howells ASSERT(list_empty(&collector)); 439330bdcfaSDavid Howells 440330bdcfaSDavid Howells /* Schedule the timer for the next occupied timeslot. */ 441330bdcfaSDavid Howells cursor = rxnet->peer_keepalive_cursor; 442330bdcfaSDavid Howells stop = cursor + RXRPC_KEEPALIVE_TIME - 1; 443330bdcfaSDavid Howells for (; (s8)(cursor - stop) < 0; cursor++) { 444330bdcfaSDavid Howells if (!list_empty(&rxnet->peer_keepalive[cursor & mask])) 445330bdcfaSDavid Howells break; 446330bdcfaSDavid Howells base++; 447330bdcfaSDavid Howells } 448330bdcfaSDavid Howells 449330bdcfaSDavid Howells now = ktime_get_seconds(); 450330bdcfaSDavid Howells delay = base - now; 451330bdcfaSDavid Howells if (delay < 1) 452330bdcfaSDavid Howells delay = 1; 453330bdcfaSDavid Howells delay *= HZ; 454330bdcfaSDavid Howells if (rxnet->live) 455ace45becSDavid Howells timer_reduce(&rxnet->peer_keepalive_timer, jiffies + delay); 456330bdcfaSDavid Howells 457ace45becSDavid Howells _leave(""); 458ace45becSDavid Howells } 459