network.c

/* horst - Highly Optimized Radio Scanning Tool
 *
 * Copyright (C) 2005-2016 Bruno Randolf (br1@einfach.org)
 *
 * This program is free software; you can redistribute it and/or
 * modify it under the terms of the GNU General Public License
 * as published by the Free Software Foundation; either version 2
 * of the License, or (at your option) any later version.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software Foundation,
 * Inc., 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301, USA.
 */

#include <stdio.h>
#include <stdlib.h>
#include <unistd.h>
#include <stdint.h>
#include <endian.h>
#include <string.h>
#include <sys/socket.h>
#include <netinet/in.h>
#include <netdb.h>
#include <errno.h>
#include <err.h>

#include <uwifi/util.h>
#include <uwifi/channel.h>
#include <uwifi/log.h>

#include "main.h"
#include "network.h"
#include "display.h"

extern struct config conf;

int srv_fd = -1;
int cli_fd = -1;
static int netmon_fd;

#define PROTO_VERSION	4

enum pkt_type {
	PROTO_PKT_INFO		= 0,
	PROTO_CHAN_LIST		= 1,
	PROTO_CONF_CHAN		= 2,
	PROTO_CONF_FILTER	= 3,
};

struct net_header {
	unsigned char version;
	unsigned char type;
} __attribute__ ((packed));

struct net_conf_chan {
	struct net_header	proto;

	unsigned char do_change;
	unsigned char upper;
	int dwell_time;

	/* channel */
	unsigned int freq;
	unsigned int center_freq;
	unsigned char width;

} __attribute__ ((packed));

struct net_conf_filter {
	struct net_header	proto;

	unsigned char	filtermac[MAX_FILTERMAC][WLAN_MAC_LEN];
	char		filtermac_enabled[MAX_FILTERMAC];
	unsigned char	filterbssid[WLAN_MAC_LEN];
	uint16_t	filter_stype[WLAN_NUM_TYPES];
	int		filter_pkt;
	int		filter_mode;

#define NET_FILTER_OFF		0x01
#define NET_FILTER_BADFCS	0x02
	unsigned char	filter_flags;
} __attribute__ ((packed));

struct net_band {
	unsigned char num_chans;
	unsigned char max_width;
	unsigned char streams_rx;
	unsigned char streams_tx;
} __attribute__ ((packed));

struct net_chan_list {
	struct net_header	proto;

	unsigned char num_bands;
	struct net_band band[2];	// always send both
	unsigned int freq[1];
} __attribute__ ((packed));

#define PKT_INFO_VERSION	2

struct net_packet_info {
	struct net_header	proto;

	unsigned char		version;

	/* general */
	unsigned int		pkt_types;	/* bitmask of packet types */

	/* wlan phy (from radiotap) */
	int			phy_signal;	/* signal strength (usually dBm) */
	unsigned int		phy_rate;	/* physical rate * 10 (= in 100kbps) */
	unsigned char		phy_rate_idx;
	unsigned char		phy_rate_flags;
	unsigned int		phy_freq;	/* frequency */
	unsigned int		phy_flags;	/* A, B, G, shortpre */

	/* wlan mac */
	unsigned int		wlan_len;	/* packet length */
	unsigned int		wlan_type;	/* frame control field */
	unsigned char		wlan_ta[WLAN_MAC_LEN];
	unsigned char		wlan_ra[WLAN_MAC_LEN];
	unsigned char		wlan_bssid[WLAN_MAC_LEN];
	char			wlan_essid[WLAN_MAX_SSID_LEN];
	uint64_t		wlan_tsf;	/* timestamp from beacon */
	unsigned int		wlan_bintval;	/* beacon interval */
	unsigned int		wlan_mode;	/* AP, STA or IBSS */
	unsigned char		wlan_channel;	/* channel from beacon, probe */
	unsigned char		wlan_chan_width;
	unsigned char		wlan_tx_streams;
	unsigned char		wlan_rx_streams;
	unsigned char		wlan_qos_class;	/* for QDATA frames */
	unsigned int		wlan_nav;	/* frame NAV duration */
	unsigned int		wlan_seqno;	/* sequence number */

#define PKT_WLAN_FLAG_WEP	0x01
#define PKT_WLAN_FLAG_RETRY	0x02
#define PKT_WLAN_FLAG_WPA	0x04
#define PKT_WLAN_FLAG_RSN	0x08
#define PKT_WLAN_FLAG_HT40PLUS	0x10

