tests/tests_frescan/test_frescan_fp_send_basic_pp_measures.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 <time.h>
  55 #include "frescan.h"
  56
  57 #define PUT_ERROR(s) {perror (s); exit (-1);}
  58
  59 #define NETWORK 0
  60
  61 #define SENDER
  62 // #define ENABLE_LOGGING
  63 #define ENABLE_PARALLEL_PORT_TRACER
  64
  65 #ifdef ENABLE_PARALLEL_PORT_TRACER
  66 #include <sys/pio.h>
  67 #define PP_BASE_REG    0x378
  68 #define PP_DATA_REG    0     // Data port offset
  69 #endif
  70
  71 #if 0
  72 #include <stdio.h>
  73 #define DEBUG(x,args...) printf("%s: " x, __func__ , ##args)
  74 #else
  75 #define DEBUG(x,args...)
  76 #endif
  77
  78 #ifdef SENDER
  79
  80 #define LOCAL_NODE 1
  81
  82 #ifdef ENABLE_LOGGING
  83
  84 #include <drivers/console_switcher.h>
  85 #include <misc/logger.h>
  86 #include <assert.h>
  87 #define LOG_DEVICE LOG_ETHERNET
  88
  89 #endif
  90
  91 int main ()
  92 {
  93         int i, ret;
  94         frescan_send_params_t params;
  95         char msg[200];
  96         int written;
  97         frescan_init_params_t init_params;
  98         struct timespec my_period, next_activation;
  99
 100         init_params.net = NETWORK;
 101         init_params.node = LOCAL_NODE;
 102         init_params.tx_fp_max_prio = 10;
 103         init_params.rx_num_of_channels = 5;
 104         init_params.rx_channel_max_prio = NULL;
 105
 106 #ifdef ENABLE_LOGGING
 107         ret = logger_init(LOG_DEVICE);
 108         assert(ret == 0);
 109
 110         DEBUG("Changing to membuffer console\n");
 111         MEMBUFFER_CONSOLE_INIT();
 112 #endif
 113         ret = frescan_init(&init_params);
 114         if (ret != 0) PUT_ERROR ("could not init FRESCAN");
 115
 116         DEBUG("FRESCAN initialized (local node: %u)\n", LOCAL_NODE);
 117
 118         params.net      = NETWORK;
 119         params.to       = 0;
 120         params.channel  = 0;
 121         params.flags    = FRESCAN_FP | FRESCAN_ASYNC;
 122         params.prio     = 7;
 123
 124         my_period.tv_sec  = 0;
 125         my_period.tv_nsec = 100000000;
 126
 127         outb_p (PP_BASE_REG + PP_DATA_REG, 0x00);
 128
 129         for(i=0; 1; i++) {
 130                 incr_timespec (next_activation, my_period); // the fosa one
 131                 clock_nanosleep(CLOCK_MONOTONIC,
 132                                 TIMER_ABSTIME,
 133                                 &next_activation, NULL);
 134
 135                 written = snprintf(msg, sizeof(msg), "his number is... %d", i);
 136 #ifdef ENABLE_PARALLEL_PORT_TRACER
 137                 outb_p (PP_BASE_REG + PP_DATA_REG, 0xFF);
 138 #endif
 139                 ret = frescan_send(&params, (uint8_t *)msg, 32);
 140                 if (ret != 0) PUT_ERROR ("could not send message\n");
 141
 142 #ifdef ENABLE_PARALLEL_PORT_TRACER
 143                 outb_p (PP_BASE_REG + PP_DATA_REG, 0x00);
 144 #endif
 145                 DEBUG("SENT: %d\n", i);
 146 #ifdef ENABLE_LOGGING
 147                 while (logger_manual_call() > 0);
 148 #endif
 149         }
 150
 151         return 0;
 152 }
 153
 154 #else
 155
 156 #define LOCAL_NODE 0
 157
 158 int main ()
 159 {
 160         int ret;
 161         frescan_recv_params_t params;
 162         uint8_t msg[3000];
 163         size_t recv_bytes;
 164         frescan_node_t from;
 165         frescan_init_params_t init_params;
 166         frescan_prio_t prio;
 167         struct timespec pulse_width = {0, 100000};
 168
 169         init_params.net = NETWORK;
 170         init_params.node = LOCAL_NODE;
 171         init_params.tx_fp_max_prio = 10;
 172         init_params.rx_num_of_channels = 5;
 173         init_params.rx_channel_max_prio = NULL;
 174
 175         ret = frescan_init(&init_params);
 176         if (ret != 0) PUT_ERROR ("could not init FRESCAN");
 177
 178         DEBUG("FRESCAN initialized (local node: %u)\n", LOCAL_NODE);
 179
 180         params.net      = NETWORK;
 181         params.channel  = 0;
 182         params.flags    = FRESCAN_SYNC;
 183
 184         outb_p (PP_BASE_REG + PP_DATA_REG, 0x00);
 185
 186         while (1) {
 187                 DEBUG("RECEIVING...\n");
 188                 ret = frescan_recv(&params, (uint8_t *)msg, sizeof(msg),
 189                                     &recv_bytes, &from, &prio);
 190                 if (ret != 0) PUT_ERROR ("could not send message");
 191 #ifdef ENABLE_PARALLEL_PORT_TRACER
 192                 outb_p (PP_BASE_REG + PP_DATA_REG, 0xFF);
 193                 nanosleep(&pulse_width, NULL);
 194                 outb_p (PP_BASE_REG + PP_DATA_REG, 0x00);
 195 #endif
 196                 msg[recv_bytes] = '\0';
 197                 DEBUG("RECEIVED: %s with prio:%u from:%u\n", msg, prio, from);
 198         }
 199
 200         return 0;
 201 }
 202
 203 #endif