linux-imx

/* Peer event handling, typically ICMP messages.

 *

 * Copyright (C) 2007 Red Hat, Inc. All Rights Reserved.

 * Written by David Howells (dhowells@redhat.com)

 *

 * This program is free software; you can redistribute it and/or

 * modify it under the terms of the GNU General Public License

 * as published by the Free Software Foundation; either version

 * 2 of the License, or (at your option) any later version.

 */

​

#include <linux/module.h>

#include <linux/net.h>

#include <linux/skbuff.h>

#include <linux/errqueue.h>

#include <linux/udp.h>

#include <linux/in.h>

#include <linux/in6.h>

#include <linux/icmp.h>

#include <net/sock.h>

#include <net/af_rxrpc.h>

#include <net/ip.h>

#include "ar-internal.h"

​

static void rxrpc_store_error(struct rxrpc_peer *, struct sock_exterr_skb *);

static void rxrpc_distribute_error(struct rxrpc_peer *, int,

                   enum rxrpc_call_completion);

​

/*

 * Find the peer associated with an ICMP packet.

 */

static struct rxrpc_peer *rxrpc_lookup_peer_icmp_rcu(struct rxrpc_local *local,

                             const struct sk_buff *skb,

                             struct sockaddr_rxrpc *srx)

{

    struct sock_exterr_skb *serr = SKB_EXT_ERR(skb);

​

    _enter("");

​

    memset(srx, 0, sizeof(*srx));

    srx->transport_type = local->srx.transport_type;

    srx->transport_len = local->srx.transport_len;

    srx->transport.family = local->srx.transport.family;

​

    /* Can we see an ICMP4 packet on an ICMP6 listening socket?  and vice

     * versa?

     */

    switch (srx->transport.family) {

    case AF_INET:

        srx->transport_len = sizeof(srx->transport.sin);

        srx->transport.family = AF_INET;

        srx->transport.sin.sin_port = serr->port;

        switch (serr->ee.ee_origin) {

        case SO_EE_ORIGIN_ICMP:

            _net("Rx ICMP");

            memcpy(&srx->transport.sin.sin_addr,

                   skb_network_header(skb) + serr->addr_offset,

                   sizeof(struct in_addr));

            break;

        case SO_EE_ORIGIN_ICMP6:

            _net("Rx ICMP6 on v4 sock");

            memcpy(&srx->transport.sin.sin_addr,

                   skb_network_header(skb) + serr->addr_offset + 12,

                   sizeof(struct in_addr));

            break;

        default:

            memcpy(&srx->transport.sin.sin_addr, &ip_hdr(skb)->saddr,

                   sizeof(struct in_addr));

            break;

        }

        break;

​

#ifdef CONFIG_AF_RXRPC_IPV6

    case AF_INET6:

        switch (serr->ee.ee_origin) {

        case SO_EE_ORIGIN_ICMP6:

            _net("Rx ICMP6");

            srx->transport.sin6.sin6_port = serr->port;

            memcpy(&srx->transport.sin6.sin6_addr,

                   skb_network_header(skb) + serr->addr_offset,

                   sizeof(struct in6_addr));

            break;

        case SO_EE_ORIGIN_ICMP:

            _net("Rx ICMP on v6 sock");

            srx->transport_len = sizeof(srx->transport.sin);

            srx->transport.family = AF_INET;

            srx->transport.sin.sin_port = serr->port;

            memcpy(&srx->transport.sin.sin_addr,

                   skb_network_header(skb) + serr->addr_offset,

                   sizeof(struct in_addr));

            break;

        default: