inet.hh revision 10469:b16b7dc83139
1/* 2 * Copyright (c) 2013 ARM Limited 3 * All rights reserved 4 * 5 * The license below extends only to copyright in the software and shall 6 * not be construed as granting a license to any other intellectual 7 * property including but not limited to intellectual property relating 8 * to a hardware implementation of the functionality of the software 9 * licensed hereunder. You may use the software subject to the license 10 * terms below provided that you ensure that this notice is replicated 11 * unmodified and in its entirety in all distributions of the software, 12 * modified or unmodified, in source code or in binary form. 13 * 14 * Copyright (c) 2002-2005 The Regents of The University of Michigan 15 * Copyright (c) 2010 Advanced Micro Devices, Inc. 16 * All rights reserved. 17 * 18 * Redistribution and use in source and binary forms, with or without 19 * modification, are permitted provided that the following conditions are 20 * met: redistributions of source code must retain the above copyright 21 * notice, this list of conditions and the following disclaimer; 22 * redistributions in binary form must reproduce the above copyright 23 * notice, this list of conditions and the following disclaimer in the 24 * documentation and/or other materials provided with the distribution; 25 * neither the name of the copyright holders nor the names of its 26 * contributors may be used to endorse or promote products derived from 27 * this software without specific prior written permission. 28 * 29 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS 30 * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 31 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR 32 * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT 33 * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, 34 * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT 35 * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 36 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 37 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 38 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE 39 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 40 * 41 * Authors: Nathan Binkert 42 * Steve Reinhardt 43 * Gabe Black 44 * Geoffrey Blake 45 */ 46 47#ifndef __BASE_INET_HH__ 48#define __BASE_INET_HH__ 49 50#include <iosfwd> 51#include <string> 52#include <utility> 53#include <vector> 54 55#include "base/types.hh" 56#include "dev/etherpkt.hh" 57#include "dnet/os.h" 58#include "dnet/eth.h" 59#include "dnet/ip.h" 60#include "dnet/ip6.h" 61#include "dnet/addr.h" 62#include "dnet/arp.h" 63#include "dnet/icmp.h" 64#include "dnet/tcp.h" 65#include "dnet/udp.h" 66#include "dnet/intf.h" 67#include "dnet/route.h" 68#include "dnet/fw.h" 69#include "dnet/blob.h" 70#include "dnet/rand.h" 71 72namespace Net { 73 74/* 75 * Ethernet Stuff 76 */ 77struct EthAddr : protected eth_addr 78{ 79 protected: 80 void parse(const std::string &addr); 81 82 public: 83 EthAddr(); 84 EthAddr(const uint8_t ea[ETH_ADDR_LEN]); 85 EthAddr(const eth_addr &ea); 86 EthAddr(const std::string &addr); 87 const EthAddr &operator=(const eth_addr &ea); 88 const EthAddr &operator=(const std::string &addr); 89 90 int size() const { return sizeof(eth_addr); } 91 92 const uint8_t *bytes() const { return &data[0]; } 93 uint8_t *bytes() { return &data[0]; } 94 95 const uint8_t *addr() const { return &data[0]; } 96 bool unicast() const { return !(data[0] & 0x01); } 97 bool multicast() const { return !unicast() && !broadcast(); } 98 bool broadcast() const 99 { 100 bool isBroadcast = true; 101 for (int i = 0; i < ETH_ADDR_LEN; ++i) { 102 isBroadcast = isBroadcast && data[i] == 0xff; 103 } 104 105 return isBroadcast; 106 } 107 108 std::string string() const; 109 110 operator uint64_t() const 111 { 112 uint64_t reg = 0; 113 reg |= ((uint64_t)data[0]) << 40; 114 reg |= ((uint64_t)data[1]) << 32; 115 reg |= ((uint64_t)data[2]) << 24; 116 reg |= ((uint64_t)data[3]) << 16; 117 reg |= ((uint64_t)data[4]) << 8; 118 reg |= ((uint64_t)data[5]) << 0; 119 return reg; 120 } 121 122}; 123 124std::ostream &operator<<(std::ostream &stream, const EthAddr &ea); 125bool operator==(const EthAddr &left, const EthAddr &right); 126 127struct EthHdr : public eth_hdr 128{ 129 bool isVlan() const { return (ntohs(eth_type) == ETH_TYPE_8021Q); } 130 uint16_t type() const { 131 if (!isVlan()) 132 return ntohs(eth_type); 133 else 134 // L3 type is now 16 bytes into the hdr with 802.1Q 135 // instead of 12. dnet/eth.h only supports 802.1 136 return ntohs(*((uint16_t*)(((uint8_t *)this) + 16))); 137 } 138 uint16_t vlanId() const { 139 if (isVlan()) 140 return ntohs(*((uint16_t*)(((uint8_t *)this) + 14))); 141 else 142 return 0x0000; 143 } 144 145 const EthAddr &src() const { return *(EthAddr *)ð_src; } 146 const EthAddr &dst() const { return *(EthAddr *)ð_dst; } 147 148 int size() const { 149 if (!isVlan()) 150 return sizeof(eth_hdr); 151 else 152 return (sizeof(eth_hdr)+4); 153 } 154 155 const uint8_t *bytes() const { return (const uint8_t *)this; } 156 const uint8_t *payload() const { return bytes() + size(); } 157 uint8_t *bytes() { return (uint8_t *)this; } 158 uint8_t *payload() { return bytes() + size(); } 159}; 160 161class EthPtr 162{ 163 protected: 164 friend class IpPtr; 165 friend class Ip6Ptr; 166 EthPacketPtr p; 167 168 public: 169 EthPtr() {} 170 EthPtr(const EthPacketPtr &ptr) : p(ptr) { } 171 172 EthHdr *operator->() { return (EthHdr *)p->data; } 173 EthHdr &operator*() { return *(EthHdr *)p->data; } 174 operator EthHdr *() { return (EthHdr *)p->data; } 175 176 const EthHdr *operator->() const { return (const EthHdr *)p->data; } 177 const EthHdr &operator*() const { return *(const EthHdr *)p->data; } 178 operator const EthHdr *() const { return (const EthHdr *)p->data; } 179 180 const EthPtr &operator=(const EthPacketPtr &ptr) { p = ptr; return *this; } 181 182 const EthPacketPtr packet() const { return p; } 183 EthPacketPtr packet() { return p; } 184 bool operator!() const { return !p; } 185 operator bool() const { return (p != nullptr); } 186 int off() const { return 0; } 187 int pstart() const { return off() + ((const EthHdr*)p->data)->size(); } 188}; 189 190/* 191 * IP Stuff 192 */ 193struct IpAddress 194{ 195 protected: 196 uint32_t _ip; 197 198 public: 199 IpAddress() : _ip(0) 200 {} 201 IpAddress(const uint32_t __ip) : _ip(__ip) 202 {} 203 204 uint32_t ip() const { return _ip; } 205 206 std::string string() const; 207}; 208 209std::ostream &operator<<(std::ostream &stream, const IpAddress &ia); 210bool operator==(const IpAddress &left, const IpAddress &right); 211 212struct IpNetmask : public IpAddress 213{ 214 protected: 215 uint8_t _netmask; 216 217 public: 218 IpNetmask() : IpAddress(), _netmask(0) 219 {} 220 IpNetmask(const uint32_t __ip, const uint8_t __netmask) : 221 IpAddress(__ip), _netmask(__netmask) 222 {} 223 224 uint8_t netmask() const { return _netmask; } 225 226 std::string string() const; 227}; 228 229std::ostream &operator<<(std::ostream &stream, const IpNetmask &in); 230bool operator==(const IpNetmask &left, const IpNetmask &right); 231 232struct IpWithPort : public IpAddress 233{ 234 protected: 235 uint16_t _port; 236 237 public: 238 IpWithPort() : IpAddress(), _port(0) 239 {} 240 IpWithPort(const uint32_t __ip, const uint16_t __port) : 241 IpAddress(__ip), _port(__port) 242 {} 243 244 uint8_t port() const { return _port; } 245 246 std::string string() const; 247}; 248 249std::ostream &operator<<(std::ostream &stream, const IpWithPort &iwp); 250bool operator==(const IpWithPort &left, const IpWithPort &right); 251 252struct IpOpt; 253struct IpHdr : public ip_hdr 254{ 255 uint8_t version() const { return ip_v; } 256 uint8_t hlen() const { return ip_hl * 4; } 257 uint8_t tos() const { return ip_tos; } 258 uint16_t len() const { return ntohs(ip_len); } 259 uint16_t id() const { return ntohs(ip_id); } 260 uint16_t frag_flags() const { return ntohs(ip_off) >> 13; } 261 uint16_t frag_off() const { return ntohs(ip_off) & 0x1fff; } 262 uint8_t ttl() const { return ip_ttl; } 263 uint8_t proto() const { return ip_p; } 264 uint16_t sum() const { return ip_sum; } 265 uint32_t src() const { return ntohl(ip_src); } 266 uint32_t dst() const { return ntohl(ip_dst); } 267 268 void sum(uint16_t sum) { ip_sum = sum; } 269 void id(uint16_t _id) { ip_id = htons(_id); } 270 void len(uint16_t _len) { ip_len = htons(_len); } 271 272 bool options(std::vector<const IpOpt *> &vec) const; 273 274 int size() const { return hlen(); } 275 const uint8_t *bytes() const { return (const uint8_t *)this; } 276 const uint8_t *payload() const { return bytes() + size(); } 277 uint8_t *bytes() { return (uint8_t *)this; } 278 uint8_t *payload() { return bytes() + size(); } 279}; 280 281class IpPtr 282{ 283 protected: 284 friend class TcpPtr; 285 friend class UdpPtr; 286 EthPacketPtr p; 287 bool eth_hdr_vlan; 288 289 void set(const EthPacketPtr &ptr) 290 { 291 p = 0; 292 eth_hdr_vlan = false; 293 294 if (ptr) { 295 EthHdr *eth = (EthHdr *)ptr->data; 296 if (eth->type() == ETH_TYPE_IP) 297 p = ptr; 298 if (eth->isVlan()) 299 eth_hdr_vlan = true; 300 } 301 } 302 303 public: 304 IpPtr() : p(0), eth_hdr_vlan(false) {} 305 IpPtr(const EthPacketPtr &ptr) : p(0), eth_hdr_vlan(false) { set(ptr); } 306 IpPtr(const EthPtr &ptr) : p(0), eth_hdr_vlan(false) { set(ptr.p); } 307 IpPtr(const IpPtr &ptr) : p(ptr.p), eth_hdr_vlan(ptr.eth_hdr_vlan) { } 308 309 IpHdr *get() { return (IpHdr *)(p->data + sizeof(eth_hdr) + 310 ((eth_hdr_vlan) ? 4 : 0)); } 311 IpHdr *operator->() { return get(); } 312 IpHdr &operator*() { return *get(); } 313 314 const IpHdr *get() const 315 { return (const IpHdr *)(p->data + sizeof(eth_hdr) + 316 ((eth_hdr_vlan) ? 4 : 0)); } 317 const IpHdr *operator->() const { return get(); } 318 const IpHdr &operator*() const { return *get(); } 319 320 const IpPtr &operator=(const EthPacketPtr &ptr) { set(ptr); return *this; } 321 const IpPtr &operator=(const EthPtr &ptr) { set(ptr.p); return *this; } 322 const IpPtr &operator=(const IpPtr &ptr) { p = ptr.p; return *this; } 323 324 const EthPacketPtr packet() const { return p; } 325 EthPacketPtr packet() { return p; } 326 bool operator!() const { return !p; } 327 operator bool() const { return (p != nullptr); } 328 int off() const { return (sizeof(eth_hdr) + ((eth_hdr_vlan) ? 4 : 0)); } 329 int pstart() const { return (off() + get()->size()); } 330}; 331 332uint16_t cksum(const IpPtr &ptr); 333 334struct IpOpt : public ip_opt 335{ 336 uint8_t type() const { return opt_type; } 337 uint8_t typeNumber() const { return IP_OPT_NUMBER(opt_type); } 338 uint8_t typeClass() const { return IP_OPT_CLASS(opt_type); } 339 uint8_t typeCopied() const { return IP_OPT_COPIED(opt_type); } 340 uint8_t len() const { return IP_OPT_TYPEONLY(type()) ? 1 : opt_len; } 341 342 bool isNumber(int num) const { return typeNumber() == IP_OPT_NUMBER(num); } 343 bool isClass(int cls) const { return typeClass() == IP_OPT_CLASS(cls); } 344 bool isCopied(int cpy) const { return typeCopied() == IP_OPT_COPIED(cpy); } 345 346 const uint8_t *data() const { return opt_data.data8; } 347 void sec(ip_opt_data_sec &sec) const; 348 void lsrr(ip_opt_data_rr &rr) const; 349 void ssrr(ip_opt_data_rr &rr) const; 350 void ts(ip_opt_data_ts &ts) const; 351 uint16_t satid() const { return ntohs(opt_data.satid); } 352 uint16_t mtup() const { return ntohs(opt_data.mtu); } 353 uint16_t mtur() const { return ntohs(opt_data.mtu); } 354 void tr(ip_opt_data_tr &tr) const; 355 const uint32_t *addext() const { return &opt_data.addext[0]; } 356 uint16_t rtralt() const { return ntohs(opt_data.rtralt); } 357 void sdb(std::vector<uint32_t> &vec) const; 358}; 359 360/* 361 * Ip6 Classes 362 */ 363struct Ip6Opt; 364struct Ip6Hdr : public ip6_hdr 365{ 366 uint8_t version() const { return ip6_vfc; } 367 uint32_t flow() const { return ntohl(ip6_flow); } 368 uint16_t plen() const { return ntohs(ip6_plen); } 369 uint16_t hlen() const { return IP6_HDR_LEN; } 370 uint8_t nxt() const { return ip6_nxt; } 371 uint8_t hlim() const { return ip6_hlim; } 372 373 const uint8_t* src() const { return ip6_src.data; } 374 const uint8_t* dst() const { return ip6_dst.data; } 375 376 int extensionLength() const; 377 const Ip6Opt* getExt(uint8_t ext) const; 378 const Ip6Opt* fragmentExt() const { return getExt(IP_PROTO_FRAGMENT); } 379 const Ip6Opt* rtTypeExt() const { return getExt(IP_PROTO_ROUTING); } 380 const Ip6Opt* dstOptExt() const { return getExt(IP_PROTO_DSTOPTS); } 381 uint8_t proto() const; 382 383 void plen(uint16_t _plen) { ip6_plen = htons(_plen); } 384 385 int size() const { return IP6_HDR_LEN + extensionLength(); } 386 const uint8_t *bytes() const { return (const uint8_t *)this; } 387 const uint8_t *payload() const { return bytes() + IP6_HDR_LEN 388 + extensionLength(); } 389 uint8_t *bytes() { return (uint8_t *)this; } 390 uint8_t *payload() { return bytes() + IP6_HDR_LEN 391 + extensionLength(); } 392}; 393 394class Ip6Ptr 395{ 396 protected: 397 friend class TcpPtr; 398 friend class UdpPtr; 399 EthPacketPtr p; 400 bool eth_hdr_vlan; 401 402 void set(const EthPacketPtr &ptr) 403 { 404 p = 0; 405 eth_hdr_vlan = false; 406 407 if (ptr) { 408 EthHdr *eth = (EthHdr *)ptr->data; 409 if (eth->type() == ETH_TYPE_IPV6) 410 p = ptr; 411 if (eth->isVlan()) 412 eth_hdr_vlan = true; 413 } 414 } 415 416 public: 417 Ip6Ptr() : p(0), eth_hdr_vlan(false) {} 418 Ip6Ptr(const EthPacketPtr &ptr) : p(0), eth_hdr_vlan(false) { set(ptr); } 419 Ip6Ptr(const EthPtr &ptr) : p(0), eth_hdr_vlan(false) { set(ptr.p); } 420 Ip6Ptr(const Ip6Ptr &ptr) : p(ptr.p), eth_hdr_vlan(ptr.eth_hdr_vlan) { } 421 422 Ip6Hdr *get() { return (Ip6Hdr *)(p->data + sizeof(eth_hdr) 423 + ((eth_hdr_vlan) ? 4 : 0)); } 424 Ip6Hdr *operator->() { return get(); } 425 Ip6Hdr &operator*() { return *get(); } 426 427 const Ip6Hdr *get() const 428 { return (const Ip6Hdr *)(p->data + sizeof(eth_hdr) 429 + ((eth_hdr_vlan) ? 4 : 0)); } 430 const Ip6Hdr *operator->() const { return get(); } 431 const Ip6Hdr &operator*() const { return *get(); } 432 433 const Ip6Ptr &operator=(const EthPacketPtr &ptr) 434 { set(ptr); return *this; } 435 const Ip6Ptr &operator=(const EthPtr &ptr) 436 { set(ptr.p); return *this; } 437 const Ip6Ptr &operator=(const Ip6Ptr &ptr) 438 { p = ptr.p; return *this; } 439 440 const EthPacketPtr packet() const { return p; } 441 EthPacketPtr packet() { return p; } 442 bool operator!() const { return !p; } 443 operator bool() const { return (p != nullptr); } 444 int off() const { return sizeof(eth_hdr) + ((eth_hdr_vlan) ? 4 : 0); } 445 int pstart() const { return off() + get()->size(); } 446}; 447 448// Dnet supplied ipv6 opt header is incomplete and 449// newer NIC card filters expect a more robust 450// ipv6 header option declaration. 451struct ip6_opt_fragment { 452 uint16_t offlg; 453 uint32_t ident; 454}; 455 456struct ip6_opt_routing_type2 { 457 uint8_t type; 458 uint8_t segleft; 459 uint32_t reserved; 460 ip6_addr_t addr; 461}; 462 463#define HOME_ADDRESS_OPTION 0xC9 464struct ip6_opt_dstopts { 465 uint8_t type; 466 uint8_t length; 467 ip6_addr_t addr; 468} __attribute__((packed)); 469 470struct ip6_opt_hdr 471{ 472 uint8_t ext_nxt; 473 uint8_t ext_len; 474 union { 475 struct ip6_opt_fragment fragment; 476 struct ip6_opt_routing_type2 rtType2; 477 struct ip6_opt_dstopts dstOpts; 478 } ext_data; 479} __attribute__((packed)); 480 481struct Ip6Opt : public ip6_opt_hdr 482{ 483 uint8_t nxt() const { return ext_nxt; } 484 uint8_t extlen() const { return ext_len; } 485 uint8_t len() const { return extlen() + 8; } 486 487 // Supporting the types of header extensions likely to be encountered: 488 // fragment, routing type 2 and dstopts. 489 490 // Routing type 2 491 uint8_t rtType2Type() const { return ext_data.rtType2.type; } 492 uint8_t rtType2SegLft() const { return ext_data.rtType2.segleft; } 493 const uint8_t* rtType2Addr() const { return ext_data.rtType2.addr.data; } 494 495 // Fragment 496 uint16_t fragmentOfflg() const { return ntohs(ext_data.fragment.offlg); } 497 uint32_t fragmentIdent() const { return ntohl(ext_data.fragment.ident); } 498 499 // Dst Options/Home Address Option 500 uint8_t dstOptType() const { return ext_data.dstOpts.type; } 501 uint8_t dstOptLength() const { return ext_data.dstOpts.length; } 502 const uint8_t* dstOptAddr() const { return ext_data.dstOpts.addr.data; } 503}; 504 505 506/* 507 * TCP Stuff 508 */ 509struct TcpOpt; 510struct TcpHdr : public tcp_hdr 511{ 512 uint16_t sport() const { return ntohs(th_sport); } 513 uint16_t dport() const { return ntohs(th_dport); } 514 uint32_t seq() const { return ntohl(th_seq); } 515 uint32_t ack() const { return ntohl(th_ack); } 516 uint8_t off() const { return th_off*4; } 517 uint8_t flags() const { return th_flags & 0x3f; } 518 uint16_t win() const { return ntohs(th_win); } 519 uint16_t sum() const { return th_sum; } 520 uint16_t urp() const { return ntohs(th_urp); } 521 522 void sum(uint16_t sum) { th_sum = sum; } 523 void seq(uint32_t _seq) { th_seq = htonl(_seq); } 524 void flags(uint8_t _flags) { th_flags = _flags; } 525 526 bool options(std::vector<const TcpOpt *> &vec) const; 527 528 int size() const { return off(); } 529 const uint8_t *bytes() const { return (const uint8_t *)this; } 530 const uint8_t *payload() const { return bytes() + size(); } 531 uint8_t *bytes() { return (uint8_t *)this; } 532 uint8_t *payload() { return bytes() + size(); } 533}; 534 535class TcpPtr 536{ 537 protected: 538 EthPacketPtr p; 539 int _off; 540 541 void set(const EthPacketPtr &ptr, int offset) { p = ptr; _off = offset; } 542 void set(const IpPtr &ptr) 543 { 544 if (ptr && ptr->proto() == IP_PROTO_TCP) 545 set(ptr.p, ptr.pstart()); 546 else 547 set(0, 0); 548 } 549 void set(const Ip6Ptr &ptr) 550 { 551 if (ptr && ptr->proto() == IP_PROTO_TCP) 552 set(ptr.p, ptr.pstart()); 553 else 554 set(0, 0); 555 } 556 557 public: 558 TcpPtr() : p(0), _off(0) {} 559 TcpPtr(const IpPtr &ptr) : p(0), _off(0) { set(ptr); } 560 TcpPtr(const Ip6Ptr &ptr) : p(0), _off(0) { set(ptr); } 561 TcpPtr(const TcpPtr &ptr) : p(ptr.p), _off(ptr._off) {} 562 563 TcpHdr *get() { return (TcpHdr *)(p->data + _off); } 564 TcpHdr *operator->() { return get(); } 565 TcpHdr &operator*() { return *get(); } 566 567 const TcpHdr *get() const { return (const TcpHdr *)(p->data + _off); } 568 const TcpHdr *operator->() const { return get(); } 569 const TcpHdr &operator*() const { return *get(); } 570 571 const TcpPtr &operator=(const IpPtr &i) 572 { set(i); return *this; } 573 const TcpPtr &operator=(const TcpPtr &t) 574 { set(t.p, t._off); return *this; } 575 576 const EthPacketPtr packet() const { return p; } 577 EthPacketPtr packet() { return p; } 578 bool operator!() const { return !p; } 579 operator bool() const { return (p != nullptr); } 580 int off() const { return _off; } 581 int pstart() const { return off() + get()->size(); } 582}; 583 584uint16_t cksum(const TcpPtr &ptr); 585 586struct TcpOpt : public tcp_opt 587{ 588 uint8_t type() const { return opt_type; } 589 uint8_t len() const { return TCP_OPT_TYPEONLY(type()) ? 1 : opt_len; } 590 591 bool isopt(int opt) const { return type() == opt; } 592 593 const uint8_t *data() const { return opt_data.data8; } 594 595 uint16_t mss() const { return ntohs(opt_data.mss); } 596 uint8_t wscale() const { return opt_data.wscale; } 597 uint32_t echo() const { return ntohl(opt_data.echo); } 598 uint32_t tsval() const { return ntohl(opt_data.timestamp[0]); } 599 uint32_t tsecr() const { return ntohl(opt_data.timestamp[1]); } 600 uint32_t cc() const { return ntohl(opt_data.cc); } 601 uint8_t cksum() const{ return opt_data.cksum; } 602 const uint8_t *md5() const { return opt_data.md5; } 603 604 int size() const { return len(); } 605 const uint8_t *bytes() const { return (const uint8_t *)this; } 606 const uint8_t *payload() const { return bytes() + size(); } 607 uint8_t *bytes() { return (uint8_t *)this; } 608 uint8_t *payload() { return bytes() + size(); } 609}; 610 611/* 612 * UDP Stuff 613 */ 614struct UdpHdr : public udp_hdr 615{ 616 uint16_t sport() const { return ntohs(uh_sport); } 617 uint16_t dport() const { return ntohs(uh_dport); } 618 uint16_t len() const { return ntohs(uh_ulen); } 619 uint16_t sum() const { return uh_sum; } 620 621 void sum(uint16_t sum) { uh_sum = sum; } 622 void len(uint16_t _len) { uh_ulen = htons(_len); } 623 624 int size() const { return sizeof(udp_hdr); } 625 const uint8_t *bytes() const { return (const uint8_t *)this; } 626 const uint8_t *payload() const { return bytes() + size(); } 627 uint8_t *bytes() { return (uint8_t *)this; } 628 uint8_t *payload() { return bytes() + size(); } 629}; 630 631class UdpPtr 632{ 633 protected: 634 EthPacketPtr p; 635 int _off; 636 637 void set(const EthPacketPtr &ptr, int offset) { p = ptr; _off = offset; } 638 void set(const IpPtr &ptr) 639 { 640 if (ptr && ptr->proto() == IP_PROTO_UDP) 641 set(ptr.p, ptr.pstart()); 642 else 643 set(0, 0); 644 } 645 void set(const Ip6Ptr &ptr) 646 { 647 if (ptr && ptr->proto() == IP_PROTO_UDP) 648 set(ptr.p, ptr.pstart()); 649 else 650 set(0, 0); 651 } 652 653 public: 654 UdpPtr() : p(0), _off(0) {} 655 UdpPtr(const IpPtr &ptr) : p(0), _off(0) { set(ptr); } 656 UdpPtr(const Ip6Ptr &ptr) : p(0), _off(0) { set(ptr); } 657 UdpPtr(const UdpPtr &ptr) : p(ptr.p), _off(ptr._off) {} 658 659 UdpHdr *get() { return (UdpHdr *)(p->data + _off); } 660 UdpHdr *operator->() { return get(); } 661 UdpHdr &operator*() { return *get(); } 662 663 const UdpHdr *get() const { return (const UdpHdr *)(p->data + _off); } 664 const UdpHdr *operator->() const { return get(); } 665 const UdpHdr &operator*() const { return *get(); } 666 667 const UdpPtr &operator=(const IpPtr &i) { set(i); return *this; } 668 const UdpPtr &operator=(const UdpPtr &t) 669 { set(t.p, t._off); return *this; } 670 671 const EthPacketPtr packet() const { return p; } 672 EthPacketPtr packet() { return p; } 673 bool operator!() const { return !p; } 674 operator bool() const { return (p != nullptr); } 675 int off() const { return _off; } 676 int pstart() const { return off() + get()->size(); } 677}; 678 679uint16_t __tu_cksum6(const Ip6Ptr &ip6); 680uint16_t __tu_cksum(const IpPtr &ip); 681uint16_t cksum(const UdpPtr &ptr); 682 683int hsplit(const EthPacketPtr &ptr); 684 685} // namespace Net 686 687#endif // __BASE_INET_HH__ 688