udp: client

README.md

@@ -6,3 +6,23 @@ A simple and trivial IPv6 stack for Arduino. Currently implements:
 * ICMP Router Advertisement
 * UDP server
 
+# Quick start
+Browse `examples` directory for Arduino sketches.
+
+```
+cd examples/simple-udp-server
+make build
+make flash
+```
+
+# Configuration
+`src/settings.h`:
+
+* `ENABLE_SLAAC`: enable stateless auto-configuration
+
+# Issues
+* bugs:
+  * only known features
+* nice-to-have:
+  * settings configuration outside library directory
+

examples/simple-udp-client/.gitignore

@@ -0,0 +1 @@
+/build/

examples/simple-udp-client/Makefile

@@ -0,0 +1,15 @@
+BOARD ?= arduino:avr:diecimila
+PORT ?= /dev/ttyUSB0
+
+CCFLAGS += -Icfg
+
+.PHONY: build flash
+
+build:
+	arduino-cli compile -v -e --libraries coppino -b $(BOARD)
+
+flash:
+	arduino-cli -b $(BOARD) -p $(PORT) -v upload
+
+clean:
+	rm -r build

examples/simple-udp-client/simple-udp-client.ino

@@ -0,0 +1,47 @@
+#include "coppino.h"
+#include "ipv6.h"
+#include "slip.h"
+#include "udp.h"
+
+const char MY_ADDRESS[] = "\x20\x01\x04\x70\xc8\x44\x00\x31\x00\x00\x00\x00\x00\x00\xca\xfe";
+
+void setup()
+{
+  /* Customize coppino library configuration settings by editing settings.h */
+
+  /* setup serial for Internet connectivity
+   * attach a SLIP daemon on the other endpoint; a good one is `tunslip6` by Contiki
+   * $ tunslip6 -s /dev/ttyUSB0 -L -v5 -B 19200 2001:db8:1324::1/64
+   * Note: the address given is the one on the host it is running on
+   */
+  Serial.begin(19200);
+
+  /* set unique identifier of network hardware. It MUST be unique!
+   * For example, this could be your microcontroller serial number
+   * Note: pay attention to enter exactly 64 bits / 8 bytes
+   */
+  ipv6::setEUI("\xde\xad\xbe\xef\x12\x34\x56\x78");
+  /* set global address -- will be overwritten if SLAAC is enabled and a Router Advertisement is received */
+  ipv6::setGlobalAddress(MY_ADDRESS);
+}
+
+void loop()
+{
+  char message[16];
+  ipv6::IPv6Addr srcaddr = ipv6::IPv6Addr(MY_ADDRESS);
+  ipv6::IPv6Addr dstaddr = ipv6::IPv6Addr("\x20\x01\x04\x70\xc8\x44\x00\x31\x00\x00\x00\x00\x00\x00\x00\x01");
+  uint16_t srcport = 1337;
+  uint16_t dstport = 1234;
+  udp::UDPClient udpclient = udp::UDPClient(srcaddr, dstaddr, srcport, dstport);
+
+  while (true)
+  {
+    for (int i = 0; i < 32; ++i)
+    {
+      sprintf(message, "iteration #%d\r\n", i);
+
+      udpclient.send_datagram((const uint8_t *)message, strlen(message));
+      delay(1000);
+    }
+  }
+}

examples/simple-udp-server/.gitignore

@@ -0,0 +1 @@
+/build/

examples/simple-udp-server/Makefile

@@ -0,0 +1,15 @@
+BOARD ?= arduino:avr:diecimila
+PORT ?= /dev/ttyUSB0
+
+CCFLAGS += -Icfg
+
+.PHONY: build flash
+
+build:
+	arduino-cli compile -v -e --libraries coppino -b $(BOARD)
+
+flash:
+	arduino-cli -b $(BOARD) -p $(PORT) -v upload
+
+clean:
+	rm -r build

examples/simple-udp-server/simple-udp-server.ino

