Blame view

net/rxrpc/utils.c 1.81 KB
81f7e3824   Eric Lee   Initial Release, ...
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
  /* Utility routines
   *
   * Copyright (C) 2015 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 Licence
   * as published by the Free Software Foundation; either version
   * 2 of the Licence, or (at your option) any later version.
   */
  
  #include <linux/ip.h>
  #include <linux/ipv6.h>
  #include <linux/udp.h>
  #include "ar-internal.h"
  
  /*
   * Fill out a peer address from a socket buffer containing a packet.
   */
  int rxrpc_extract_addr_from_skb(struct rxrpc_local *local,
  				struct sockaddr_rxrpc *srx,
  				struct sk_buff *skb)
  {
  	memset(srx, 0, sizeof(*srx));
  
  	switch (ntohs(skb->protocol)) {
  	case ETH_P_IP:
  		if (local->srx.transport.family == AF_INET6) {
  			srx->transport_type = SOCK_DGRAM;
  			srx->transport_len = sizeof(srx->transport.sin6);
  			srx->transport.sin6.sin6_family = AF_INET6;
  			srx->transport.sin6.sin6_port = udp_hdr(skb)->source;
  			srx->transport.sin6.sin6_addr.s6_addr32[2] = htonl(0xffff);
  			srx->transport.sin6.sin6_addr.s6_addr32[3] = ip_hdr(skb)->saddr;
  		} else {
  			srx->transport_type = SOCK_DGRAM;
  			srx->transport_len = sizeof(srx->transport.sin);
  			srx->transport.sin.sin_family = AF_INET;
  			srx->transport.sin.sin_port = udp_hdr(skb)->source;
  			srx->transport.sin.sin_addr.s_addr = ip_hdr(skb)->saddr;
  		}
  		return 0;
  
  #ifdef CONFIG_AF_RXRPC_IPV6
  	case ETH_P_IPV6:
  		srx->transport_type = SOCK_DGRAM;
  		srx->transport_len = sizeof(srx->transport.sin6);
  		srx->transport.sin6.sin6_family = AF_INET6;
  		srx->transport.sin6.sin6_port = udp_hdr(skb)->source;
  		srx->transport.sin6.sin6_addr = ipv6_hdr(skb)->saddr;
  		return 0;
  #endif
  
  	default:
  		pr_warn_ratelimited("AF_RXRPC: Unknown eth protocol %u
  ",
  				    ntohs(skb->protocol));
  		return -EAFNOSUPPORT;
  	}
  }