	/* bitfields are not portable - endianness is not guaranteed */
	unsigned int		wlan_flags;

	/* IP */
	unsigned int		ip_src;
	unsigned int		ip_dst;
	unsigned int		tcpudp_port;
	unsigned int		olsr_type;
	unsigned int		olsr_neigh;
	unsigned int		olsr_tc;

#define PKT_BAT_FLAG_GW		0x1
	unsigned char		bat_flags;
	unsigned char		bat_pkt_type;
} __attribute__ ((packed));

static bool net_write(int fd, unsigned char* buf, size_t len)
{
	int ret;
	ret = write(fd, buf, len);
	if (ret == -1) {
		if (errno == EPIPE) {
			LOG_INF("Client has closed");
			close(fd);
			if (fd == cli_fd)
				cli_fd = -1;
			net_init_server_socket(conf.port);
		}
		else
			LOG_ERR("ERROR: in net_write");
		return false;
	}
	return true;
}

void net_send_packet(struct uwifi_packet *p)
{
	struct net_packet_info np;

	np.proto.version = PROTO_VERSION;
	np.proto.type	= PROTO_PKT_INFO;

	np.version	= PKT_INFO_VERSION;
	np.pkt_types	= htole32(p->pkt_types);
	np.phy_signal	= htole32(p->phy_signal);
	np.phy_rate	= htole32(p->phy_rate);
	np.phy_rate_idx	= p->phy_rate_idx;
	np.phy_rate_flags = p->phy_rate_flags;
	np.phy_freq	= htole32(p->phy_freq);
	np.phy_flags	= htole32(p->phy_flags);
	np.wlan_len	= htole32(p->wlan_len);
	np.wlan_type	= htole32(p->wlan_type);
	memcpy(np.wlan_ta, p->wlan_ta, WLAN_MAC_LEN);
	memcpy(np.wlan_ra, p->wlan_ra, WLAN_MAC_LEN);
	memcpy(np.wlan_bssid, p->wlan_bssid, WLAN_MAC_LEN);
	memcpy(np.wlan_essid, p->wlan_essid, WLAN_MAX_SSID_LEN);
	np.wlan_tsf	= htole64(p->wlan_tsf);
	np.wlan_bintval	= htole32(p->wlan_bintval);
	np.wlan_mode	= htole32(p->wlan_mode);
	np.wlan_channel = p->wlan_channel;
	np.wlan_chan_width = p->wlan_chan_width;
	np.wlan_tx_streams = p->wlan_tx_streams;
	np.wlan_rx_streams = p->wlan_rx_streams;
	np.wlan_qos_class = p->wlan_qos_class;
	np.wlan_nav	= htole32(p->wlan_nav);
	np.wlan_seqno	= htole32(p->wlan_seqno);
	np.wlan_flags = 0;
	if (p->wlan_wep)
		np.wlan_flags |= PKT_WLAN_FLAG_WEP;
	if (p->wlan_retry)
		np.wlan_flags |= PKT_WLAN_FLAG_RETRY;
	if (p->wlan_wpa)
		np.wlan_flags |= PKT_WLAN_FLAG_WPA;
	if (p->wlan_rsn)
		np.wlan_flags |= PKT_WLAN_FLAG_RSN;
	if (p->wlan_ht40plus)
		np.wlan_flags |= PKT_WLAN_FLAG_HT40PLUS;
	np.wlan_flags	= htole32(np.wlan_flags);
	np.ip_src	= p->ip_src;
	np.ip_dst	= p->ip_dst;
	np.tcpudp_port	= htole32(p->tcpudp_port);
	np.olsr_type	= htole32(p->olsr_type);
	np.olsr_neigh	= htole32(p->olsr_neigh);
	np.olsr_tc	= htole32(p->olsr_tc);
	np.bat_flags = 0;
	if (p->bat_gw)
		np.bat_flags |= PKT_BAT_FLAG_GW;
	np.bat_pkt_type = p->bat_packet_type;

	net_write(cli_fd, (unsigned char *)&np, sizeof(np));
}

