]>
Commit | Line | Data |
---|---|---|
12e41d03 DL |
1 | /* |
2 | PIM for Quagga | |
3 | Copyright (C) 2008 Everton da Silva Marques | |
4 | ||
5 | This program is free software; you can redistribute it and/or modify | |
6 | it under the terms of the GNU General Public License as published by | |
7 | the Free Software Foundation; either version 2 of the License, or | |
8 | (at your option) any later version. | |
9 | ||
10 | This program is distributed in the hope that it will be useful, but | |
11 | WITHOUT ANY WARRANTY; without even the implied warranty of | |
12 | MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU | |
13 | General Public License for more details. | |
14 | ||
15 | You should have received a copy of the GNU General Public License | |
16 | along with this program; see the file COPYING; if not, write to the | |
17 | Free Software Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, | |
18 | MA 02110-1301 USA | |
19 | ||
20 | $QuaggaId: $Format:%an, %ai, %h$ $ | |
21 | */ | |
22 | ||
23 | #include <zebra.h> | |
24 | ||
744d91b3 DS |
25 | #include "if.h" |
26 | ||
12e41d03 DL |
27 | #include "pimd.h" |
28 | #include "pim_pim.h" | |
29 | #include "pim_msg.h" | |
30 | #include "pim_util.h" | |
31 | ||
32 | void pim_msg_build_header(uint8_t *pim_msg, int pim_msg_size, | |
33 | uint8_t pim_msg_type) | |
34 | { | |
35 | uint16_t checksum; | |
36 | ||
37 | zassert(pim_msg_size >= PIM_PIM_MIN_LEN); | |
38 | ||
39 | /* | |
40 | * Write header | |
41 | */ | |
42 | ||
43 | *(uint8_t *) PIM_MSG_HDR_OFFSET_VERSION(pim_msg) = (PIM_PROTO_VERSION << 4) | pim_msg_type; | |
44 | *(uint8_t *) PIM_MSG_HDR_OFFSET_RESERVED(pim_msg) = 0; | |
45 | ||
46 | /* | |
47 | * Compute checksum | |
48 | */ | |
49 | ||
50 | *(uint16_t *) PIM_MSG_HDR_OFFSET_CHECKSUM(pim_msg) = 0; | |
51 | checksum = in_cksum(pim_msg, pim_msg_size); | |
52 | *(uint16_t *) PIM_MSG_HDR_OFFSET_CHECKSUM(pim_msg) = checksum; | |
53 | } | |
54 | ||
55 | uint8_t *pim_msg_addr_encode_ipv4_ucast(uint8_t *buf, | |
56 | int buf_size, | |
57 | struct in_addr addr) | |
58 | { | |
59 | const int ENCODED_IPV4_UCAST_SIZE = 6; | |
60 | ||
61 | if (buf_size < ENCODED_IPV4_UCAST_SIZE) { | |
62 | return 0; | |
63 | } | |
64 | ||
65 | buf[0] = PIM_MSG_ADDRESS_FAMILY_IPV4; /* addr family */ | |
66 | buf[1] = '\0'; /* native encoding */ | |
67 | memcpy(buf+2, &addr, sizeof(struct in_addr)); | |
68 | ||
69 | return buf + ENCODED_IPV4_UCAST_SIZE; | |
70 | } | |
71 | ||
72 | uint8_t *pim_msg_addr_encode_ipv4_group(uint8_t *buf, | |
73 | int buf_size, | |
74 | struct in_addr addr) | |
75 | { | |
76 | const int ENCODED_IPV4_GROUP_SIZE = 8; | |
77 | ||
78 | if (buf_size < ENCODED_IPV4_GROUP_SIZE) { | |
79 | return 0; | |
80 | } | |
81 | ||
82 | buf[0] = PIM_MSG_ADDRESS_FAMILY_IPV4; /* addr family */ | |
83 | buf[1] = '\0'; /* native encoding */ | |
84 | buf[2] = '\0'; /* reserved */ | |
85 | buf[3] = 32; /* mask len */ | |
86 | memcpy(buf+4, &addr, sizeof(struct in_addr)); | |
87 | ||
88 | return buf + ENCODED_IPV4_GROUP_SIZE; | |
89 | } | |
90 | ||
91 | uint8_t *pim_msg_addr_encode_ipv4_source(uint8_t *buf, | |
92 | int buf_size, | |
93 | struct in_addr addr) | |
94 | { | |
95 | const int ENCODED_IPV4_SOURCE_SIZE = 8; | |
96 | ||
97 | if (buf_size < ENCODED_IPV4_SOURCE_SIZE) { | |
98 | return 0; | |
99 | } | |
100 | ||
101 | buf[0] = PIM_MSG_ADDRESS_FAMILY_IPV4; /* addr family */ | |
102 | buf[1] = '\0'; /* native encoding */ | |
103 | buf[2] = 4; /* reserved = 0 | S bit = 1 | W bit = 0 | R bit = 0 */ | |
104 | buf[3] = 32; /* mask len */ | |
105 | memcpy(buf+4, &addr, sizeof(struct in_addr)); | |
106 | ||
107 | return buf + ENCODED_IPV4_SOURCE_SIZE; | |
108 | } |