143 lines
3.9 KiB
C++
143 lines
3.9 KiB
C++
/*
|
|
Copyright (c) 2013, Matthias Schiffer <mschiffer@universe-factory.net>
|
|
All rights reserved.
|
|
|
|
Redistribution and use in source and binary forms, with or without
|
|
modification, are permitted provided that the following conditions are met:
|
|
|
|
1. Redistributions of source code must retain the above copyright notice,
|
|
this list of conditions and the following disclaimer.
|
|
2. Redistributions in binary form must reproduce the above copyright notice,
|
|
this list of conditions and the following disclaimer in the documentation
|
|
and/or other materials provided with the distribution.
|
|
|
|
THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
|
|
AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
|
|
IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
|
|
DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
|
|
FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
|
|
DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
|
|
SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
|
|
CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
|
|
OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
|
|
OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
|
*/
|
|
|
|
|
|
#include "mmss.hpp"
|
|
#include "util.hpp"
|
|
|
|
#include <cassert>
|
|
|
|
|
|
extern "C" {
|
|
|
|
gmrf_addr_t gmrf_iface_get_addr(gmrf_t *gmrf, gmrf_iface_t *iface) {
|
|
return iface->address;
|
|
}
|
|
|
|
const char* gmrf_iface_get_name(gmrf_t *gmrf, gmrf_iface_t *iface) {
|
|
return iface->name.c_str();
|
|
}
|
|
|
|
size_t gmrf_iface_get_mtu(gmrf_t *gmrf, gmrf_iface_t *iface) {
|
|
auto net = iface->net.lock();
|
|
if (!net)
|
|
return 0;
|
|
|
|
return net->mtu;
|
|
}
|
|
|
|
bool gmrf_iface_send(gmrf_t *gmrf, gmrf_iface_t *iface, const void *data, size_t len, const gmrf_addr_t *dest) {
|
|
auto src_iface = iface->iface.lock();
|
|
assert(src_iface);
|
|
|
|
auto net = src_iface->net.lock();
|
|
if (!net)
|
|
return false;
|
|
|
|
for (auto dest_iface : net->interfaces) {
|
|
if (gmrf_addr_equal(&dest_iface->address, dest)) {
|
|
MMSS::enqueue(gmrf->mmss, src_iface, dest_iface, data, len);
|
|
break;
|
|
}
|
|
}
|
|
|
|
return true;
|
|
}
|
|
|
|
bool gmrf_iface_send_bc(gmrf_t *gmrf, gmrf_iface_t *iface, const void *data, size_t len) {
|
|
auto src_iface = iface->iface.lock();
|
|
assert(src_iface);
|
|
|
|
auto net = src_iface->net.lock();
|
|
if (!net)
|
|
return false;
|
|
|
|
for (auto dest_iface : net->interfaces) {
|
|
if (dest_iface != src_iface)
|
|
MMSS::enqueue(gmrf->mmss, src_iface, dest_iface, data, len);
|
|
}
|
|
|
|
return true;
|
|
}
|
|
|
|
void gmrf_schedule(gmrf_t *gmrf, gmrf_scheduled_func f, void *arg, unsigned delay) {
|
|
auto node = gmrf->node.lock();
|
|
assert(node);
|
|
|
|
std::shared_ptr<MMSS::scheduled_t> scheduled = std::make_shared<MMSS::scheduled_t>();
|
|
|
|
scheduled->node = std::move(node);
|
|
scheduled->f = f;
|
|
scheduled->arg = arg;
|
|
|
|
gmrf->mmss->scheduled_queue.put(std::move(scheduled), gmrf->mmss->now()+delay);
|
|
}
|
|
|
|
gmrf_time_t gmrf_now(gmrf_t *gmrf) {
|
|
return gmrf->mmss->now();
|
|
}
|
|
|
|
void gmrf_random_bytes(gmrf_t *gmrf, void *buffer, size_t len) {
|
|
uint8_t *data = reinterpret_cast<uint8_t*>(buffer);
|
|
|
|
size_t i;
|
|
for (i = 0; i < len; i++)
|
|
data[i] = rand_r(&gmrf->rand_seed);
|
|
}
|
|
|
|
static inline const char* get_log_prefix(int log_level) {
|
|
switch(log_level) {
|
|
case LOG_CRIT:
|
|
return "Fatal: ";
|
|
case LOG_ERR:
|
|
return "Error: ";
|
|
case LOG_WARNING:
|
|
return "Warning: ";
|
|
case LOG_NOTICE:
|
|
return "Info: ";
|
|
case LOG_INFO:
|
|
return "Verbose: ";
|
|
case LOG_DEBUG:
|
|
return "DEBUG: ";
|
|
default:
|
|
return "";
|
|
}
|
|
}
|
|
|
|
void gmrf_logf(gmrf_t *gmrf, int priority, const char *format, ...) {
|
|
char buf[1024];
|
|
size_t pos = 0;
|
|
|
|
pos += MMSS::snprintf_safe(buf, sizeof(buf), "%s: %s", gmrf->name.c_str(), get_log_prefix(priority));
|
|
|
|
va_list ap;
|
|
va_start(ap, format);
|
|
vsnprintf(buf+pos, sizeof(buf)-pos, format, ap);
|
|
va_end(ap);
|
|
|
|
MMSS::logf(gmrf->mmss, priority, "%s", buf);
|
|
}
|
|
|
|
}
|