/***
 *
 *  rtmac/rtmac_proto.c
 *
 *  rtmac - real-time networking media access control subsystem
 *  Copyright (C) 2002      Marc Kleine-Budde <kleine-budde@gmx.de>,
 *                2003-2005 Jan Kiszka <Jan.Kiszka@web.de>
 *
 *  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., 675 Mass Ave, Cambridge, MA 02139, USA.
 *
 */

#include <rtdm/driver.h>
#include <stack_mgr.h>
#include <rtmac/rtmac_disc.h>
#include <rtmac/rtmac_proto.h>
#include <rtmac/rtmac_vnic.h>

int rtmac_proto_rx(struct rtskb *skb, struct rtpacket_type *pt)
{
	struct rtmac_disc *disc = skb->rtdev->mac_disc;
	struct rtmac_hdr *hdr;

	if (disc == NULL) {
		goto error;
	}

	hdr = (struct rtmac_hdr *)skb->data;
	rtskb_pull(skb, sizeof(struct rtmac_hdr));

	if (hdr->ver != RTMAC_VERSION) {
		rtdm_printk(
			"RTmac: received unsupported RTmac protocol version on "
			"device %s.  Got 0x%x but expected 0x%x\n",
			skb->rtdev->name, hdr->ver, RTMAC_VERSION);
		goto error;
	}

	if (hdr->flags & RTMAC_FLAG_TUNNEL)
		rtmac_vnic_rx(skb, hdr->type);
	else if (disc->disc_type == hdr->type)
		disc->packet_rx(skb);
	return 0;

error:
	kfree_rtskb(skb);
	return 0;
}

struct rtpacket_type rtmac_packet_type = { .type = __constant_htons(ETH_RTMAC),
					   .handler = rtmac_proto_rx };

void rtmac_proto_release(void)
{
	rtdev_remove_pack(&rtmac_packet_type);
}