/*
 * netsniff-ng - the packet sniffing beast
 * Copyright 2009, 2010 Daniel Borkmann.
 * Copyright 2014 Tobias Klauser
 * Subject to the GPL, version 2.
 */

#include <stdio.h>
#include <stdint.h>
#include <netinet/in.h>
#include <linux/if_ether.h>

#include "proto.h"
#include "dissector_eth.h"
#include "lookup.h"
#include "pkt_buff.h"
#include "oui.h"

static inline bool is_multicast_ether_addr(const uint8_t *mac)
{
	return mac[0] & 0x01;
}

static inline bool is_broadcast_ether_addr(const uint8_t *mac)
{
	return (mac[0] & mac[1] & mac[2] & mac[3] & mac[4] & mac[5]) == 0xff;
}

static const char *ether_lookup_addr(const uint8_t *mac)
{
	if (is_multicast_ether_addr(mac)) {
		if (is_broadcast_ether_addr(mac))
			return "Broadcast";
		else
			return "Multicast";
	}

	/* found no matching address, so look up the vendor from OUI */
	return lookup_vendor_str((mac[0] << 16) | (mac[1] << 8) | mac[2]);
}

static void ethernet(struct pkt_buff *pkt)
{
	char *type;
	uint8_t *src_mac, *dst_mac;
	struct ethhdr *eth = (struct ethhdr *) pkt_pull(pkt, sizeof(*eth));

	if (eth == NULL)
		return;

	src_mac = eth->h_source;
	dst_mac = eth->h_dest;

	tprintf(" [ Eth ");
	tprintf("MAC (%.2x:%.2x:%.2x:%.2x:%.2x:%.2x => ",
		src_mac[0], src_mac[1], src_mac[2],
		src_mac[3], src_mac[4], src_mac[5]);
	tprintf("%.2x:%.2x:%.2x:%.2x:%.2x:%.2x), ",
		dst_mac[0], dst_mac[1], dst_mac[2],
		dst_mac[3], dst_mac[4], dst_mac[5]);
	tprintf("Proto (0x%.4x", ntohs(eth->h_proto));

	type = lookup_ether_type(ntohs(eth->h_proto));
	if (type)
		tprintf(", %s%s%s", colorize_start(bold), type, colorize_end());

	tprintf(") ]\n");
	tprintf(" [ Vendor ");
	tprintf("(%s => %s)", ether_lookup_addr(src_mac), ether_lookup_addr(dst_mac));
	tprintf(" ]\n");

	pkt_set_dissector(pkt, &eth_lay2, ntohs(eth->h_proto));
}

static void ethernet_less(struct pkt_buff *pkt)
{
	uint8_t *src_mac, *dst_mac;
	struct ethhdr *eth = (struct ethhdr *) pkt_pull(pkt, sizeof(*eth));

	if (eth == NULL)
		return;

	src_mac = eth->h_source;
	dst_mac = eth->h_dest;
	tprintf(" %s => %s ", ether_lookup_addr(src_mac),
		ether_lookup_addr(dst_mac));
	tprintf("%s%s%s", colorize_start(bold),
		lookup_ether_type(ntohs(eth->h_proto)), colorize_end());

	pkt_set_dissector(pkt, &eth_lay2, ntohs(eth->h_proto));
}

struct protocol ethernet_ops = {
	.key = 0,
	.print_full = ethernet,
	.print_less = ethernet_less,
};
7f7ccf'>diff</a></td><td class='form'><form class='right' method='get' action='/cgit.cgi/linux/net-next.git/log/arch/arm/boot/dts/imx28-eukrea-mbmx283lc.dts'>
<input type='hidden' name='h' value='nds-private-remove'/><input type='hidden' name='id' value='5db4992d8f040b8d8db0b86d42806e0c417f7ccf'/><select name='qt'>
<option value='grep'>log msg</option>
<option value='author'>author</option>
<option value='committer'>committer</option>
<option value='range'>range</option>
</select>
<input class='txt' type='search' size='10' name='q' value=''/>
<input type='submit' value='search'/>
</form>
</td></tr></table>
<div class='path'>path: <a href='/cgit.cgi/linux/net-next.git/log/?h=nds-private-remove&amp;id=5db4992d8f040b8d8db0b86d42806e0c417f7ccf'>root</a>/<a href='/cgit.cgi/linux/net-next.git/log/arch?h=nds-private-remove&amp;id=5db4992d8f040b8d8db0b86d42806e0c417f7ccf'>arch</a>/<a href='/cgit.cgi/linux/net-next.git/log/arch/arm?h=nds-private-remove&amp;id=5db4992d8f040b8d8db0b86d42806e0c417f7ccf'>arm</a>/<a href='/cgit.cgi/linux/net-next.git/log/arch/arm/boot?h=nds-private-remove&amp;id=5db4992d8f040b8d8db0b86d42806e0c417f7ccf'>boot</a>/<a href='/cgit.cgi/linux/net-next.git/log/arch/arm/boot/dts?h=nds-private-remove&amp;id=5db4992d8f040b8d8db0b86d42806e0c417f7ccf'>dts</a>/<a href='/cgit.cgi/linux/net-next.git/log/arch/arm/boot/dts/imx28-eukrea-mbmx283lc.dts?h=nds-private-remove&amp;id=5db4992d8f040b8d8db0b86d42806e0c417f7ccf'>imx28-eukrea-mbmx283lc.dts</a></div><div class='content'><table class='list nowrap'><tr class='nohover'><th class='left'>Age</th><th class='left'>Commit message (<a href='/cgit.cgi/linux/net-next.git/log/arch/arm/boot/dts/imx28-eukrea-mbmx283lc.dts?h=nds-private-remove&amp;id=5db4992d8f040b8d8db0b86d42806e0c417f7ccf&amp;showmsg=1'>Expand</a>)</th><th class='left'>Author</th><th class='left'>Files</th><th class='left'>Lines</th></tr>