static int net_receive_packet(unsigned char *buffer, size_t len)
{
	struct net_packet_info *np;
	struct uwifi_packet p;

	if (len < sizeof(struct net_packet_info))
		return 0;

	np = (struct net_packet_info *)buffer;

	if (np->phy_rate == 0)
		return 0;

	if (np->version != PKT_INFO_VERSION)
		return 0;

	memset(&p, 0, sizeof(p));
	p.pkt_types	= le32toh(np->pkt_types);
	p.phy_signal	= le32toh(np->phy_signal);
	p.phy_rate	= le32toh(np->phy_rate);
	p.phy_rate_idx	= np->phy_rate_idx;
	p.phy_rate_flags= np->phy_rate_flags;
	p.phy_freq	= le32toh(np->phy_freq);
	p.phy_flags	= le32toh(np->phy_flags);
	p.wlan_len	= le32toh(np->wlan_len);
	p.wlan_type	= le32toh(np->wlan_type);
	memcpy(p.wlan_ta, np->wlan_ta, WLAN_MAC_LEN);
	memcpy(p.wlan_ra, np->wlan_ra, WLAN_MAC_LEN);
	memcpy(p.wlan_bssid, np->wlan_bssid, WLAN_MAC_LEN);
	memcpy(p.wlan_essid, np->wlan_essid, WLAN_MAX_SSID_LEN);
	p.wlan_tsf	= le64toh(np->wlan_tsf);
	p.wlan_bintval	= le32toh(np->wlan_bintval);
	p.wlan_mode	= le32toh(np->wlan_mode);
	p.wlan_channel	= np->wlan_channel;
	p.wlan_chan_width = np->wlan_chan_width;
	p.wlan_tx_streams = np->wlan_tx_streams;
	p.wlan_rx_streams = np->wlan_rx_streams;
	p.wlan_qos_class = np->wlan_qos_class;
	p.wlan_nav	= le32toh(np->wlan_nav);
	p.wlan_seqno	= le32toh(np->wlan_seqno);
	np->wlan_flags	= le32toh(np->wlan_flags);
	if (np->wlan_flags & PKT_WLAN_FLAG_WEP)
		p.wlan_wep = 1;
	if (np->wlan_flags & PKT_WLAN_FLAG_RETRY)
		p.wlan_retry = 1;
	if (np->wlan_flags & PKT_WLAN_FLAG_WPA)
		p.wlan_wpa = 1;
	if (np->wlan_flags & PKT_WLAN_FLAG_RSN)
		p.wlan_rsn = 1;
	if (np->wlan_flags & PKT_WLAN_FLAG_HT40PLUS)
		p.wlan_ht40plus = 1;
	p.ip_src	= np->ip_src;
	p.ip_dst	= np->ip_dst;
	p.tcpudp_port	= le32toh(np->tcpudp_port);
	p.olsr_type	= le32toh(np->olsr_type);
	p.olsr_neigh	= le32toh(np->olsr_neigh);
	p.olsr_tc	= le32toh(np->olsr_tc);
	if (np->bat_flags & PKT_BAT_FLAG_GW)
		p.bat_gw = 1;
	p.bat_packet_type = np->bat_pkt_type;

	handle_packet(&p);

	return sizeof(struct net_packet_info);
}

