[21580dd] | 1 | /*
|
---|
| 2 | * Copyright (c) 2009 Lukas Mejdrech
|
---|
| 3 | * All rights reserved.
|
---|
| 4 | *
|
---|
| 5 | * Redistribution and use in source and binary forms, with or without
|
---|
| 6 | * modification, are permitted provided that the following conditions
|
---|
| 7 | * are met:
|
---|
| 8 | *
|
---|
| 9 | * - Redistributions of source code must retain the above copyright
|
---|
| 10 | * notice, this list of conditions and the following disclaimer.
|
---|
| 11 | * - Redistributions in binary form must reproduce the above copyright
|
---|
| 12 | * notice, this list of conditions and the following disclaimer in the
|
---|
| 13 | * documentation and/or other materials provided with the distribution.
|
---|
| 14 | * - The name of the author may not be used to endorse or promote products
|
---|
| 15 | * derived from this software without specific prior written permission.
|
---|
| 16 | *
|
---|
| 17 | * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
|
---|
| 18 | * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
|
---|
| 19 | * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
|
---|
| 20 | * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
|
---|
| 21 | * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
|
---|
| 22 | * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
|
---|
| 23 | * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
|
---|
| 24 | * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
|
---|
| 25 | * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
|
---|
| 26 | * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
---|
| 27 | */
|
---|
| 28 |
|
---|
[9b9d1c95] | 29 | /** @addtogroup libnet
|
---|
| 30 | * @{
|
---|
[21580dd] | 31 | */
|
---|
| 32 |
|
---|
| 33 | /** @file
|
---|
[9b9d1c95] | 34 | * IP client interface implementation.
|
---|
| 35 | * @see ip_client.h
|
---|
[21580dd] | 36 | */
|
---|
| 37 |
|
---|
| 38 | #include <errno.h>
|
---|
| 39 | #include <sys/types.h>
|
---|
| 40 |
|
---|
[849ed54] | 41 | #include <ip_client.h>
|
---|
[0a866eeb] | 42 | #include <packet_client.h>
|
---|
[849ed54] | 43 | #include <ip_header.h>
|
---|
[21580dd] | 44 |
|
---|
[c69d327] | 45 | #include <net/packet.h>
|
---|
[0a866eeb] | 46 |
|
---|
[9b9d1c95] | 47 | /** Returns the IP header length.
|
---|
| 48 | *
|
---|
| 49 | * @param[in] packet The packet.
|
---|
[1bfd3d3] | 50 | * @return The IP header length in bytes.
|
---|
| 51 | * @return Zero if there is no IP header.
|
---|
[9b9d1c95] | 52 | */
|
---|
[46d4d9f] | 53 | size_t ip_client_header_length(packet_t *packet)
|
---|
[9b9d1c95] | 54 | {
|
---|
[88a1bb9] | 55 | ip_header_t *header;
|
---|
[a64c64d] | 56 |
|
---|
[88a1bb9] | 57 | header = (ip_header_t *) packet_get_data(packet);
|
---|
[9b9d1c95] | 58 | if (!header || (packet_get_data_length(packet) < sizeof(ip_header_t)))
|
---|
[a64c64d] | 59 | return 0;
|
---|
[9b9d1c95] | 60 |
|
---|
[a64c64d] | 61 | return IP_HEADER_LENGTH(header);
|
---|
| 62 | }
|
---|
| 63 |
|
---|
[9b9d1c95] | 64 | /** Constructs the IPv4 pseudo header.
|
---|
| 65 | *
|
---|
| 66 | * @param[in] protocol The transport protocol.
|
---|
| 67 | * @param[in] src The source address.
|
---|
| 68 | * @param[in] srclen The source address length.
|
---|
| 69 | * @param[in] dest The destination address.
|
---|
| 70 | * @param[in] destlen The destination address length.
|
---|
| 71 | * @param[in] data_length The data length to be set.
|
---|
| 72 | * @param[out] header The constructed IPv4 pseudo header.
|
---|
| 73 | * @param[out] headerlen The length of the IP pseudo header in bytes.
|
---|
[1bfd3d3] | 74 | * @return EOK on success.
|
---|
| 75 | * @return EBADMEM if the header and/or the headerlen parameter is
|
---|
[9b9d1c95] | 76 | * NULL.
|
---|
[1bfd3d3] | 77 | * @return EINVAL if the source address and/or the destination
|
---|
[9b9d1c95] | 78 | * address parameter is NULL.
|
---|
[1bfd3d3] | 79 | * @return EINVAL if the source address length is less than struct
|
---|
[9b9d1c95] | 80 | * sockaddr length.
|
---|
[1bfd3d3] | 81 | * @return EINVAL if the source address length differs from the
|
---|
[9b9d1c95] | 82 | * destination address length.
|
---|
[1bfd3d3] | 83 | * @return EINVAL if the source address family differs from the
|
---|
[9b9d1c95] | 84 | * destination family.
|
---|
[1bfd3d3] | 85 | * @return EAFNOSUPPORT if the address family is not supported.
|
---|
| 86 | * @return ENOMEM if there is not enough memory left.
|
---|
[9b9d1c95] | 87 | */
|
---|
| 88 | int
|
---|
| 89 | ip_client_get_pseudo_header(ip_protocol_t protocol, struct sockaddr *src,
|
---|
| 90 | socklen_t srclen, struct sockaddr *dest, socklen_t destlen,
|
---|
| 91 | size_t data_length, void **header, size_t *headerlen)
|
---|
| 92 | {
|
---|
[88a1bb9] | 93 | ipv4_pseudo_header_t *header_in;
|
---|
[9b9d1c95] | 94 | struct sockaddr_in *address_in;
|
---|
[a64c64d] | 95 |
|
---|
[9b9d1c95] | 96 | if (!header || !headerlen)
|
---|
[a64c64d] | 97 | return EBADMEM;
|
---|
[9b9d1c95] | 98 |
|
---|
| 99 | if (!src || !dest || srclen <= 0 ||
|
---|
| 100 | (((size_t) srclen < sizeof(struct sockaddr))) ||
|
---|
| 101 | (srclen != destlen) || (src->sa_family != dest->sa_family)) {
|
---|
[a64c64d] | 102 | return EINVAL;
|
---|
| 103 | }
|
---|
| 104 |
|
---|
[9b9d1c95] | 105 | switch (src->sa_family) {
|
---|
| 106 | case AF_INET:
|
---|
| 107 | if (srclen != sizeof(struct sockaddr_in))
|
---|
| 108 | return EINVAL;
|
---|
| 109 |
|
---|
| 110 | *headerlen = sizeof(*header_in);
|
---|
[88a1bb9] | 111 | header_in = (ipv4_pseudo_header_t *) malloc(*headerlen);
|
---|
[9b9d1c95] | 112 | if (!header_in)
|
---|
| 113 | return ENOMEM;
|
---|
| 114 |
|
---|
| 115 | bzero(header_in, *headerlen);
|
---|
| 116 | address_in = (struct sockaddr_in *) dest;
|
---|
| 117 | header_in->destination_address = address_in->sin_addr.s_addr;
|
---|
| 118 | address_in = (struct sockaddr_in *) src;
|
---|
| 119 | header_in->source_address = address_in->sin_addr.s_addr;
|
---|
| 120 | header_in->protocol = protocol;
|
---|
| 121 | header_in->data_length = htons(data_length);
|
---|
| 122 | *header = header_in;
|
---|
| 123 | return EOK;
|
---|
| 124 |
|
---|
[ccca251] | 125 | // TODO IPv6
|
---|
| 126 | #if 0
|
---|
| 127 | case AF_INET6:
|
---|
[9b9d1c95] | 128 | if (addrlen != sizeof(struct sockaddr_in6))
|
---|
| 129 | return EINVAL;
|
---|
| 130 |
|
---|
| 131 | address_in6 = (struct sockaddr_in6 *) addr;
|
---|
| 132 | return EOK;
|
---|
[ccca251] | 133 | #endif
|
---|
[9b9d1c95] | 134 |
|
---|
| 135 | default:
|
---|
| 136 | return EAFNOSUPPORT;
|
---|
[a64c64d] | 137 | }
|
---|
| 138 | }
|
---|
| 139 |
|
---|
[9b9d1c95] | 140 | /** Prepares the packet to be transfered via IP.
|
---|
| 141 | *
|
---|
| 142 | * The IP header is prefixed.
|
---|
| 143 | *
|
---|
| 144 | * @param[in,out] packet The packet to be prepared.
|
---|
| 145 | * @param[in] protocol The transport protocol.
|
---|
| 146 | * @param[in] ttl The time to live counter. The IPDEFTTL is set if zero.
|
---|
| 147 | * @param[in] tos The type of service.
|
---|
| 148 | * @param[in] dont_fragment The value indicating whether fragmentation is
|
---|
| 149 | * disabled.
|
---|
| 150 | * @param[in] ipopt_length The prefixed IP options length in bytes.
|
---|
[1bfd3d3] | 151 | * @return EOK on success.
|
---|
| 152 | * @return ENOMEM if there is not enough memory left in the packet.
|
---|
[9b9d1c95] | 153 | */
|
---|
| 154 | int
|
---|
[46d4d9f] | 155 | ip_client_prepare_packet(packet_t *packet, ip_protocol_t protocol, ip_ttl_t ttl,
|
---|
[9b9d1c95] | 156 | ip_tos_t tos, int dont_fragment, size_t ipopt_length)
|
---|
| 157 | {
|
---|
[88a1bb9] | 158 | ip_header_t *header;
|
---|
[9b9d1c95] | 159 | uint8_t *data;
|
---|
[aadf01e] | 160 | size_t padding;
|
---|
[21580dd] | 161 |
|
---|
[28a3e74] | 162 | /*
|
---|
| 163 | * Compute the padding if IP options are set
|
---|
| 164 | * multiple of 4 bytes
|
---|
| 165 | */
|
---|
[21580dd] | 166 | padding = ipopt_length % 4;
|
---|
[9b9d1c95] | 167 | if (padding) {
|
---|
[21580dd] | 168 | padding = 4 - padding;
|
---|
| 169 | ipopt_length += padding;
|
---|
| 170 | }
|
---|
[a64c64d] | 171 |
|
---|
[28a3e74] | 172 | /* Prefix the header */
|
---|
[aadf01e] | 173 | data = (uint8_t *) packet_prefix(packet, sizeof(ip_header_t) + padding);
|
---|
[9b9d1c95] | 174 | if (!data)
|
---|
[aadf01e] | 175 | return ENOMEM;
|
---|
[a64c64d] | 176 |
|
---|
[28a3e74] | 177 | /* Add the padding */
|
---|
[9b9d1c95] | 178 | while (padding--)
|
---|
[aadf01e] | 179 | data[sizeof(ip_header_t) + padding] = IPOPT_NOOP;
|
---|
[a64c64d] | 180 |
|
---|
[28a3e74] | 181 | /* Set the header */
|
---|
[88a1bb9] | 182 | header = (ip_header_t *) data;
|
---|
[7bf12387] | 183 | SET_IP_HEADER_LENGTH(header,
|
---|
| 184 | (IP_COMPUTE_HEADER_LENGTH(sizeof(ip_header_t) + ipopt_length)));
|
---|
[9b9d1c95] | 185 | header->ttl = (ttl ? ttl : IPDEFTTL);
|
---|
[21580dd] | 186 | header->tos = tos;
|
---|
| 187 | header->protocol = protocol;
|
---|
[a64c64d] | 188 |
|
---|
[9b9d1c95] | 189 | if (dont_fragment)
|
---|
[7bf12387] | 190 | SET_IP_HEADER_FLAGS(header, IPFLAG_DONT_FRAGMENT);
|
---|
[9b9d1c95] | 191 |
|
---|
[21580dd] | 192 | return EOK;
|
---|
| 193 | }
|
---|
| 194 |
|
---|
[9b9d1c95] | 195 | /** Processes the received IP packet.
|
---|
| 196 | *
|
---|
| 197 | * Fills set header fields.
|
---|
| 198 | * Returns the prefixed IP header length.
|
---|
| 199 | *
|
---|
| 200 | * @param[in] packet The received packet.
|
---|
| 201 | * @param[out] protocol The transport protocol. May be NULL if not desired.
|
---|
| 202 | * @param[out] ttl The time to live counter. May be NULL if not desired.
|
---|
| 203 | * @param[out] tos The type of service. May be NULL if not desired.
|
---|
| 204 | * @param[out] dont_fragment The value indicating whether the fragmentation is
|
---|
| 205 | * disabled. May be NULL if not desired.
|
---|
| 206 | * @param[out] ipopt_length The IP options length in bytes. May be NULL if not
|
---|
| 207 | * desired.
|
---|
[1bfd3d3] | 208 | * @return The prefixed IP header length in bytes on success.
|
---|
| 209 | * @return ENOMEM if the packet is too short to contain the IP
|
---|
[9b9d1c95] | 210 | * header.
|
---|
| 211 | */
|
---|
| 212 | int
|
---|
[46d4d9f] | 213 | ip_client_process_packet(packet_t *packet, ip_protocol_t *protocol,
|
---|
[9b9d1c95] | 214 | ip_ttl_t *ttl, ip_tos_t *tos, int *dont_fragment, size_t *ipopt_length)
|
---|
| 215 | {
|
---|
[88a1bb9] | 216 | ip_header_t *header;
|
---|
[21580dd] | 217 |
|
---|
[88a1bb9] | 218 | header = (ip_header_t *) packet_get_data(packet);
|
---|
[9b9d1c95] | 219 | if (!header || (packet_get_data_length(packet) < sizeof(ip_header_t)))
|
---|
[21580dd] | 220 | return ENOMEM;
|
---|
[a64c64d] | 221 |
|
---|
[9b9d1c95] | 222 | if (protocol)
|
---|
[aadf01e] | 223 | *protocol = header->protocol;
|
---|
[9b9d1c95] | 224 | if (ttl)
|
---|
[aadf01e] | 225 | *ttl = header->ttl;
|
---|
[9b9d1c95] | 226 | if (tos)
|
---|
[aadf01e] | 227 | *tos = header->tos;
|
---|
[9b9d1c95] | 228 | if (dont_fragment)
|
---|
[7bf12387] | 229 | *dont_fragment = GET_IP_HEADER_FLAGS(header) & IPFLAG_DONT_FRAGMENT;
|
---|
[9b9d1c95] | 230 | if (ipopt_length) {
|
---|
[aadf01e] | 231 | *ipopt_length = IP_HEADER_LENGTH(header) - sizeof(ip_header_t);
|
---|
| 232 | return sizeof(ip_header_t);
|
---|
[9b9d1c95] | 233 | } else {
|
---|
[aadf01e] | 234 | return IP_HEADER_LENGTH(header);
|
---|
[21580dd] | 235 | }
|
---|
| 236 | }
|
---|
| 237 |
|
---|
[9b9d1c95] | 238 | /** Updates the IPv4 pseudo header data length field.
|
---|
| 239 | *
|
---|
| 240 | * @param[in,out] header The IPv4 pseudo header to be updated.
|
---|
| 241 | * @param[in] headerlen The length of the IP pseudo header in bytes.
|
---|
| 242 | * @param[in] data_length The data length to be set.
|
---|
[1bfd3d3] | 243 | * @return EOK on success.
|
---|
| 244 | * @return EBADMEM if the header parameter is NULL.
|
---|
| 245 | * @return EINVAL if the headerlen parameter is not IPv4 pseudo
|
---|
[9b9d1c95] | 246 | * header length.
|
---|
| 247 | */
|
---|
| 248 | int
|
---|
| 249 | ip_client_set_pseudo_header_data_length(void *header, size_t headerlen,
|
---|
| 250 | size_t data_length)
|
---|
| 251 | {
|
---|
[88a1bb9] | 252 | ipv4_pseudo_header_t *header_in;
|
---|
[21580dd] | 253 |
|
---|
[9b9d1c95] | 254 | if (!header)
|
---|
[aadf01e] | 255 | return EBADMEM;
|
---|
[a64c64d] | 256 |
|
---|
[9b9d1c95] | 257 | if (headerlen == sizeof(ipv4_pseudo_header_t)) {
|
---|
[88a1bb9] | 258 | header_in = (ipv4_pseudo_header_t *) header;
|
---|
[aadf01e] | 259 | header_in->data_length = htons(data_length);
|
---|
[21580dd] | 260 | return EOK;
|
---|
[ccca251] | 261 | // TODO IPv6
|
---|
[9b9d1c95] | 262 | } else {
|
---|
[21580dd] | 263 | return EINVAL;
|
---|
| 264 | }
|
---|
| 265 | }
|
---|
| 266 |
|
---|
| 267 | /** @}
|
---|
| 268 | */
|
---|