Autoconfiguration for nodes and coordinator, implementation of reading

Author: Juan Flores

examples/udp_6lowpan/Makefile

@@ -49,7 +49,7 @@ STACKSIZE = $(CONFIG_EXAMPLES_UDP_6LOWPAN_STACKSIZE)
 
 ASRCS =
 CSRCS =
-MAINSRC = udp_6lowpan_main.c
+MAINSRC = udp_6lowpan_main.c wpan_config.c udp_write.c udp_read.c
 
 CONFIG_EXAMPLES_UDP_6LOWPAN_PROGNAME ?= udp_6lowpan$(EXEEXT)
 PROGNAME = $(CONFIG_EXAMPLES_UDP_6LOWPAN_PROGNAME)

examples/udp_6lowpan/udp_6lowpan_main.c

@@ -1,8 +1,8 @@
 /****************************************************************************
- * examples/hello/hello_main.c
+ * examples/udp_6lowpan/udp_6lowpan_main.c
  *
- *   Copyright (C) 2008, 2011-2012 Gregory Nutt. All rights reserved.
- *   Author: Gregory Nutt <gnutt@nuttx.org>
+ *   Copyright (C) 2019 Acutronics Robotics. All rights reserved.
+ *   Author: Acutronics Robotics <juan@erlerobotics.com>
  *
  * Redistribution and use in source and binary forms, with or without
  * modification, are permitted provided that the following conditions
@@ -38,20 +38,10 @@
  ****************************************************************************/
 
 #include <nuttx/config.h>
-
-#include <stdio.h>
-#include <stdlib.h>
-#include <unistd.h>
 #include <string.h>
-#include <errno.h>
 
-#include <stdlib.h>
 #include <stdio.h>
-#include <arpa/inet.h>
-
-#include <sys/types.h>
-#include <sys/socket.h>
-
+#include <stdlib.h>
 
 /****************************************************************************
  * Public Functions
@@ -64,196 +54,30 @@ void lowpan_configuration();
  * Variables
  ****************************************************************************/
 
-uint16_t g_udpserver_ipv6[8] =
-{
-  HTONS(0),
-  HTONS(0),
-  HTONS(0),
-  HTONS(0),
-  HTONS(0),
-  HTONS(0),
-  HTONS(0),
-  HTONS(0)
-};
-
 /****************************************************************************
  * Main Functions
  ****************************************************************************/