static void net_send_conf_chan(int fd)
{
	struct net_conf_chan nc;

	nc.proto.version = PROTO_VERSION;
	nc.proto.type	= PROTO_CONF_CHAN;
	nc.do_change = conf.intf.channel_scan;
	nc.upper = conf.intf.channel_max;
	nc.dwell_time = htole32(conf.intf.channel_time);

	nc.freq = conf.intf.channel.freq;
	nc.center_freq = conf.intf.channel.center_freq;
	nc.width = conf.intf.channel.width;

	net_write(fd, (unsigned char *)&nc, sizeof(nc));
}

static int net_receive_conf_chan(unsigned char *buffer, size_t len)
{
	struct net_conf_chan *nc;

	if (len < sizeof(struct net_conf_chan))
		return 0;

	nc = (struct net_conf_chan *)buffer;
	conf.intf.channel_scan = nc->do_change;
	conf.intf.channel_max = nc->upper;
	conf.intf.channel_time = le32toh(nc->dwell_time);

	struct uwifi_chan_spec ch;
	ch.freq = nc->freq;
	ch.center_freq = nc->center_freq;
	ch.width = nc->width;

	if (conf.intf.channel.freq != ch.freq ||
	    conf.intf.channel.center_freq != ch.center_freq ||
	    conf.intf.channel.width != ch.width) { /* something changed */
		if (cli_fd > -1) { /* server */
			if (!uwifi_channel_change(&conf.intf, &ch)) {
				LOG_ERR("Net Channel %s is not available/allowed",
					uwifi_channel_get_string(&ch));
				net_send_channel_config();
			} else {
				/* success: update UI */
				conf.intf.channel_set = ch;
				update_display(NULL);
			}
		} else { /* client */
			conf.intf.channel_idx = uwifi_channel_idx_from_freq(&conf.intf.channels, ch.freq);
			conf.intf.channel = conf.intf.channel_set = ch;
			update_spectrum_durations();
			update_display(NULL);
		}
	}

	return sizeof(struct net_conf_chan);
}

static void net_send_conf_filter(int fd)
{
	struct net_conf_filter nc;
	int i;

	nc.proto.version = PROTO_VERSION;
	nc.proto.type = PROTO_CONF_FILTER;

	for (i = 0; i < MAX_FILTERMAC; i++) {
		memcpy(nc.filtermac[i], conf.filtermac[i], WLAN_MAC_LEN);
		nc.filtermac_enabled[i] = conf.filtermac_enabled[i];
	}

	for (i = 0; i < WLAN_NUM_TYPES; i++) {
		nc.filter_stype[i] = htons(conf.filter_stype[i]);
	}

	memcpy(nc.filterbssid, conf.filterbssid, WLAN_MAC_LEN);
	nc.filter_pkt = htole32(conf.filter_pkt);
	nc.filter_mode = htole32(conf.filter_mode);
	nc.filter_flags = 0;
	if (conf.filter_off)
		nc.filter_flags |= NET_FILTER_OFF;
	if (conf.filter_badfcs)
		nc.filter_flags |= NET_FILTER_BADFCS;

	net_write(fd, (unsigned char *)&nc, sizeof(nc));
}

static int net_receive_conf_filter(unsigned char *buffer, size_t len)
{
	struct net_conf_filter *nc;
	int i;

	if (len < sizeof(struct net_conf_filter))
		return 0;

	nc = (struct net_conf_filter *)buffer;

	for (i = 0; i < MAX_FILTERMAC; i++) {
		memcpy(conf.filtermac[i], nc->filtermac[i], WLAN_MAC_LEN);
		conf.filtermac_enabled[i] = nc->filtermac_enabled[i];
	}

	for (i = 0; i < WLAN_NUM_TYPES; i++) {
		conf.filter_stype[i] = ntohs(nc->filter_stype[i]);
	}

	memcpy(conf.filterbssid, nc->filterbssid, WLAN_MAC_LEN);
	conf.filter_pkt = le32toh(nc->filter_pkt);
	conf.filter_mode = le32toh(nc->filter_mode);
	conf.filter_off = !!(nc->filter_flags & NET_FILTER_OFF);
	conf.filter_badfcs = !!(nc->filter_flags & NET_FILTER_BADFCS);

	return sizeof(struct net_conf_filter);
}

