datagram.h

   1 /*
   2  *  datagram.h
   3  *  serp++
   4  *
   5  *  Created by Victor Grishchenko on 3/9/09.
   6  *  Copyright 2009 Delft University of Technology. All rights reserved.
   7  *
   8  */
   9 #ifndef DATAGRAM_H
  10 #define DATAGRAM_H
  11
  12 #ifdef _MSC_VER
  13     #include "compat/stdint.h"
  14 #else
  15     #include <stdint.h>
  16 #endif
  17 #ifdef _WIN32
  18         #include <winsock2.h>
  19         #include "compat.h"
  20 #else
  21     typedef int SOCKET;
  22
  23     #include <arpa/inet.h>
  24     #include <sys/select.h>
  25     #include <sys/socket.h>
  26     #include <netinet/in.h>
  27     #include <unistd.h>
  28 #endif
  29 #include <stdlib.h>
  30 #include <fcntl.h>
  31 #include <sys/stat.h>
  32 #include <string.h>
  33 #include <stdio.h>
  34 #include <string>
  35 #include "hashtree.h"
  36 #include "compat/util.h"
  37
  38
  39 namespace p2tp {
  40
  41 #define MAXDGRAMSZ 2800
  42 #ifndef _WIN32
  43 #define INVALID_SOCKET -1
  44 #endif
  45
  46
  47 struct Address {
  48     struct sockaddr_in  addr;
  49     static uint32_t LOCALHOST;
  50     void set_port (uint16_t port) {
  51         addr.sin_port = htons(port);
  52     }
  53     void set_port (const char* port_str) {
  54         int p;
  55         if (sscanf(port_str,"%i",&p))
  56             set_port(p);
  57     }
  58     void set_ipv4 (uint32_t ipv4) {
  59         addr.sin_addr.s_addr = htonl(ipv4);
  60     }
  61     void set_ipv4 (const char* ipv4_str) {
  62         inet_aton(ipv4_str,&(addr.sin_addr));
  63     }
  64     void clear () {
  65         memset(&addr,0,sizeof(struct sockaddr_in));
  66         addr.sin_family = AF_INET;
  67     }
  68     Address() {
  69         clear();
  70     }
  71     Address(const char* ip, uint16_t port)  {
  72         clear();
  73         set_ipv4(ip);
  74         set_port(port);
  75     }
  76     Address(const char* ip_port);
  77     Address(uint16_t port) {
  78         clear();
  79         set_ipv4(LOCALHOST);
  80         set_port(port);
  81     }
  82     Address(uint32_t ipv4addr, uint16_t port) {
  83         clear();
  84         set_ipv4(ipv4addr);
  85         set_port(port);
  86     }
  87     Address(const struct sockaddr_in& address) : addr(address) {}
  88     uint32_t ipv4 () const { return ntohl(addr.sin_addr.s_addr); }
  89     uint16_t port () const { return ntohs(addr.sin_port); }
  90     operator sockaddr_in () const {return addr;}
  91     bool operator == (const Address& b) const {
  92         return addr.sin_family==b.addr.sin_family &&
  93         addr.sin_port==b.addr.sin_port &&
  94         addr.sin_addr.s_addr==b.addr.sin_addr.s_addr;
  95     }
  96     std::string str () const {
  97         char s[32];
  98         sprintf(s,"%i.%i.%i.%i:%i",ipv4()>>24,(ipv4()>>16)&0xff,
  99                 (ipv4()>>8)&0xff,ipv4()&0xff,port());
 100         return std::string(s);
 101     }
 102     bool operator != (const Address& b) const { return !(*this==b); }
 103 };
 104
 105
 106 struct Datagram {
 107
 108         Address addr;
 109         SOCKET sock;
 110         int offset, length;
 111         uint8_t buf[MAXDGRAMSZ*2];
 112
 113         static SOCKET Bind(Address address);
 114         static void Close(int port);
 115         static tint Time();
 116         static SOCKET Wait (int sockcnt, SOCKET* sockets, tint usec=0);
 117         static tint now, epoch;
 118     static uint64_t dgrams_up, dgrams_down, bytes_up, bytes_down;
 119
 120         Datagram (SOCKET socket, const Address addr_) : addr(addr_), offset(0),
 121                 length(0), sock(socket) {}
 122         Datagram (SOCKET socket) : offset(0), length(0), sock(socket) {
 123         }
 124
 125         int space () const { return MAXDGRAMSZ-length; }
 126         int size() const { return length-offset; }
 127         std::string str() const { return std::string((char*)buf+offset,size()); }
 128     const uint8_t* operator * () const { return buf+offset; }
 129
 130         int Push (const uint8_t* data, int l) { // scatter-gather one day
 131                 int toc = l<space() ? l : space();
 132                 memcpy(buf+length,data,toc);
 133                 length += toc;
 134                 return toc;
 135         }
 136         int Pull (uint8_t** data, int l) {
 137                 int toc = l<size() ? l : size();
 138                 //memcpy(data,buf+offset,toc);
 139                 *data = buf+offset;
 140                 offset += toc;
 141                 return toc;
 142         }
 143
 144         int Send ();
 145         int Recv ();
 146         const Address& address() const { return addr; }
 147     void Clear() { offset=length=0; }
 148
 149         void    PushString (std::string str) {
 150                 Push((uint8_t*)str.c_str(),str.size());
 151         }
 152         void    Push8 (uint8_t b) {
 153                 buf[length++] = b;
 154         }
 155         void    Push16 (uint16_t w) {
 156                 *(uint16_t*)(buf+length) = htons(w);
 157                 length+=2;
 158         }
 159         void    Push32 (uint32_t i) {
 160                 *(uint32_t*)(buf+length) = htonl(i);
 161                 length+=4;
 162         }
 163         void    Push64 (uint64_t l) {
 164                 *(uint32_t*)(buf+length) = htonl((uint32_t)(l>>32));
 165                 *(uint32_t*)(buf+length+4) = htonl((uint32_t)(l&0xffffffff));
 166                 length+=8;
 167         }
 168         void    PushHash (const Sha1Hash& hash) {
 169                 Push((uint8_t*)hash.bits, Sha1Hash::SIZE);
 170         }
 171
 172         uint8_t Pull8() {
 173                 if (size()<1) return 0;
 174                 return buf[offset++];
 175         }
 176         uint16_t Pull16() {
 177                 if (size()<2) return 0;
 178                 offset+=2;
 179                 return ntohs(*(uint16_t*)(buf+offset-2));
 180         }
 181         uint32_t Pull32() {
 182                 if (size()<4) return 0;
 183                 uint32_t i = ntohl(*(uint32_t*)(buf+offset));
 184                 offset+=4;
 185                 return i;
 186         }
 187         uint64_t Pull64() {
 188                 if (size()<8) return 0;
 189                 uint64_t l = ntohl(*(uint32_t*)(buf+offset));
 190                 l<<=32;
 191                 l |= ntohl(*(uint32_t*)(buf+offset+4));
 192                 offset+=8;
 193                 return l;
 194         }
 195         Sha1Hash PullHash() {
 196                 if (size()<Sha1Hash::SIZE) return Sha1Hash::ZERO;
 197                 offset += Sha1Hash::SIZE;
 198                 return Sha1Hash(false,(char*)buf+offset-Sha1Hash::SIZE);
 199         }
 200         //std::string   to_string () const ;
 201
 202 };
 203
 204 const char* tintstr(tint t=0);
 205 std::string sock2str (struct sockaddr_in addr);
 206 #define dprintf(...) printf(__VA_ARGS__)
 207 #define eprintf(...) fprintf(stderr,__VA_ARGS__)
 208 //#define dprintf(...) {}
 209
 210 }
 211
 212 #endif