@@ -14,6 +14,8 @@ int udp_server(char* output_buffer, const char* input_buffer, int len) {
 void setup() {
   pinMode(13, OUTPUT);
 
+  /* Customize coppino library configuration settings by editing settings.h */
+
   /* setup serial for Internet connectivity
    * attach a SLIP daemon on the other endpoint; a good one is `tunslip6` by Contiki
    * $ tunslip6 -s /dev/ttyUSB0 -L -v5 -B 19200 2001:db8:1324::1/64
@@ -26,8 +28,6 @@ void setup() {
    * Note: pay attention to enter exactly 64 bits / 8 bytes
   */
   ipv6::setEUI("\xde\xad\xbe\xef\x12\x34\x56\x78");
-  /* enable or disable IPv6 Stateless Auto-Configuration (SLAAC) */
-  ipv6::SLAAC(false);
   /* set global address -- will be overwritten if SLAAC is enabled and a Router Advertisement is received */
   ipv6::setGlobalAddress("\x20\x01\x04\x70\xc8\x44\x00\x31\x00\x00\x00\x00\x00\x00\xca\xfe");
 

src/ipv6.cpp

@@ -1,158 +1,185 @@
 #include "ipv6.h"
 #include "udp.h"
 
-namespace ipv6 {
-/******** costants ********/
-const IPv6Addr  ALL_NODES_ADDRESS("\xff\x02\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x01");  /* ff02::1 */
+namespace ipv6
+{
+  /******** costants ********/
+  const IPv6Addr ALL_NODES_ADDRESS("\xff\x02\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x01"); /* ff02::1 */
 
-/******** variables ********/
-uint8_t HOP_LIMIT = 64;
-IPv6Addr LINK_LOCAL_ADDRESS;
-IPv6Addr GLOBAL_ADDRESS;
-bool slaac_enable;
+  /******** variables ********/
+  uint8_t HOP_LIMIT = 64;
+  IPv6Addr LINK_LOCAL_ADDRESS;
+  IPv6Addr GLOBAL_ADDRESS;
 
-/******** buffers ********/
-IPv6Packet packetin;
-IPv6Packet packetout;
+  /******** buffers ********/
+  IPv6Packet packetin;
+  IPv6Packet packetout;
 
-/******** FUNCTIONS *******/
-void setEUI(const char* eui) {
-  memset(&LINK_LOCAL_ADDRESS, 0, 16);
-  memcpy(&LINK_LOCAL_ADDRESS, "\xfe\x80", 2);
-  memcpy( ((char*)&LINK_LOCAL_ADDRESS) + 8 , eui, 8);
-}
-void SLAAC(bool enable) {
-  slaac_enable = enable;
-}
-void setGlobalAddress(const char* address) {
-  memcpy(&GLOBAL_ADDRESS, address, 16);
-}
-
-uint16_t compute_checksum(const IPv6Addr* src_addr, const IPv6Addr* dst_addr, uint8_t next_header, int upper_len, const char* payload, int len) {
-  char buffer[LEN];
-  uint32_t total;
-  uint16_t* ptr;
-  int words;
-  int i = len;
-
-  /* prepare buffer with all data to checksum:
-      - the actual payload
-      - the pseudo ipv6 header
-  */
-  /* actual payload */
-  memcpy(buffer, payload, len);
-  if (len % 2) {  /* pad with 0 if length is odd */
-    buffer[len] = 0;
-    i++;
+  /******** FUNCTIONS *******/
+  void setEUI(const char *eui)
+  {
+    memset(&LINK_LOCAL_ADDRESS, 0, 16);
+    memcpy(&LINK_LOCAL_ADDRESS, "\xfe\x80", 2);
+    memcpy(((char *)&LINK_LOCAL_ADDRESS) + 8, eui, 8);
   }
-  /* pseudo ipv6 header -- see RFC 2460, Section 8.1 */
-  memcpy(buffer + i, src_addr, 16); i += 16;
-  memcpy(buffer + i, dst_addr, 16); i += 16;
-  memset(buffer + i, 0, 3); i+= 3;  /* first 3 bytes always 0, because len always < 256 */
-  buffer[i] = upper_len & 0xff; i += 1;
-  memset(buffer + i, 0, 3); i += 3; /* zero, as per-standard */
-  buffer[i] = next_header; i += 1;
-
-  /* do computation */
-  total = 0;
-  ptr = (uint16_t*)buffer;
-  words = (i + 1) / 2;
-
-  while (words--) total += *ptr++;
-
-  while (total & 0xffff0000) {
-    total = (total >> 16) + (total & 0xffff);
+  void setGlobalAddress(const char *address)
+  {
+    memcpy(&GLOBAL_ADDRESS, address, 16);
   }
 
-  return ~((uint16_t) total);
-}
+  uint16_t compute_checksum(const IPv6Addr *src_addr, const IPv6Addr *dst_addr, uint8_t next_header, int upper_len, const char *payload, int len)
+  {
+    char buffer[LEN];
+    uint32_t total;
+    uint16_t *ptr;
+    int words;
+    int i = len;
 
-/******** IPv6Addr ********/
-IPv6Addr::IPv6Addr() {;}
+    /* prepare buffer with all data to checksum:
+        - the actual payload
+        - the pseudo ipv6 header
+    */
+    /* actual payload */
+    memcpy(buffer, payload, len);
+    if (len % 2)
+    { /* pad with 0 if length is odd */
+      buffer[len] = 0;
+      i++;
+    }
+    /* pseudo ipv6 header -- see RFC 2460, Section 8.1 */
+    memcpy(buffer + i, src_addr, 16);
+    i += 16;
+    memcpy(buffer + i, dst_addr, 16);
+    i += 16;
+    memset(buffer + i, 0, 3);
+    i += 3; /* first 3 bytes always 0, because len always < 256 */
+    buffer[i] = upper_len & 0xff;
+    i += 1;
+    memset(buffer + i, 0, 3);
+    i += 3; /* zero, as per-standard */
+    buffer[i] = next_header;
+    i += 1;
 
-IPv6Addr::IPv6Addr(const char* address) {
-  memcpy(this->address, address, 16);
-}
+    /* do computation */
+    total = 0;
+    ptr = (uint16_t *)buffer;
+    words = (i + 1) / 2;
 
-/******** IPv6Packet ********/
-IPv6Packet::IPv6Packet() {
-  memset(packet, 0, LEN);
-  *(packet) = 0x60;               /* IP version 6 */
-  *(packet + 7) = HOP_LIMIT;      /* hop limit / ttl */
-}
+    while (words--)
+      total += *ptr++;
 
-IPv6Packet::IPv6Packet(const char* buffer, int len) {
-  memcpy(this->packet, buffer, len);
-}
+    while (total & 0xffff0000)
+    {
+      total = (total >> 16) + (total & 0xffff);
+    }
 
-void IPv6Packet::setNextHeader(uint8_t next_header) {
-  *(packet + 6) = next_header;
-}
+    return ~((uint16_t)total);
+  }
 
-void IPv6Packet::setLen(int len) {
-  *(packet + 4) = len >> 8;
-  *(packet + 5) = len & 0xff;
-}
-int IPv6Packet::getLen() {
-  return ((*(packet + 4)) << 8) + (*(packet + 5));
-}
+  /******** IPv6Addr ********/
+  IPv6Addr::IPv6Addr() { ; }
 
-void IPv6Packet::setSrcAddress(const IPv6Addr* address) {
-  memcpy(packet + 8, address, 16);
-}
-void IPv6Packet::setDstAddress(const IPv6Addr* address) {
-  memcpy(packet + 24, address, 16);
-}
+  IPv6Addr::IPv6Addr(const char *address)
+  {
+    memcpy(this->address, address, 16);
+  }
 
-const IPv6Addr* IPv6Packet::getSrcAddress() {
-  return (const IPv6Addr*) (packet + 8);
-}
-const IPv6Addr* IPv6Packet::getDstAddress() {
-  return (const IPv6Addr*) (packet + 24);
-}
+  /******** IPv6Packet ********/
+  IPv6Packet::IPv6Packet()
+  {
+    memset(packet, 0, LEN);
+    *(packet) = 0x60;          /* IP version 6 */
+    *(packet + 7) = HOP_LIMIT; /* hop limit / ttl */
+  }
 
-void IPv6Packet::setFlow(const char* flow) {
-  /* three bytes
-    4 most significant bits are ignored
-    because only 20 bits can be used */
-  *(packet + 1) = (*(packet + 1)) | (flow[0] & 0x0f); /* pay attention to TC field */
-  memcpy(packet + 2, flow + 1, 2);
-}
+  IPv6Packet::IPv6Packet(const char *buffer, int len)
+  {
+    memcpy(this->packet, buffer, len);
+  }
 
-void IPv6Packet::setPayload(char* payload, int len) {
-  *(packet + 4 + 0) = len >> 8;
-  *(packet + 4 + 1) = len & 0xff;
-  memcpy(packet + 40, payload, len);  /* payload */
-}
+  void IPv6Packet::setNextHeader(uint8_t next_header)
+  {
+    *(packet + 6) = next_header;
+  }
 
-void IPv6Packet::send() {
-  slip::send(packet, 40 + this->getLen());
-}
+  void IPv6Packet::setLen(int len)
+  {
+    *(packet + 4) = len >> 8;
+    *(packet + 5) = len & 0xff;
+  }
+  int IPv6Packet::getLen()
+  {
+    return ((*(packet + 4)) << 8) + (*(packet + 5));
+  }
 
-void IPv6Packet::doAction() {
-  /* if destination is my address (global or link-local), or destination is "all nodes" address, then... */
-  if (
-    (memcmp(&(ALL_NODES_ADDRESS), packet + 24, 16) == 0) ||
-    (memcmp(&(LINK_LOCAL_ADDRESS), packet + 24, 16) == 0) ||
-    (memcmp(&(GLOBAL_ADDRESS), packet + 24, 16) == 0)) {
-    int ilen = this->getLen();  /* input payload length */
-    int olen;                   /* output payload length */
-    
-    switch(*(packet + 6)) { /* next header */
+  void IPv6Packet::setSrcAddress(const IPv6Addr *address)
+  {
+    memcpy(packet + 8, address, 16);
+  }
+  void IPv6Packet::setDstAddress(const IPv6Addr *address)
+  {
+    memcpy(packet + 24, address, 16);
+  }
+
+  const IPv6Addr *IPv6Packet::getSrcAddress()
+  {
+    return (const IPv6Addr *)(packet + 8);
+  }
+  const IPv6Addr *IPv6Packet::getDstAddress()
+  {
+    return (const IPv6Addr *)(packet + 24);
+  }
+
+  void IPv6Packet::setFlow(const char *flow)
+  {
+    /* three bytes
+      4 most significant bits are ignored
+      because only 20 bits can be used */
+    *(packet + 1) = (*(packet + 1)) | (flow[0] & 0x0f); /* pay attention to TC field */
+    memcpy(packet + 2, flow + 1, 2);
+  }
+
+  void IPv6Packet::setPayload(char *payload, int len)
+  {
+    *(packet + 4 + 0) = len >> 8;
+    *(packet + 4 + 1) = len & 0xff;
+    memcpy(packet + 40, payload, len); /* payload */
+  }
+
+  void IPv6Packet::send()
+  {
+    slip::send(packet, 40 + this->getLen());
+  }
+
+  void IPv6Packet::doAction()
+  {
+    /* if destination is my address (global or link-local), or destination is "all nodes" address, then... */
+    if (
+        (memcmp(&(ALL_NODES_ADDRESS), packet + 24, 16) == 0) ||
+        (memcmp(&(LINK_LOCAL_ADDRESS), packet + 24, 16) == 0) ||
+        (memcmp(&(GLOBAL_ADDRESS), packet + 24, 16) == 0))
+    {
+      int ilen = this->getLen(); /* input payload length */
+      int olen;                  /* output payload length */
+
+      switch (*(packet + 6))
+      { /* next header */
       case NH_ICMP:
-        if ((olen = handleICMP((char*)&packetout + 40, packet + 40, ilen)) != -1) {
+        if ((olen = handleICMP((char *)&packetout + 40, packet + 40, ilen)) != -1)
+        {
           packetout.setLen(olen);
-          packetout.setFlow(((char*)(&packetin)) + 1);
+          packetout.setFlow(((char *)(&packetin)) + 1);
           packetout.setSrcAddress(packetin.getDstAddress());
           packetout.setDstAddress(packetin.getSrcAddress());
           packetout.setNextHeader(NH_ICMP);
           packetout.send();
-         }
+        }
         break;
       case NH_UDP:
-        if ((olen = udp::handleUDP((char*)&packetout + 40, packet + 40, ilen)) != -1) {
+        if ((olen = udp::handleUDP((char *)&packetout + 40, packet + 40, ilen)) != -1)
+        {
           packetout.setLen(olen);
-          packetout.setFlow(((char*)(&packetin)) + 1);
+          packetout.setFlow(((char *)(&packetin)) + 1);
           packetout.setSrcAddress(packetin.getDstAddress());
           packetout.setDstAddress(packetin.getSrcAddress());
           packetout.setNextHeader(NH_UDP);
@@ -162,72 +189,80 @@ void IPv6Packet::doAction() {
       default:
         /* no other protocols are known here, sorry :-) */
         break;
-    }
-  } /* ...else discard packet */
-}
-
-/* handles ICMP and (possibly) generate a reply
- *  returns length of generated packet (written to output_buffer), or -1 if there is no reply packet
-*/
-int handleICMP(char* output_buffer, const char* input_buffer, int len) {
-  uint8_t type = *(input_buffer);
-
-  /* compute checksum, and assert validity of incoming message */
-  char received_checksum[2];
-  memcpy(received_checksum, input_buffer + 2, 2);
-
-  memcpy(output_buffer, input_buffer, len);
-  memset(output_buffer + 2, 0, 2); /* zero-checksum */
-  uint16_t computed_checksum = compute_checksum(
-    packetin.getSrcAddress(),
-    packetin.getDstAddress(),
-    NH_ICMP,
-    len,
-    output_buffer,
-    len);
-
-  if (memcmp(&computed_checksum, received_checksum, 2) != 0) { /* if checksum is not valid, return */
-    return -1;
+      }
+    } /* ...else discard packet */
   }
 
-  if (type == ICMP_ECHO_REQUEST_TYPE) { /* if it is ICMPv6 Echo Request, then... */
-    /*  Build an echo reply:
-     *  the reply has the same exact format of the request,
-     *  except for Type and Checksum */
-    *(output_buffer) = ICMP_ECHO_REPLY_TYPE;
-    memset(output_buffer + 2, 0, 2); /* zero-checksum */
+  /* handles ICMP and (possibly) generate a reply
+   *  returns length of generated packet (written to output_buffer), or -1 if there is no reply packet
+   */
+  int handleICMP(char *output_buffer, const char *input_buffer, int len)
+  {
+    uint8_t type = *(input_buffer);
 
-    uint16_t checksum = compute_checksum(
-      packetin.getDstAddress(),
-      packetin.getSrcAddress(),
-      NH_ICMP,
-      len,
-      output_buffer,
-      len);
-    memcpy(output_buffer + 2, &checksum, 2);
-    return len;
-    
-  } else if (type == ICMP_RADV_TYPE && slaac_enable) {  /* if it is IVMPc6 Router Advertisement, then... */
-    ICMPv6_RADV* radv = (ICMPv6_RADV*)input_buffer;
-    HOP_LIMIT = (radv->cur_hop_limit != 0) ? radv->cur_hop_limit : 64;
-    
-    for (
-      ICMPv6_RADV_Option* option = (ICMPv6_RADV_Option*) (radv + 1);
-      option != input_buffer + len;
-      option = (ICMPv6_RADV_Option*) ( ((char*)(option)) + option->len )) {
-        if (option->type == 3 && option->len == 4) {  /* if it is a ICMPv6 Prefix Information, then... */
-          ICMPv6_RADV_PrefixInformation* p = (ICMPv6_RADV_PrefixInformation*) option;
-          
-          if (p->prefix_length != 64) continue; /* only /64 prefix is supported */
-          if (! (p->la_flags & 0x40)) continue; /* only SLAAC is supported */
+    /* compute checksum, and assert validity of incoming message */
+    char received_checksum[2];
+    memcpy(received_checksum, input_buffer + 2, 2);
+
+    memcpy(output_buffer, input_buffer, len);
+    memset(output_buffer + 2, 0, 2); /* zero-checksum */
+    uint16_t computed_checksum = compute_checksum(
+        packetin.getSrcAddress(),
+        packetin.getDstAddress(),
+        NH_ICMP,
+        len,
+        output_buffer,
+        len);
+
+    if (memcmp(&computed_checksum, received_checksum, 2) != 0)
+    { /* if checksum is not valid, return */
+      return -1;
+    }
+
+    if (type == ICMP_ECHO_REQUEST_TYPE)
+    { /* if it is ICMPv6 Echo Request, then... */
+      /*  Build an echo reply:
+       *  the reply has the same exact format of the request,
+       *  except for Type and Checksum */
+      *(output_buffer) = ICMP_ECHO_REPLY_TYPE;
+      memset(output_buffer + 2, 0, 2); /* zero-checksum */
+
+      uint16_t checksum = compute_checksum(
+          packetin.getDstAddress(),
+          packetin.getSrcAddress(),
+          NH_ICMP,
+          len,
+          output_buffer,
+          len);
+      memcpy(output_buffer + 2, &checksum, 2);
+      return len;
+    }
+    else if (type == ICMP_RADV_TYPE && ENABLE_SLAAC)
+    { /* if it is IVMPc6 Router Advertisement, then... */
+      ICMPv6_RADV *radv = (ICMPv6_RADV *)input_buffer;
+      HOP_LIMIT = (radv->cur_hop_limit != 0) ? radv->cur_hop_limit : 64;
+
+      for (
+          ICMPv6_RADV_Option *option = (ICMPv6_RADV_Option *)(radv + 1);
+          option != input_buffer + len;
+          option = (ICMPv6_RADV_Option *)(((char *)(option)) + option->len))
+      {
+        if (option->type == 3 && option->len == 4)
+        { /* if it is a ICMPv6 Prefix Information, then... */
+          ICMPv6_RADV_PrefixInformation *p = (ICMPv6_RADV_PrefixInformation *)option;
+
+          if (p->prefix_length != 64)
+            continue; /* only /64 prefix is supported */
+          if (!(p->la_flags & 0x40))
+            continue;                            /* only SLAAC is supported */
           memcpy(&GLOBAL_ADDRESS, p->prefix, 8); /* set prefix -- leave host bits unchanged */
           break;
         }
+      }
+
+      return -1;
     }
-    
     return -1;
   }
-  return -1;
-}
 
 }

src/ipv6.h

@@ -1,50 +1,56 @@
 #ifndef COPPINO_IPV6_H
 #define COPPINO_IPV6_H
 
+#include "settings.h"
 #include "Arduino.h"
 #include "slip.h"
 
-namespace ipv6 {
+namespace ipv6
+{
   /* maximum length for an IPv6 packet */
   const uint8_t LEN = 128;
 
   /* ICMP Types */
   const uint8_t ICMP_ECHO_REQUEST_TYPE = 128;
-  const uint8_t ICMP_ECHO_REPLY_TYPE   = 129;
-  const uint8_t ICMP_RADV_TYPE         = 134;
+  const uint8_t ICMP_ECHO_REPLY_TYPE = 129;
+  const uint8_t ICMP_RADV_TYPE = 134;
 
   /* Next-Header Types */
   const uint8_t NH_ICMP = 58;
-  const uint8_t NH_UDP  = 17;
+  const uint8_t NH_UDP = 17;
 
-  class IPv6Addr {
-    private:
-      char address[16];
-    public:
-      IPv6Addr();
-      IPv6Addr(const char* address);
+  class IPv6Addr
+  {
+  private:
+    char address[16];
+
+  public:
+    IPv6Addr();
+    IPv6Addr(const char *address);
   };
 
   extern const IPv6Addr ALL_NODES_ADDRESS;
 
-  class IPv6Packet {
-    private:
-      char packet[LEN];
-    public:
-      IPv6Packet();
-      IPv6Packet(const char* buffer, int len);
-      void setLen(int len);
-      int getLen();
-      void setSrcAddress(const IPv6Addr* address);
-      const IPv6Addr* getSrcAddress();
-      void setDstAddress(const IPv6Addr* address);
-      const IPv6Addr* getDstAddress();
-      void setNextHeader(uint8_t next_header);
-      void setFlow(const char* flow);
-      void setPayload(char* payload, int len);
-      void send();
+  class IPv6Packet
+  {
+  private:
+    char packet[LEN];
 
-      void doAction();
+  public:
+    IPv6Packet();
+    IPv6Packet(const char *buffer, int len);
+    void setLen(int len);
+    int getLen();
+    void setSrcAddress(const IPv6Addr *address);
+    const IPv6Addr *getSrcAddress();
+    void setDstAddress(const IPv6Addr *address);
+    const IPv6Addr *getDstAddress();
+    void setNextHeader(uint8_t next_header);
+    void setFlow(const char *flow);
+    void setPayload(char *payload, int len);
+    void send();
+
+    void doAction();
   };
 
   /* incoming and outgoing packets buffer */
@@ -52,20 +58,21 @@ namespace ipv6 {
   extern IPv6Packet packetout;
 
   /* Note: content of message may be changed */
-  int handleICMP(char* output_buffer, const char* input_buffer, int len);
+  int handleICMP(char *output_buffer, const char *input_buffer, int len);
 
   /* Compute internet checksum. Actually it is not so straightforward: */
   uint16_t compute_checksum(
-    const IPv6Addr* src_addr, /* source IPv6 address      */
-    const IPv6Addr* dst_addr, /* destination IPv6 address */
-    uint8_t next_header,      /* IPv6 next header number */
-    int upper_len,            /* length as found in the upper layer protocol */
-    const char* payload,      /* IPv6 payload */
-    int len                   /* IPv6 payload length */
-   );
+      const IPv6Addr *src_addr, /* source IPv6 address      */
+      const IPv6Addr *dst_addr, /* destination IPv6 address */
+      uint8_t next_header,      /* IPv6 next header number */
+      int upper_len,            /* length as found in the upper layer protocol */
+      const char *payload,      /* IPv6 payload */
+      int len                   /* IPv6 payload length */
+  );
 
   /* RFC 4861 -- begin */
-  struct ICMPv6_RADV {
+  struct ICMPv6_RADV
+  {
     uint8_t type;
     uint8_t code;
     char checksum[2];
@@ -76,12 +83,14 @@ namespace ipv6 {
     uint32_t retrans_time;
   };
 
-  struct ICMPv6_RADV_Option {
+  struct ICMPv6_RADV_Option
+  {
     uint8_t type;
     uint8_t len;
   };
 
-  struct ICMPv6_RADV_PrefixInformation {
+  struct ICMPv6_RADV_PrefixInformation
+  {
     uint8_t type;
     uint8_t len;
     uint8_t prefix_length;
@@ -93,9 +102,8 @@ namespace ipv6 {
   };
   /* RFC 4861 -- end */
 
-  void setEUI(const char* eui);         /* 64bit Extended Unique Identifier */
-  void SLAAC(bool enable);              /* enable IPv6 automatic prefix configuration (listens for RADV) */
-  void setGlobalAddress(const char* address); /* global IPv6 address, manually configured */
+  void setEUI(const char *eui);               /* 64bit Extended Unique Identifier */
+  void setGlobalAddress(const char *address); /* global IPv6 address, manually configured */
 }
 
 #endif

src/settings.h

@@ -0,0 +1,8 @@
+#ifndef __COPPINO_SETTINGS_
+#define __COPPINO_SETTINGS_
+
+/* coppino configuration settings */
+// Enable IPv6 automatic prefix configuration (listens for RADV)
+constexpr bool ENABLE_SLAAC = false;
+
+#endif

src/udp.cpp

@@ -1,77 +1,118 @@
 #include "udp.h"
 
-namespace udp {
+namespace udp
+{
+  int (*server_handler)(char *output_buffer, const char *input_buffer, int size) = NULL;
+  uint16_t server_port = 0;
 
-int(*server_handler) (char* output_buffer, const char* input_buffer, int size) = NULL;
-uint16_t server_port = 0;
+  void UDPPacket::setSrcPort(uint16_t port)
+  {
+    *(packet + 0) = port >> 8;
+    *(packet + 1) = port & 0xff;
+  }
 
-void UDPPacket::setSrcPort(uint16_t port) {
-  *(packet + 0) = port >> 8;
-  *(packet + 1) = port & 0xff;
-} 
+  void UDPPacket::setDstPort(uint16_t port)
+  {
+    *(packet + 2) = port >> 8;
+    *(packet + 3) = port & 0xff;
+  }
 
-void UDPPacket::setDstPort(uint16_t port) {
-  *(packet + 2) = port >> 8;
-  *(packet + 3) = port & 0xff;
-}
+  uint16_t UDPPacket::getSrcPort()
+  {
+    return (*(packet + 0) << 8) + (uint8_t) * (packet + 1);
+  }
+  uint16_t UDPPacket::getDstPort()
+  {
+    return (*(packet + 2) << 8) + (uint8_t) * (packet + 3);
+  }
 
-uint16_t UDPPacket::getSrcPort() {
-  return (*(packet + 0) << 8) + (uint8_t)*(packet + 1);
-}
-uint16_t UDPPacket::getDstPort() {
-  return (*(packet + 2) << 8) + (uint8_t)*(packet + 3);
-}
+  /* sets the payload and also updates the packet length field */
+  void UDPPacket::setPayload(const char *payload, int len)
+  {
+    memcpy(packet + 8, payload, len);
+    *(packet + 4) = (len + 8) >> 8;
+    *(packet + 5) = (len + 8) & 0xff;
+  }
+  const char *UDPPacket::getPayload()
+  {
+    return packet + 8;
+  }
 
-/* sets the payload and also updates the packet length field */
-void UDPPacket::setPayload(const char* payload, int len) {
-  memcpy(packet + 8, payload, len);
-  *(packet + 4) = (len + 8) >> 8;
-  *(packet + 5) = (len + 8) & 0xff;
-}
-const char* UDPPacket::getPayload() {
-  return packet + 8;
-}
+  /* computes the checksum and also updates it inside the UDP packet */
+  void UDPPacket::computeChecksum(const ipv6::IPv6Addr *src_addr, const ipv6::IPv6Addr *dst_addr, int len)
+  {
+    memset(packet + 6, 0, 2);
+    uint16_t checksum = ipv6::compute_checksum(src_addr, dst_addr, ipv6::NH_UDP, len, packet, len);
+    memcpy(packet + 6, &checksum, 2);
+  }
 
-/* computes the checksum and also updates it inside the UDP packet */
-void UDPPacket::computeChecksum(const ipv6::IPv6Addr* src_addr, const ipv6::IPv6Addr* dst_addr, int len) {
-  memset(packet + 6, 0, 2);
-  uint16_t checksum = ipv6::compute_checksum(src_addr, dst_addr, ipv6::NH_UDP, len, packet, len);
-  memcpy(packet + 6, &checksum, 2);
-}
+  /* sets an handler (a function) which will be called every time there is a packet for a certain given port */
+  void set_handler(uint16_t port, int (*server_handler)(char *output_buffer, const char *input_buffer, int size))
+  {
+    udp::server_port = port;
+    udp::server_handler = server_handler;
+  }
 
-/* sets an handler (a function) which will be called every time there is a packet for a certain given port */
-void set_handler(uint16_t port, int(* server_handler) (char* output_buffer, const char* input_buffer, int size)) {
-  udp::server_port = port;
-  udp::server_handler = server_handler;
-}
+  /* handles an UDP packet, and (possibly) produces a reply UDP packet
+   * returns length of reply packet, which is written in output_buffer, or -1 if there is no reply packet
+   */
+  int handleUDP(char *output_buffer, const char *input_buffer, int ilen)
+  {
+    UDPPacket *incoming_packet = (UDPPacket *)input_buffer;
+    UDPPacket *outgoing_packet = (UDPPacket *)output_buffer;
+    int olen;
 
-/* handles an UDP packet, and (possibly) produces a reply UDP packet
- * returns length of reply packet, which is written in output_buffer, or -1 if there is no reply packet
-*/
-int handleUDP(char* output_buffer, const char* input_buffer, int ilen) {
-  UDPPacket* incoming_packet = (UDPPacket*)input_buffer;
-  UDPPacket* outgoing_packet = (UDPPacket*)output_buffer;
-  int olen;
+    if (incoming_packet->getDstPort() == server_port)
+    { /* call user-defined server handler */
+      if (server_port != 0 && server_handler != NULL)
+      {
+        olen = server_handler(outgoing_packet->getPayload(), incoming_packet->getPayload(), ilen - 8);
 
-  if (incoming_packet->getDstPort() == server_port) { /* call user-defined server handler */
-    if (server_port != 0 && server_handler != NULL) {
-      olen = server_handler(outgoing_packet->getPayload(), incoming_packet->getPayload(), ilen - 8);
-      
+        outgoing_packet->setSrcPort(incoming_packet->getDstPort());
+        outgoing_packet->setDstPort(incoming_packet->getSrcPort());
+        outgoing_packet->setPayload(outgoing_packet->getPayload(), olen);
+        outgoing_packet->computeChecksum(ipv6::packetin.getDstAddress(), ipv6::packetin.getSrcAddress(), olen + 8);
+        return olen + 8;
+      }
+    }
+    else
+    { /* default UDP application handler: echoes back the packet content */
       outgoing_packet->setSrcPort(incoming_packet->getDstPort());
       outgoing_packet->setDstPort(incoming_packet->getSrcPort());
-      outgoing_packet->setPayload(outgoing_packet->getPayload(), olen);
-      outgoing_packet->computeChecksum(ipv6::packetin.getDstAddress(), ipv6::packetin.getSrcAddress(), olen + 8);
-      return olen + 8;
+      outgoing_packet->setPayload(incoming_packet->getPayload(), ilen - 8);
+      outgoing_packet->computeChecksum(ipv6::packetin.getSrcAddress(), ipv6::packetin.getDstAddress(), ilen);
+      return ilen;
     }
-  } else {  /* default UDP application handler: echoes back the packet content */
-    outgoing_packet->setSrcPort(incoming_packet->getDstPort());
-    outgoing_packet->setDstPort(incoming_packet->getSrcPort());
-    outgoing_packet->setPayload(incoming_packet->getPayload(), ilen - 8);
-    outgoing_packet->computeChecksum(ipv6::packetin.getSrcAddress(), ipv6::packetin.getDstAddress(), ilen);
-    return ilen;
+
+    return -1;
+  }
+
+  UDPClient::UDPClient(
+      const ipv6::IPv6Addr &_srcaddr,
+      ipv6::IPv6Addr &_dstaddr,
+      const uint16_t _srcport,
+      const uint16_t _dstport) : srcaddr(_srcaddr),
+                                 dstaddr(_dstaddr),
+                                 srcport(_srcport),
+                                 dstport(_dstport)
+  {
+    ;
+  }
+
+  void UDPClient::send_datagram(const uint8_t *obuffer, size_t len)
+  {
+    UDPPacket *outgoing_packet = (UDPPacket *)(((uint8_t *)&ipv6::packetout) + 40);
+    outgoing_packet->setSrcPort(srcport);
+    outgoing_packet->setDstPort(dstport);
+    outgoing_packet->setPayload((const char *)obuffer, len);
+    outgoing_packet->computeChecksum(&srcaddr, &dstaddr, len + 8);
+
+    ipv6::packetout.setLen(len + 8);
+    ipv6::packetout.setFlow("\x26\x12\x21");
+    ipv6::packetout.setSrcAddress(&srcaddr);
+    ipv6::packetout.setDstAddress(&dstaddr);
+    ipv6::packetout.setNextHeader(ipv6::NH_UDP);
+    ipv6::packetout.send();
   }
-  
-  return -1;
-}
 
 }

src/udp.h

@@ -4,27 +4,43 @@
 #include "Arduino.h"
 #include "ipv6.h"
 
-namespace udp {
-  class UDPPacket {
-    private:
-      char packet[ipv6::LEN - 40];
-    public:
-      void setSrcPort(uint16_t port);
-      uint16_t getSrcPort();
-      void setDstPort(uint16_t port);
-      uint16_t getDstPort();
-      const char* UDPPacket::getPayload();
-      void setPayload(const char* payload, int len);  /* also sets proper length */
-      void computeChecksum(const ipv6::IPv6Addr* src_addr, const ipv6::IPv6Addr* dst_addr, int len);  /* computes and updates checksum in the packet */
+namespace udp
+{
+  class UDPPacket
+  {
+  private:
+    char packet[ipv6::LEN - 40];
+
+  public:
+    void setSrcPort(uint16_t port);
+    uint16_t getSrcPort();
+    void setDstPort(uint16_t port);
+    uint16_t getDstPort();
+    const char *UDPPacket::getPayload();
+    void setPayload(const char *payload, int len);                                                 /* also sets proper length */
+    void computeChecksum(const ipv6::IPv6Addr *src_addr, const ipv6::IPv6Addr *dst_addr, int len); /* computes and updates checksum in the packet */
+  };
+
+  class UDPClient
+  {
+  private:
+    const ipv6::IPv6Addr &srcaddr;
+    const ipv6::IPv6Addr &dstaddr;
+    const uint16_t srcport;
+    const uint16_t dstport;
+
+  public:
+    UDPClient(const ipv6::IPv6Addr &srcaddr, ipv6::IPv6Addr &dstaddr, const uint16_t srcport, const uint16_t dstport);
+    void send_datagram(const uint8_t *payload, size_t len);
   };
 
   /* UDP handler for lower layer protocol */
-  int handleUDP(char* output_buffer, const char* input_buffer, int len);
+  int handleUDP(char *output_buffer, const char *input_buffer, int len);
 
   /* pointer to server handler function */
-  extern int(*server_handler) (char* output_buffer, const char* buffer, int size);
+  extern int (*server_handler)(char *output_buffer, const char *buffer, int size);
   extern uint16_t server_port;
-  void set_handler(uint16_t port, int(* handler) (char* output_buffer, const char* input_buffer, int size));
+  void set_handler(uint16_t port, int (*handler)(char *output_buffer, const char *input_buffer, int size));
 }
 
 #endif