static void net_send_chan_list(int fd)
{
	char* buf;
	struct net_chan_list *nc;
	int i;

	buf = malloc(sizeof(struct net_chan_list) +
		     sizeof(unsigned int) * (uwifi_channel_get_num_channels(&conf.intf.channels) - 1));
	if (buf == NULL)
		return;

	nc = (struct net_chan_list *)buf;
	nc->proto.version = PROTO_VERSION;
	nc->proto.type	= PROTO_CHAN_LIST;

	nc->num_bands = uwifi_channel_get_num_bands(&conf.intf.channels);
	for (i = 0; i < nc->num_bands; i++) {
		const struct uwifi_band* bp = uwifi_channel_get_band(&conf.intf.channels, i);
		nc->band[i].num_chans = bp->num_channels;
		nc->band[i].max_width = bp->max_chan_width;
		nc->band[i].streams_rx = bp->streams_rx;
		nc->band[i].streams_tx = bp->streams_tx;
	}

	for (i = 0; i < uwifi_channel_get_num_channels(&conf.intf.channels); i++) {
		nc->freq[i] = htole32(uwifi_channel_get_freq(&conf.intf.channels, i));
		LOG_DBG("NET send freq %d %d", i, uwifi_channel_get_freq(&conf.intf.channels, i));
	}

	net_write(fd, (unsigned char *)buf, sizeof(struct net_chan_list) +
					    sizeof(unsigned int) * (i - 1));
	free(buf);
}

static int net_receive_chan_list(unsigned char *buffer, size_t len)
{
	struct net_chan_list *nc;
	int num_chans = 0;

	if (len < sizeof(struct net_chan_list))
		return 0;

	nc = (struct net_chan_list *)buffer;

	for (int i = 0; i < nc->num_bands; i++) {
		uwifi_channel_band_add(&conf.intf.channels, nc->band[i].num_chans, nc->band[i].max_width,
				 nc->band[i].streams_rx, nc->band[i].streams_tx);
		num_chans += nc->band[i].num_chans;
	}

	if (len < sizeof(struct net_chan_list) + sizeof(unsigned int) * (num_chans - 1))
		return 0;

	for (int i = 0; i < num_chans; i++) {
		uwifi_channel_list_add(&conf.intf.channels, le32toh(nc->freq[i]));
		LOG_DBG("NET recv freq %d %d", i, le32toh(nc->freq[i]));
	}
	init_spectrum();
	return sizeof(struct net_chan_list) + sizeof(unsigned int) * (num_chans - 1);
}

static int try_receive_packet(unsigned char* buf, size_t len)
{
	struct net_header *nh = (struct net_header *)buf;

	if (nh->version != PROTO_VERSION) {
		LOG_ERR("ERROR: protocol version %x", nh->version);
		return 0;
	}

	switch (nh->type) {
	case PROTO_PKT_INFO:
		len = net_receive_packet(buf, len);
		break;
	case PROTO_CHAN_LIST:
		len = net_receive_chan_list(buf, len);
		break;
	case PROTO_CONF_CHAN:
		len = net_receive_conf_chan(buf, len);
		break;
	case PROTO_CONF_FILTER:
		len = net_receive_conf_filter(buf, len);
		break;
	default:
		LOG_ERR("ERROR: unknown net packet type");
		len = 0;
	}

	return len; /* the number of bytes we have consumed */
}

int net_receive(int fd, unsigned char* buffer, size_t* buflen, size_t maxlen)
{
	int len, consumed = 0;

	len = recv(fd, buffer + *buflen, maxlen - *buflen, MSG_DONTWAIT);

	if (len < 0)
		return 0;

	*buflen += len;

	while (*buflen > sizeof(struct net_header)) {
		len = try_receive_packet(buffer + consumed, *buflen);
		if (len == 0)
			break;
		*buflen -= len;
		consumed += len;
	}
	memmove(buffer, buffer + consumed, *buflen);

	return consumed;
}

