| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | /* | 
|  | 2 | * xfrm_input.c | 
|  | 3 | * | 
|  | 4 | * Changes: | 
|  | 5 | * 	YOSHIFUJI Hideaki @USAGI | 
|  | 6 | * 		Split up af-specific portion | 
| YOSHIFUJI Hideaki | a716c11 | 2007-02-09 23:25:29 +0900 | [diff] [blame] | 7 | * | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 8 | */ | 
|  | 9 |  | 
|  | 10 | #include <linux/slab.h> | 
|  | 11 | #include <linux/module.h> | 
|  | 12 | #include <net/ip.h> | 
|  | 13 | #include <net/xfrm.h> | 
|  | 14 |  | 
| Christoph Lameter | e18b890 | 2006-12-06 20:33:20 -0800 | [diff] [blame] | 15 | static struct kmem_cache *secpath_cachep __read_mostly; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 16 |  | 
|  | 17 | void __secpath_destroy(struct sec_path *sp) | 
|  | 18 | { | 
|  | 19 | int i; | 
|  | 20 | for (i = 0; i < sp->len; i++) | 
| Herbert Xu | dbe5b4a | 2006-04-01 00:54:16 -0800 | [diff] [blame] | 21 | xfrm_state_put(sp->xvec[i]); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 22 | kmem_cache_free(secpath_cachep, sp); | 
|  | 23 | } | 
|  | 24 | EXPORT_SYMBOL(__secpath_destroy); | 
|  | 25 |  | 
|  | 26 | struct sec_path *secpath_dup(struct sec_path *src) | 
|  | 27 | { | 
|  | 28 | struct sec_path *sp; | 
|  | 29 |  | 
| Christoph Lameter | 54e6ecb | 2006-12-06 20:33:16 -0800 | [diff] [blame] | 30 | sp = kmem_cache_alloc(secpath_cachep, GFP_ATOMIC); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 31 | if (!sp) | 
|  | 32 | return NULL; | 
|  | 33 |  | 
|  | 34 | sp->len = 0; | 
|  | 35 | if (src) { | 
|  | 36 | int i; | 
|  | 37 |  | 
|  | 38 | memcpy(sp, src, sizeof(*sp)); | 
|  | 39 | for (i = 0; i < sp->len; i++) | 
| Herbert Xu | dbe5b4a | 2006-04-01 00:54:16 -0800 | [diff] [blame] | 40 | xfrm_state_hold(sp->xvec[i]); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 41 | } | 
|  | 42 | atomic_set(&sp->refcnt, 1); | 
|  | 43 | return sp; | 
|  | 44 | } | 
|  | 45 | EXPORT_SYMBOL(secpath_dup); | 
|  | 46 |  | 
|  | 47 | /* Fetch spi and seq from ipsec header */ | 
|  | 48 |  | 
| Al Viro | 6067b2b | 2006-09-27 18:47:59 -0700 | [diff] [blame] | 49 | int xfrm_parse_spi(struct sk_buff *skb, u8 nexthdr, __be32 *spi, __be32 *seq) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 50 | { | 
|  | 51 | int offset, offset_seq; | 
|  | 52 |  | 
|  | 53 | switch (nexthdr) { | 
|  | 54 | case IPPROTO_AH: | 
|  | 55 | offset = offsetof(struct ip_auth_hdr, spi); | 
|  | 56 | offset_seq = offsetof(struct ip_auth_hdr, seq_no); | 
|  | 57 | break; | 
|  | 58 | case IPPROTO_ESP: | 
|  | 59 | offset = offsetof(struct ip_esp_hdr, spi); | 
|  | 60 | offset_seq = offsetof(struct ip_esp_hdr, seq_no); | 
|  | 61 | break; | 
|  | 62 | case IPPROTO_COMP: | 
|  | 63 | if (!pskb_may_pull(skb, sizeof(struct ip_comp_hdr))) | 
|  | 64 | return -EINVAL; | 
| Arnaldo Carvalho de Melo | 9c70220 | 2007-04-25 18:04:18 -0700 | [diff] [blame] | 65 | *spi = htonl(ntohs(*(__be16*)(skb_transport_header(skb) + 2))); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 66 | *seq = 0; | 
|  | 67 | return 0; | 
|  | 68 | default: | 
|  | 69 | return 1; | 
|  | 70 | } | 
|  | 71 |  | 
|  | 72 | if (!pskb_may_pull(skb, 16)) | 
|  | 73 | return -EINVAL; | 
|  | 74 |  | 
| Arnaldo Carvalho de Melo | 9c70220 | 2007-04-25 18:04:18 -0700 | [diff] [blame] | 75 | *spi = *(__be32*)(skb_transport_header(skb) + offset); | 
|  | 76 | *seq = *(__be32*)(skb_transport_header(skb) + offset_seq); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 77 | return 0; | 
|  | 78 | } | 
|  | 79 | EXPORT_SYMBOL(xfrm_parse_spi); | 
|  | 80 |  | 
|  | 81 | void __init xfrm_input_init(void) | 
|  | 82 | { | 
|  | 83 | secpath_cachep = kmem_cache_create("secpath_cache", | 
|  | 84 | sizeof(struct sec_path), | 
| Alexey Dobriyan | e5d679f | 2006-08-26 19:25:52 -0700 | [diff] [blame] | 85 | 0, SLAB_HWCACHE_ALIGN|SLAB_PANIC, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 86 | NULL, NULL); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 87 | } |