Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | /* include/net/dsfield.h - Manipulation of the Differentiated Services field */ |
| 2 | |
| 3 | /* Written 1998-2000 by Werner Almesberger, EPFL ICA */ |
| 4 | |
| 5 | |
| 6 | #ifndef __NET_DSFIELD_H |
| 7 | #define __NET_DSFIELD_H |
| 8 | |
| 9 | #include <linux/types.h> |
| 10 | #include <linux/ip.h> |
| 11 | #include <linux/ipv6.h> |
| 12 | #include <asm/byteorder.h> |
| 13 | |
| 14 | |
Jan Engelhardt | 3c3f486 | 2007-12-04 23:37:29 -0800 | [diff] [blame] | 15 | static inline __u8 ipv4_get_dsfield(const struct iphdr *iph) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 16 | { |
| 17 | return iph->tos; |
| 18 | } |
| 19 | |
| 20 | |
Jan Engelhardt | 3c3f486 | 2007-12-04 23:37:29 -0800 | [diff] [blame] | 21 | static inline __u8 ipv6_get_dsfield(const struct ipv6hdr *ipv6h) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 22 | { |
Jan Engelhardt | 3c3f486 | 2007-12-04 23:37:29 -0800 | [diff] [blame] | 23 | return ntohs(*(const __be16 *)ipv6h) >> 4; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 24 | } |
| 25 | |
| 26 | |
| 27 | static inline void ipv4_change_dsfield(struct iphdr *iph,__u8 mask, |
| 28 | __u8 value) |
| 29 | { |
Al Viro | 5c78f27 | 2006-11-14 21:42:26 -0800 | [diff] [blame] | 30 | __u32 check = ntohs((__force __be16)iph->check); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 31 | __u8 dsfield; |
| 32 | |
| 33 | dsfield = (iph->tos & mask) | value; |
| 34 | check += iph->tos; |
| 35 | if ((check+1) >> 16) check = (check+1) & 0xffff; |
| 36 | check -= dsfield; |
| 37 | check += check >> 16; /* adjust carry */ |
Al Viro | 5c78f27 | 2006-11-14 21:42:26 -0800 | [diff] [blame] | 38 | iph->check = (__force __sum16)htons(check); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 39 | iph->tos = dsfield; |
| 40 | } |
| 41 | |
| 42 | |
| 43 | static inline void ipv6_change_dsfield(struct ipv6hdr *ipv6h,__u8 mask, |
| 44 | __u8 value) |
| 45 | { |
YOSHIFUJI Hideaki / 吉藤英明 | a0376db | 2013-01-08 06:47:08 +0000 | [diff] [blame] | 46 | __be16 *p = (__force __be16 *)ipv6h; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 47 | |
YOSHIFUJI Hideaki / 吉藤英明 | a0376db | 2013-01-08 06:47:08 +0000 | [diff] [blame] | 48 | *p = (*p & htons((((u16)mask << 4) | 0xf00f))) | htons((u16)value << 4); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 49 | } |
| 50 | |
| 51 | |
| 52 | #endif |