void net_handle_server_conn(void)
{
	struct sockaddr_in cin;
	socklen_t cinlen;

	cinlen = sizeof(cin);
	memset(&cin, 0, sizeof(struct sockaddr_in));
	cli_fd = accept(srv_fd, (struct sockaddr*)&cin, &cinlen);

	LOG_INF("Accepting client");

	/* send initial config */
	net_send_chan_list(cli_fd);
	net_send_conf_chan(cli_fd);
	net_send_conf_filter(cli_fd);

	/* we only accept one client, so close server socket */
	close(srv_fd);
	srv_fd = -1;
}

void net_init_server_socket(int rport)
{
	struct sockaddr_in sock_in;
	int reuse = 1;

	LOG_INF("Initializing server port %d", rport);

	memset(&sock_in, 0, sizeof(struct sockaddr_in));
	sock_in.sin_family = AF_INET;
	sock_in.sin_addr.s_addr = htonl(INADDR_ANY);
	sock_in.sin_port = htons(rport);

	if ((srv_fd = socket(AF_INET, SOCK_STREAM, 0)) < 0)
		err(1, "Could not open server socket");

	if (setsockopt(srv_fd, SOL_SOCKET, SO_REUSEADDR, &reuse, sizeof(reuse)) < 0)
		err(1, "setsockopt SO_REUSEADDR");

	if (bind(srv_fd, (struct sockaddr*)&sock_in, sizeof(sock_in)) < 0)
		err(1, "bind");

	if (listen(srv_fd, 0) < 0)
		err(1, "listen");
}

int net_open_client_socket(char* serveraddr, int rport)
{
	struct addrinfo saddr;
	struct addrinfo *result, *rp;
	char rport_str[20];
	int ret;

	snprintf(rport_str, 20, "%d", rport);

	LOG_INF("Connecting to server %s port %s", serveraddr, rport_str);

	/* Obtain address(es) matching host/port */
	memset(&saddr, 0, sizeof(struct addrinfo));
	saddr.ai_family = AF_INET;
	saddr.ai_socktype = SOCK_STREAM;
	saddr.ai_flags = 0;
	saddr.ai_protocol = 0;

	ret = getaddrinfo(serveraddr, rport_str, &saddr, &result);
	if (ret != 0) {
		fprintf(stderr, "Could not resolve: %s\n", gai_strerror(ret));
		exit(EXIT_FAILURE);
	}

	/* getaddrinfo() returns a list of address structures.
	 * Try each address until we successfully connect. */
	for (rp = result; rp != NULL; rp = rp->ai_next) {
		netmon_fd = socket(rp->ai_family, rp->ai_socktype, rp->ai_protocol);
		if (netmon_fd == -1)
			continue;

		if (connect(netmon_fd, rp->ai_addr, rp->ai_addrlen) != -1)
			break; /* Success */

		close(netmon_fd);
	}

	if (rp == NULL) {
		/* No address succeeded */
		freeaddrinfo(result);
		err(1, "Could not connect");
	}

	freeaddrinfo(result);

	LOG_INF("Connected to server %s", serveraddr);
	return netmon_fd;
}

void net_finish(void)
{
	if (srv_fd != -1)
		close(srv_fd);

	if (cli_fd != -1)
		close(cli_fd);

	if (netmon_fd)
		close(netmon_fd);
}

void net_send_channel_config(void)
{
	if (conf.serveraddr[0] != '\0')
		net_send_conf_chan(netmon_fd);
	else if (conf.allow_client && cli_fd > -1)
		net_send_conf_chan(cli_fd);
}

void net_send_filter_config(void)
{
	if (conf.serveraddr[0] != '\0')
		net_send_conf_filter(netmon_fd);
	else if (conf.allow_client && cli_fd > -1)
		net_send_conf_filter(cli_fd);
}