RIOT/projects/WEAtHeR/weather_routing.c

#include <stdlib.h>
#include <stdio.h>
#include <cc1100.h>
#include <time.h>
#include "weather_protocol.h"
#include "weather_routing.h"

static source_timestamp_t sources[MAX_SOURCES];

static uint8_t update_sources(uint8_t id, time_t timestamp) {
    uint8_t i;
    for (i = 0; i < MAX_SOURCES; i++) {
        /* source id found */
        if (sources[i].id == id) {
            /* more current timestamp received, updating */
            if (sources[i].timestamp < timestamp) {
                sources[i].timestamp = timestamp;
                return 1;
            }
            /* older, but still valid timestamp, not updating */
            else if (sources[i].timestamp < timestamp + MAX_INTERVAL) {
                return 1;
            }
            /* timestamp too old, discard this packet */
            else {
                puts("Timestamp too old, not routing");
                return 0;
            }
        }
        /* source id not yet stored creating new entry */
        else if (!sources[i].id) {
            sources[i].id = id;
            sources[i].timestamp = timestamp;
            return 1;
        }
    }
    puts("No more sources could be stored!");
    return 0;
}

void route_packet(void* msg, int msg_size) {
   weather_packet_header_t *header = (weather_packet_header_t*) msg;
   if (header->type == WEATHER_DATA) {
        weather_data_pkt_t* wdp = (weather_data_pkt_t*) msg;
        if (!update_sources(wdp->header.src, wdp->timestamp)) {
            return;
        }
   }

   if ((100.0 * rand()/(double) RAND_MAX) <= FLOODING_PROB) {
       printf("Broadcasting packet...");
       if (cc1100_send_csmaca(0, WEATHER_PROTOCOL_NR, 0, (char*)msg, msg_size)) {
               puts("successful!");
       }
       else {
           puts("failed!");
       }
   }
}