static void
pcap_dispatch_cb (u_char *u_handle,
const struct pcap_pkthdr *header,
const u_char *packet)
{
NAPCapHandle *handle = (NAPCapHandle *)u_handle;
switch (handle->linktype)
{
case (DLT_EN10MB):
parse_ethernet (header, packet);
break;
case (DLT_PPP):
parse_ppp (header, packet);
break;
case (DLT_LINUX_SLL):
parse_linux_cooked (header, packet);
break;
case (DLT_RAW):
case (DLT_NULL):
// hope for the best
parse_ip (header, packet);
break;
default:
g_debug ("Unknown linktype %d", handle->linktype);
break;
}
}
static int interp_mac2str(struct ulogd_pluginstance *pi)
{
struct ulogd_key *ret = pi->output.keys;
struct ulogd_key *inp = pi->input.keys;
u_int16_t type = 0;
if (pp_is_valid(inp, KEY_OOB_PROTOCOL))
okey_set_u16(&ret[KEY_MAC_PROTOCOL],
ikey_get_u16(&inp[KEY_OOB_PROTOCOL]));
if (pp_is_valid(inp, KEY_RAW_MAC_SADDR)) {
int fret;
if (! pp_is_valid(inp, KEY_RAW_MAC_ADDRLEN))
return ULOGD_IRET_ERR;
fret = parse_mac2str(ret,
ikey_get_ptr(&inp[KEY_RAW_MAC_SADDR]),
KEY_MAC_SADDR,
ikey_get_u16(&inp[KEY_RAW_MAC_ADDRLEN]));
if (fret != ULOGD_IRET_OK)
return fret;
/* set MAC type to unknown */
okey_set_u16(&ret[KEY_MAC_TYPE], ARPHRD_VOID);
}
if (pp_is_valid(inp, KEY_RAW_MAC)) {
if (! pp_is_valid(inp, KEY_RAW_MACLEN))
return ULOGD_IRET_ERR;
if (pp_is_valid(inp, KEY_RAW_TYPE)) {
/* NFLOG with Linux >= 2.6.27 case */
type = ikey_get_u16(&inp[KEY_RAW_TYPE]);
} else {
/* ULOG case, treat ethernet encapsulation */
if (ikey_get_u16(&inp[KEY_RAW_MACLEN]) == ETH_HLEN)
type = ARPHRD_ETHER;
else
type = ARPHRD_VOID;
}
okey_set_u16(&ret[KEY_MAC_TYPE], type);
}
switch (type) {
case ARPHRD_ETHER:
parse_ethernet(ret, inp);
default:
if (!pp_is_valid(inp, KEY_RAW_MAC))
return ULOGD_IRET_OK;
/* convert raw header to string */
return parse_mac2str(ret,
ikey_get_ptr(&inp[KEY_RAW_MAC]),
KEY_MAC_ADDR,
ikey_get_u16(&inp[KEY_RAW_MACLEN]));
}
return ULOGD_IRET_OK;
}
static int
paxos_rx_process(struct rte_mbuf *pkt, struct proposer* proposer)
{
int ret = 0;
uint8_t l4_proto = 0;
uint16_t outer_header_len;
union tunnel_offload_info info = { .data = 0 };
struct udp_hdr *udp_hdr;
struct paxos_hdr *paxos_hdr;
struct ether_hdr *phdr = rte_pktmbuf_mtod(pkt, struct ether_hdr *);
parse_ethernet(phdr, &info, &l4_proto);
if (l4_proto != IPPROTO_UDP)
return -1;
udp_hdr = (struct udp_hdr *)((char *)phdr +
info.outer_l2_len + info.outer_l3_len);
/* if UDP dst port is not either PROPOSER or LEARNER port */
if (!(udp_hdr->dst_port == rte_cpu_to_be_16(PROPOSER_PORT) ||
udp_hdr->dst_port == rte_cpu_to_be_16(LEARNER_PORT)) &&
(pkt->packet_type & RTE_PTYPE_TUNNEL_MASK) == 0)
return -1;
paxos_hdr = (struct paxos_hdr *)((char *)udp_hdr + sizeof(struct udp_hdr));
if (rte_get_log_level() == RTE_LOG_DEBUG) {
//rte_hexdump(stdout, "udp", udp_hdr, sizeof(struct udp_hdr));
//rte_hexdump(stdout, "paxos", paxos_hdr, sizeof(struct paxos_hdr));
print_paxos_hdr(paxos_hdr);
}
int value_len = rte_be_to_cpu_16(paxos_hdr->value_len);
struct paxos_value *v = paxos_value_new((char *)paxos_hdr->paxosval, value_len);
switch(rte_be_to_cpu_16(paxos_hdr->msgtype)) {
case PAXOS_PROMISE: {
struct paxos_promise promise = {
.iid = rte_be_to_cpu_32(paxos_hdr->inst),
.ballot = rte_be_to_cpu_16(paxos_hdr->rnd),
.value_ballot = rte_be_to_cpu_16(paxos_hdr->vrnd),
.aid = rte_be_to_cpu_16(paxos_hdr->acptid),
.value = *v
};
proposer_handle_promise(proposer, &promise);
break;
}
case PAXOS_ACCEPT: {
if (first_time) {
proposer_preexecute(proposer);
first_time = false;
}
struct paxos_accept acpt = {
.iid = rte_be_to_cpu_32(paxos_hdr->inst),
.ballot = rte_be_to_cpu_16(paxos_hdr->rnd),
.value_ballot = rte_be_to_cpu_16(paxos_hdr->vrnd),
.aid = rte_be_to_cpu_16(paxos_hdr->acptid),
.value = *v
};
proposer_handle_accept(proposer, &acpt);
break;
}
case PAXOS_ACCEPTED: {
struct paxos_accepted ack = {
.iid = rte_be_to_cpu_32(paxos_hdr->inst),
.ballot = rte_be_to_cpu_16(paxos_hdr->rnd),
.value_ballot = rte_be_to_cpu_16(paxos_hdr->vrnd),
.aid = rte_be_to_cpu_16(paxos_hdr->acptid),
.value = *v
};
proposer_handle_accepted(proposer, &ack);
break;
}
default:
break;
}
outer_header_len = info.outer_l2_len + info.outer_l3_len
+ sizeof(struct udp_hdr) + sizeof(struct paxos_hdr);
rte_pktmbuf_adj(pkt, outer_header_len);
return ret;
}
static uint16_t
add_timestamps(uint8_t port __rte_unused, uint16_t qidx __rte_unused,
struct rte_mbuf **pkts, uint16_t nb_pkts,
uint16_t max_pkts __rte_unused, void *user_param)
{
struct proposer* proposer = (struct proposer *)user_param;
unsigned i;
uint64_t now = rte_rdtsc();
for (i = 0; i < nb_pkts; i++) {
pkts[i]->udata64 = now;
paxos_rx_process(pkts[i], proposer);
}
return nb_pkts;
}
static inline int
port_init(uint8_t port, struct rte_mempool *mbuf_pool, struct proposer* proposer)
{
struct rte_eth_dev_info dev_info;
struct rte_eth_txconf *txconf;
struct rte_eth_rxconf *rxconf;
struct rte_eth_conf port_conf = port_conf_default;
const uint16_t rx_rings = 1, tx_rings = 1;
int retval;
uint16_t q;
rte_eth_dev_info_get(port, &dev_info);
rxconf = &dev_info.default_rxconf;
txconf = &dev_info.default_txconf;
txconf->txq_flags &= PKT_TX_IPV4;
txconf->txq_flags &= PKT_TX_UDP_CKSUM;
if (port >= rte_eth_dev_count())
return -1;
retval = rte_eth_dev_configure(port, rx_rings, tx_rings, &port_conf);
if (retval != 0)
return retval;
for (q = 0; q < rx_rings; q++) {
retval = rte_eth_rx_queue_setup(port, q, RX_RING_SIZE,
rte_eth_dev_socket_id(port), rxconf, mbuf_pool);
if (retval < 0)
return retval;
}
for (q = 0; q < tx_rings; q++) {
retval = rte_eth_tx_queue_setup(port, q, TX_RING_SIZE,
rte_eth_dev_socket_id(port), txconf);
if (retval < 0)
return retval;
}
retval = rte_eth_dev_start(port);
if (retval < 0)
return retval;
struct ether_addr addr;
rte_eth_macaddr_get(port, &addr);
rte_eth_promiscuous_enable(port);
rte_eth_add_rx_callback(port, 0, add_timestamps, proposer);
rte_eth_add_tx_callback(port, 0, calc_latency, NULL);
return 0;
}
static void
lcore_main(uint8_t port, __rte_unused struct proposer *p)
{
proposer_preexecute(p);
for (;;) {
// Check if signal is received
if (force_quit)
break;
struct rte_mbuf *bufs[BURST_SIZE];
const uint16_t nb_rx = rte_eth_rx_burst(port, 0, bufs, BURST_SIZE);
if (unlikely(nb_rx == 0))
continue;
uint16_t buf;
for (buf = 0; buf < nb_rx; buf++)
rte_pktmbuf_free(bufs[buf]);
}
}
static __attribute__((noreturn)) int
lcore_mainloop(__attribute__((unused)) void *arg)
{
uint64_t prev_tsc = 0, cur_tsc, diff_tsc;
unsigned lcore_id;
lcore_id = rte_lcore_id();
rte_log(RTE_LOG_DEBUG, RTE_LOGTYPE_TIMER,
"Starting mainloop on core %u\n", lcore_id);
while(1) {
cur_tsc = rte_rdtsc();
diff_tsc = cur_tsc - prev_tsc;
if (diff_tsc > TIMER_RESOLUTION_CYCLES) {
rte_timer_manage();
prev_tsc = cur_tsc;
}
}
}
static void
report_stat(struct rte_timer *tim, __attribute((unused)) void *arg)
{
/* print stat */
uint32_t count = rte_atomic32_read(&stat);
rte_log(RTE_LOG_INFO, RTE_LOGTYPE_USER8,
"Throughput = %8u msg/s\n", count);
/* reset stat */
rte_atomic32_set(&stat, 0);
/* this timer is automatically reloaded until we decide to stop it */
if (force_quit)
rte_timer_stop(tim);
}
static void
check_timeout(struct rte_timer *tim, void *arg)
{
struct proposer* p = (struct proposer *) arg;
unsigned lcore_id = rte_lcore_id();
rte_log(RTE_LOG_DEBUG, RTE_LOGTYPE_USER8, "%s() on lcore_id %i\n", __func__, lcore_id);
struct paxos_message out;
out.type = PAXOS_PREPARE;
struct timeout_iterator* iter = proposer_timeout_iterator(p);
while(timeout_iterator_prepare(iter, &out.u.prepare)) {
rte_log(RTE_LOG_DEBUG, RTE_LOGTYPE_USER8,
"%s Send PREPARE inst %d ballot %d\n",
__func__, out.u.prepare.iid, out.u.prepare.ballot);
send_paxos_message(&out);
}
out.type = PAXOS_ACCEPT;
while(timeout_iterator_accept(iter, &out.u.accept)) {
rte_log(RTE_LOG_DEBUG, RTE_LOGTYPE_USER8,
"%s: Send ACCEPT inst %d ballot %d\n",
__func__, out.u.prepare.iid, out.u.prepare.ballot);
send_paxos_message(&out);
}
timeout_iterator_free(iter);
/* this timer is automatically reloaded until we decide to stop it */
if (force_quit)
rte_timer_stop(tim);
}
int
main(int argc, char *argv[])
{
uint8_t portid = 0;
unsigned master_core, lcore_id;
signal(SIGTERM, signal_handler);
signal(SIGINT, signal_handler);
force_quit = false;
int proposer_id = 0;
if (rte_get_log_level() == RTE_LOG_DEBUG) {
paxos_config.verbosity = PAXOS_LOG_DEBUG;
}
struct proposer *proposer = proposer_new(proposer_id, NUM_ACCEPTORS);
first_time = true;
/* init EAL */
int ret = rte_eal_init(argc, argv);
if (ret < 0)
rte_exit(EXIT_FAILURE, "Error with EAL initialization\n");
/* init timer structure */
rte_timer_init(&timer);
rte_timer_init(&stat_timer);
/* load deliver_timer, every 1 s, on a slave lcore, reloaded automatically */
uint64_t hz = rte_get_timer_hz();
/* Call rte_timer_manage every 10ms */
TIMER_RESOLUTION_CYCLES = hz / 100;
rte_log(RTE_LOG_INFO, RTE_LOGTYPE_USER1, "Clock: %"PRIu64"\n", hz);
/* master core */
master_core = rte_lcore_id();
/* slave core */
lcore_id = rte_get_next_lcore(master_core, 0, 1);
rte_log(RTE_LOG_DEBUG, RTE_LOGTYPE_USER1, "lcore_id: %d\n", lcore_id);
rte_timer_reset(&timer, hz, PERIODICAL, lcore_id, check_timeout, proposer);
/* reset timer */
rte_eal_remote_launch(lcore_mainloop, NULL, lcore_id);
/* stat core */
lcore_id = rte_get_next_lcore(lcore_id , 0, 1);
rte_log(RTE_LOG_DEBUG, RTE_LOGTYPE_USER1, "lcore_id: %d\n", lcore_id);
rte_timer_reset(&stat_timer, hz, PERIODICAL, lcore_id,
report_stat, NULL);
/* init RTE timer library */
rte_timer_subsystem_init();
mbuf_pool = rte_pktmbuf_pool_create("MBUF_POOL",
NUM_MBUFS, MBUF_CACHE_SIZE, 0,
RTE_MBUF_DEFAULT_BUF_SIZE, rte_socket_id());
if (mbuf_pool == NULL)
rte_exit(EXIT_FAILURE, "Cannot create mbuf_pool\n");
/* reset timer */
rte_eal_remote_launch(lcore_mainloop, NULL, lcore_id);
if (port_init(portid, mbuf_pool, proposer) != 0)
rte_exit(EXIT_FAILURE, "Cannot init port %"PRIu8"\n", portid);
lcore_main(portid, proposer);
rte_log(RTE_LOG_DEBUG, RTE_LOGTYPE_USER8, "Free proposer\n");
proposer_free(proposer);
return 0;
}
static bool update_service_property(DBusMessageIter *arg, void *user_data)
{
struct connman_service *service = user_data;
const char *name, *value;
gboolean boolean_value;
char **array;
int length;
if (cui_dbus_get_basic(arg, DBUS_TYPE_STRING, &name) != 0)
return FALSE;
dbus_message_iter_next(arg);
if (g_strcmp0(name, "Name") == 0) {
cui_dbus_get_basic_variant(arg, DBUS_TYPE_STRING, &value);
service->name = g_strdup(value);
} else if (g_strcmp0(name, "Type") == 0) {
cui_dbus_get_basic_variant(arg, DBUS_TYPE_STRING, &value);
service->type = g_strdup(value);
} else if (g_strcmp0(name, "Security") == 0) {
cui_dbus_get_array(arg, DBUS_TYPE_STRING, &length, &array);
g_free(service->security);
if (array != NULL) {
service->security = g_strjoinv(";", array);
g_free(array);
} else
service->security = NULL;
} else if (g_strcmp0(name, "Immutable") == 0) {
cui_dbus_get_basic_variant(arg,
DBUS_TYPE_BOOLEAN, &boolean_value);
service->immutable = boolean_value;
} else if (g_strcmp0(name, PROPERTY(SERVICE_STATE)) == 0) {
cui_dbus_get_basic_variant(arg, DBUS_TYPE_STRING, &value);
service->state = string2enum_state(value);
service->update_index = SERVICE_STATE;
} else if (g_strcmp0(name, PROPERTY(SERVICE_ERROR)) == 0) {
cui_dbus_get_basic_variant(arg, DBUS_TYPE_STRING, &value);
g_free(service->error);
service->error = g_strdup(value);
service->update_index = SERVICE_ERROR;
} else if (g_strcmp0(name, PROPERTY(SERVICE_STRENGTH)) == 0) {
uint8_t uint8_value;
cui_dbus_get_basic_variant(arg, DBUS_TYPE_BYTE, &uint8_value);
service->strength = uint8_value;
service->update_index = SERVICE_STRENGTH;
} else if (g_strcmp0(name, PROPERTY(SERVICE_FAVORITE)) == 0) {
cui_dbus_get_basic_variant(arg,
DBUS_TYPE_BOOLEAN, &boolean_value);
service->favorite = boolean_value;
service->update_index = SERVICE_FAVORITE;
} else if (g_strcmp0(name, PROPERTY(SERVICE_AUTOCONNECT)) == 0) {
cui_dbus_get_basic_variant(arg,
DBUS_TYPE_BOOLEAN, &boolean_value);
service->autoconnect = boolean_value;
service->update_index = SERVICE_AUTOCONNECT;
} else if (g_strcmp0(name, PROPERTY(SERVICE_ROAMING)) == 0) {
cui_dbus_get_basic_variant(arg,
DBUS_TYPE_BOOLEAN, &boolean_value);
service->roaming = boolean_value;
service->update_index = SERVICE_ROAMING;
} else if (g_strcmp0(name, PROPERTY(SERVICE_NAMESERVERS)) == 0) {
cui_dbus_get_array(arg, DBUS_TYPE_STRING, &length, &array);
g_free(service->nameservers);
if (array != NULL) {
service->nameservers = g_strjoinv(";", array);
g_free(array);
} else
service->nameservers = NULL;
service->update_index = SERVICE_NAMESERVERS;
} else if (g_strcmp0(name,
PROPERTY(SERVICE_NAMESERVERS_CONFIGURATION)) == 0) {
cui_dbus_get_array(arg, DBUS_TYPE_STRING, &length, &array);
g_free(service->nameservers_conf);
if (array != NULL) {
service->nameservers_conf = g_strjoinv(";", array);
g_free(array);
} else
service->nameservers_conf = NULL;
service->update_index = SERVICE_NAMESERVERS_CONFIGURATION;
} else if (g_strcmp0(name, PROPERTY(SERVICE_DOMAINS)) == 0) {
cui_dbus_get_array(arg, DBUS_TYPE_STRING, &length, &array);
g_free(service->domains);
if (array != NULL) {
service->domains = g_strjoinv(";", array);
g_free(array);
} else
service->domains = NULL;
service->update_index = SERVICE_DOMAINS;
} else if (g_strcmp0(name,
PROPERTY(SERVICE_DOMAINS_CONFIGURATION)) == 0) {
cui_dbus_get_array(arg, DBUS_TYPE_STRING, &length, &array);
g_free(service->domains_conf);
if (array != NULL) {
service->domains_conf = g_strjoinv(";", array);
g_free(array);
} else
service->domains_conf = NULL;
service->update_index = SERVICE_DOMAINS_CONFIGURATION;
} else if (g_strcmp0(name, PROPERTY(SERVICE_TIMESERVERS)) == 0) {
cui_dbus_get_array(arg, DBUS_TYPE_STRING, &length, &array);
g_free(service->timeservers);
if (array != NULL) {
service->timeservers = g_strjoinv(";", array);
g_free(array);
} else
service->timeservers = NULL;
service->update_index = SERVICE_TIMESERVERS;
} else if (g_strcmp0(name,
PROPERTY(SERVICE_TIMESERVERS_CONFIGURATION)) == 0) {
cui_dbus_get_array(arg, DBUS_TYPE_STRING, &length, &array);
g_free(service->timeservers_conf);
if (array != NULL) {
service->timeservers_conf = g_strjoinv(";", array);
g_free(array);
} else
service->timeservers_conf = NULL;
service->update_index = SERVICE_TIMESERVERS_CONFIGURATION;
} else if (g_strcmp0(name, PROPERTY(SERVICE_IPv4)) == 0) {
service->ipv4 = parse_ipv4(arg, service->ipv4);
service->update_index = SERVICE_IPv4;
} else if (g_strcmp0(name,
PROPERTY(SERVICE_IPv4_CONFIGURATION)) == 0) {
service->ipv4_conf = parse_ipv4(arg, service->ipv4_conf);
service->update_index = SERVICE_IPv4_CONFIGURATION;
} else if (g_strcmp0(name, PROPERTY(SERVICE_IPv6)) == 0) {
service->ipv6 = parse_ipv6(arg, service->ipv6);
service->update_index = SERVICE_IPv6;
} else if (g_strcmp0(name,
PROPERTY(SERVICE_IPv6_CONFIGURATION)) == 0) {
service->ipv6_conf = parse_ipv6(arg, service->ipv6_conf);
service->update_index = SERVICE_IPv6_CONFIGURATION;
} else if (g_strcmp0(name, PROPERTY(SERVICE_PROXY)) == 0) {
service->proxy = parse_proxy(arg, service->proxy);
service->update_index = SERVICE_PROXY;
} else if (g_strcmp0(name,
PROPERTY(SERVICE_PROXY_CONFIGURATION)) == 0) {
service->proxy_conf = parse_proxy(arg, service->proxy_conf);
service->update_index = SERVICE_PROXY_CONFIGURATION;
} else if (g_strcmp0(name, PROPERTY(SERVICE_PROVIDER)) == 0) {
service->provider = parse_provider(arg, service->provider);
service->update_index = SERVICE_PROVIDER;
} else if (g_strcmp0(name, PROPERTY(SERVICE_ETHERNET)) == 0) {
service->ethernet = parse_ethernet(arg, service->ethernet);
service->update_index = SERVICE_ETHERNET;
}
return FALSE;
}