-int udp_6lowpan_main(int argc, char *argv[]){
+int udp_6lowpan_main(int argc, char *argv[]) {
 
   printf("Do you want to execute the automatic WPAN configuration? (y/n)\n");
-  char aux=getchar();
-  if(aux=='y') lowpan_configuration();
+  char aux = getchar();
+  if (aux == 'y')
+    lowpan_configuration();
 
-  while(1){
-    printf("\nAvailable commands\n -To send a package type: write \n -To receive a package type: read \n -To exit type: quit\n");
+  while (1) {
+    printf("\nAvailable commands\n -To send a package type: write \n -To "
+           "receive a package type: read \n -To exit type: quit\n");
     char buffer[256];
-    scanf("%255s",buffer);
-    if(strcmp(buffer, "write") == 0){
+    scanf("%255s", buffer);
+    if (strcmp(buffer, "write") == 0) {
       udp_write();
-    }
-    else if(strcmp(buffer, "read") == 0){
+    } else if (strcmp(buffer, "read") == 0) {
       udp_read();
-    }
-    else if(strcmp(buffer, "quit") == 0){
-      return 0;
-    }
-    else{
-      printf("\nWrong command.\n -To send a package type: write \n -To receive a package type: read \n -To exit type: quit\n");
-    }
-  }
-
-}
-
-int udp_write(){
-  //Get IP and destination port
-  struct sockaddr_in6 server;
-
-  unsigned char outbuf[256];
-  socklen_t addrlen;
-  int sockfd;
-  int nbytes;
-  int offset;
-
-
-  //Buffers
-  char buffer[256];//Buffer to save the income data
-  char ip_buffer[256];
-  char port_origin[10],port_destination[10];
-  int aux=0;
-  uint8_t char_rec=0;
-
-  //Getting IPV6 destination
-  printf("Introduce the IVP6 Destination\r\n");
-  char_rec=scanf("%255s",ip_buffer);
-  if(char_rec==0){
-    printf("Error: Wrong IP\r\n");
-    return 0;
-  }
-  inet_pton(AF_INET6, ip_buffer, g_udpserver_ipv6);
-
-  //Getting port destination
-  printf("Introduce the port destination\r\n");
-  char_rec=scanf("%10s",port_destination);
-  if(char_rec==0){
-    printf("Error: Wrong IP\r\n");
-    return 0;
-  }
-
-  printf("Introduce the port origin\r\n");
-  char_rec=scanf("%10s",port_origin);
-  if(char_rec==0){
-    printf("Error: Wrong IP\r\n");
-    return 0;
-  }
-
-  printf("Conection data: \r\n -Dest_IP: %s \r\n -Dest_Port: %s\r\n -Origin_Port: %s\r\n",ip_buffer,port_destination,port_origin);
-
-/**********************Creating client connection***************************/
-
-  //Creating socket
-  sockfd = socket(AF_INET6, SOCK_DGRAM, 0);
-  if (sockfd < 0){
-    printf("Error: Socket creation failure %d\n", errno);
-    return 0;
-  }
-
-  /* Bind the UDP socket to a IPv6 port */
-
-  server.sin6_family     = AF_INET6;
-  server.sin6_port       = HTONS(atoi(port_origin));
-  memset(server.sin6_addr.s6_addr, 0, sizeof(struct in6_addr));
-  addrlen              = sizeof(struct sockaddr_in6);
-
-  if (bind(sockfd, (FAR struct sockaddr *)&server, addrlen) < 0){
-      printf("Error: Bind failure: %d\n", errno);
-      return -1;
-  }
-
-/**********************Creating client connection***************************/
-
-  //Copy the server configuration
-  server.sin6_family            = AF_INET6;
-  server.sin6_port              = HTONS(atoi(port_destination));
-  memcpy(server.sin6_addr.s6_addr16, g_udpserver_ipv6, 8 * sizeof(uint16_t));
-  addrlen                       = sizeof(struct sockaddr_in6);
-
-  //Message to be send
-  while(1){
-    char buffer[256];
-    printf("Introduce a message to send:\r\n");
-    char_rec=scanf("%255s",buffer);
-    if(strcmp("quit",buffer)==0){
-      printf("Closing connection\n");
-      close(sockfd);
-      return;
-    }
-    printf("Sending %i characters: %s \n\n",strlen(buffer),buffer);
-    sendto(sockfd, buffer, strlen(buffer), 0,
-                    (struct sockaddr*)&server, addrlen);
-  }
-
-
-}
-
-void udp_read(){
-
-}
-
-void lowpan_configuration(){
-  char buffer[256];
-  int id=0;
-  printf("Starting WPAN configuration\n");
-  printf("Type C to be coordinator\nType N to be node\n\n\n");
-
-  scanf("%1s",buffer);
-  system("ifdown wpan0");
-  if(strcmp("c",buffer)==0){
-    //Set coordinator
-    system("i8sak wpan0 startpan cd:ab");
-    system("i8sak set chan 26");
-    sleep(1);
-    printf("Choose your ID (00 to FF)\n\n");
-    scanf("%s",buffer);
-    if(strlen(buffer)<2 ){
-      printf("Error ID must be between 00 and FF\n");
-      return 0;
-    }
-    system("i8sak set saddr 42:01");
-    sprintf(buffer,"i8sak set eaddr 00:fa:de:00:de:ad:be:%c%c",buffer[0],buffer[1]);
-    printf("Your hardware address is: %s\n\n",buffer);
-    system(buffer);
-    system("i8sak acceptassoc");
-
-  }
-  else if(strcmp("n",buffer)==0){
-    //Set node
-    system("i8sak wpan0");
-    system("i8sak set chan 26");
-    system("i8sak set panid cd:ab");
-    sleep(1);
-    printf("Choose your ID (00 to FF)\n\n");
-    scanf("%s",buffer);
-    if(strlen(buffer)<2 ){
-      printf("Error ID must be between 00 and FF\n");
+    } else if (strcmp(buffer, "quit") == 0) {
       return 0;
+    } else {
+      printf("\nWrong command.\n -To send a package type: write \n -To receive "
+             "a package type: read \n -To exit type: quit\n");
     }
-
-    sprintf(buffer,"i8sak set eaddr 00:fa:de:00:de:ad:be:%c%c",buffer[0],buffer[1]);
-    system(buffer);
-    system("i8sak set ep_saddr 42:01");
-    system("i8sak set saddr 42:02");
-    printf("Your hardware address is: %s\n\n",buffer);
-    system("i8sak assoc");
   }
-  else{
-    printf("Wrong profile\r\n");
-  }
-  system("ifup wpan0");
-
-  printf("Mounting proc file system\n");
-  system("mount -t procfs /proc");
-  system("cat proc/net/wpan0");
-  printf("\n\n");
-
 }

examples/udp_6lowpan/udp_read.c

@@ -0,0 +1,91 @@
+
+#include <errno.h>
+#include <string.h>
+#include <unistd.h>
+
+#include <arpa/inet.h>
+#include <stdio.h>
+#include <stdlib.h>
+
+#include <sys/socket.h>
+#include <sys/types.h>
+
+#include <nuttx/config.h>
+
+char port_origin[10];
+
+int optval;
+int char_rec;
+
+socklen_t addrlen;
+socklen_t recvlen;
+
+struct sockaddr_in6 server;
+struct sockaddr_in6 client;
+
+int sockfd;
+int nbytes;
+
+int offset;
+
+void udp_read() {
+
+  printf("Introduce the reception port\r\n");
+  char_rec = scanf("%10s", port_origin);
+  if (char_rec == 0) {
+    printf("Error: Wrong port\r\n");
+    return 0;
+  }
+  /* Create a new UDP socket */
+
+  sockfd = socket(PF_INET6, SOCK_DGRAM, 0);
+  if (sockfd < 0) {
+    printf("server: socket failure: %d\n", errno);
+    exit(1);
+  }
+
+  optval = 1;
+  if (setsockopt(sockfd, SOL_SOCKET, SO_REUSEADDR, (void *)&optval,
+                 sizeof(int)) < 0) {
+    printf("server: setsockopt SO_REUSEADDR failure: %d\n", errno);
+    exit(1);
+  }
+
+  /* Bind the socket to a local address */
+
+  server.sin6_family = AF_INET6;
+  server.sin6_port = HTONS(atoi(port_origin));
+
+  memset(&server.sin6_addr, 0, sizeof(struct in6_addr));
+
+  addrlen = sizeof(struct sockaddr_in6);
+
+  if (bind(sockfd, (struct sockaddr *)&server, addrlen) < 0) {
+    printf("server: bind failure: %d\n", errno);
+    exit(1);
+  }
+
+  printf("Listening on %s for input packets\n", port_origin);
+
+  sleep(5);
+  recvlen = addrlen;
+  while (1) {
+    unsigned char inbuf[1024];
+    memset(&inbuf, 0, 1024);
+    nbytes =
+        recvfrom(sockfd, inbuf, 1024, 0, (struct sockaddr *)&client, &recvlen);
+
+    printf("Received %d bytes from %04x:%04x:%04x:%04x:%04x:%04x:%04x:%04x "
+           "port %d\n",
+           nbytes, client.sin6_addr.s6_addr16[0], client.sin6_addr.s6_addr16[1],
+           client.sin6_addr.s6_addr16[2], client.sin6_addr.s6_addr16[3],
+           client.sin6_addr.s6_addr16[4], client.sin6_addr.s6_addr16[5],
+           client.sin6_addr.s6_addr16[6], client.sin6_addr.s6_addr16[7],
+           ntohs(client.sin6_port));
+    printf("Received packet: ");
+    printf(inbuf);
+    printf("\n");
+
+    usleep(100);
+  }
+}