tests/tests_frescan/test_frescan_servers_send_fast.c

   1 //----------------------------------------------------------------------
   2 //  Copyright (C) 2006 - 2009 by the FRESCOR consortium:
   3 //
   4 //    Universidad de Cantabria,              SPAIN
   5 //    University of York,                    UK
   6 //    Scuola Superiore Sant'Anna,            ITALY
   7 //    Kaiserslautern University,             GERMANY
   8 //    Univ. Politecnica  Valencia,           SPAIN
   9 //    Czech Technical University in Prague,  CZECH REPUBLIC
  10 //    ENEA                                   SWEDEN
  11 //    Thales Communication S.A.              FRANCE
  12 //    Visual Tools S.A.                      SPAIN
  13 //    Rapita Systems Ltd                     UK
  14 //    Evidence                               ITALY
  15 //
  16 //    See http://www.frescor.org
  17 //
  18 //        The FRESCOR project (FP6/2005/IST/5-034026) is funded
  19 //        in part by the European Union Sixth Framework Programme
  20 //        The European Union is not liable of any use that may be
  21 //        made of this code.
  22 //
  23 //
  24 //  based on previous work (FSF) done in the FIRST project
  25 //
  26 //   Copyright (C) 2005  Mälardalen University, SWEDEN
  27 //                       Scuola Superiore S.Anna, ITALY
  28 //                       Universidad de Cantabria, SPAIN
  29 //                       University of York, UK
  30 //
  31 // This file is part of FNA (Frescor Network Adaptation)
  32 //
  33 // FNA is free software; you can redistribute it and/or modify it
  34 // under terms of the GNU General Public License as published by the
  35 // Free Software Foundation; either version 2, or (at your option) any
  36 // later version.  FNA is distributed in the hope that it will be
  37 // useful, but WITHOUT ANY WARRANTY; without even the implied warranty
  38 // of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
  39 // General Public License for more details. You should have received a
  40 // copy of the GNU General Public License along with FNA; see file
  41 // COPYING. If not, write to the Free Software Foundation, 675 Mass Ave,
  42 // Cambridge, MA 02139, USA.
  43 //
  44 // As a special exception, including FNA header files in a file,
  45 // instantiating FNA generics or templates, or linking other files
  46 // with FNA objects to produce an executable application, does not
  47 // by itself cause the resulting executable application to be covered
  48 // by the GNU General Public License. This exception does not
  49 // however invalidate any other reasons why the executable file might be
  50 // covered by the GNU Public License.
  51 // -----------------------------------------------------------------------
  52 #include <stdio.h>  // perror
  53 #include <stdlib.h> // exit
  54 #include <unistd.h>   // sleep
  55 #include <assert.h>
  56
  57 #include <drivers/console_switcher.h>
  58 #include <misc/logger.h>
  59
  60 #include "frescan.h"
  61 #include "frescan_servers.h"
  62
  63 #define PUT_ERROR(s) {perror (s); exit (-1);}
  64
  65 #define NETWORK 0
  66 // #define SENDER
  67
  68 #ifdef SENDER
  69
  70 #define LOCAL_NODE 0
  71
  72 static void pause(){
  73         char key;
  74         printf(" press Enter...");
  75         key = getchar();
  76 }
  77
  78 int main ()
  79 {
  80         int i, ret;
  81         frescan_send_params_t params;
  82         char msg[200];
  83         frescan_init_params_t init_params;
  84         frescan_server_params_t server_params;
  85
  86         ret = logger_init(LOG_ETHERNET);
  87         assert(ret == 0);
  88
  89 //         MEMBUFFER_CONSOLE_INIT();
  90
  91         printf(">> Initializing FRESCAN\n");
  92
  93         init_params.net = NETWORK;
  94         init_params.node = LOCAL_NODE;
  95         init_params.tx_fp_max_prio = 10;
  96         init_params.rx_num_of_channels = 5;
  97         init_params.rx_channel_max_prio = NULL;
  98
  99         ret = frescan_init(&init_params);
 100         if (ret != 0) PUT_ERROR ("could not init FRESCAN");
 101
 102         printf(">> Creating a Server\n");
 103
 104         server_params.budget = 4;
 105         server_params.period.tv_sec  = 3;
 106         server_params.period.tv_nsec = 0;
 107         server_params.prio = 5;
 108
 109         ret = frescan_servers_create(NETWORK,
 110                                      &server_params,
 111                                      &params.ss);
 112         if (ret != 0) PUT_ERROR ("could not create server");
 113
 114         printf(">> Enter in loop for sending packets\n");
 115
 116         params.net      = NETWORK;
 117         params.to       = 1;
 118         params.channel  = 2;
 119         params.flags    = FRESCAN_SS | FRESCAN_ASYNC;
 120
 121         while(1) {
 122                 pause();
 123                 for (i=0; i<2; i++) {
 124                         *((uint8_t *)msg) = (uint8_t)i;
 125                         ret = frescan_send(&params, (uint8_t *)msg, 3);
 126                         if (ret != 0) PUT_ERROR ("could not send message\n");
 127                         while (logger_manual_call() > 0);
 128                        printf("SENT\n");
 129                 }
 130         }
 131
 132         return 0;
 133 }
 134
 135 #else
 136
 137 #define LOCAL_NODE 1
 138
 139 int main ()
 140 {
 141         int ret;
 142         frescan_recv_params_t params;
 143         uint8_t msg[3000];
 144         size_t recv_bytes;
 145         frescan_node_t from;
 146         frescan_init_params_t init_params;
 147         frescan_prio_t prio;
 148
 149         init_params.net = NETWORK;
 150         init_params.node = LOCAL_NODE;
 151         init_params.tx_fp_max_prio = 10;
 152         init_params.rx_num_of_channels = 5;
 153         init_params.rx_channel_max_prio = NULL;
 154
 155         ret = frescan_init(&init_params);
 156         if (ret != 0) PUT_ERROR ("could not init FRESCAN");
 157
 158         printf("FRESCAN initialized\n");
 159
 160         params.net      = NETWORK;
 161         params.channel  = 2;
 162         params.flags    = FRESCAN_SYNC;
 163
 164         while (1) {
 165                 printf("RECEIVING...\n");
 166                 ret = frescan_recv(&params, (uint8_t *)msg, sizeof(msg),
 167                                    &recv_bytes, &from, &prio);
 168                 if (ret != 0) PUT_ERROR ("could not send message");
 169
 170                 printf("RECEIVED msg %u with prio:%u\n", msg[0], prio);
 171
 172 //                 for (i=0; i<recv_bytes; i++) {
 173 //                         printf("msg[%d] = 0x%X;\n", i, msg[i]);
 174 //                 }
 175         }
 176
 177         return 0;
 178 }
 179
 180 #endif