Test/EVSE/GPL/open-plc-utils-0.3/mme/UnwantedMessage.c

/*====================================================================*
 *
 *   Copyright (c) 2013 Qualcomm Atheros, Inc.
 *
 *   All rights reserved.
 *
 *   Redistribution and use in source and binary forms, with or
 *   without modification, are permitted (subject to the limitations
 *   in the disclaimer below) provided that the following conditions
 *   are met:
 *
 *   * Redistributions of source code must retain the above copyright
 *     notice, this list of conditions and the following disclaimer.
 *
 *   * 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.
 *
 *   * Neither the name of Qualcomm Atheros nor the names of
 *     its contributors may be used to endorse or promote products
 *     derived from this software without specific prior written
 *     permission.
 *
 *   NO EXPRESS OR IMPLIED LICENSES TO ANY PARTY'S PATENT RIGHTS ARE
 *   GRANTED BY THIS LICENSE. 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 OWNER
 *   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.
 *
 *--------------------------------------------------------------------*/

/*====================================================================*
 *
 *   signed UnwantedMessage (void const * memory, size_t extent, uint8_t MMV, uint16_t MMTYPE);
 *
 *   mme.h
 *
 *   return true if memory does not contains a Qualcomm Atheros message
 *   of the specified version and type; the message version determines
 *   the location of the OUI field; messages with MMV = 1 have an FMI
 *   used to track multi-part confirmation counts; out of order counts
 *   are treated as an error;
 *
 *   constant __WHYNOT__ displays reason for message rejection;
 *
 *   batch is the fragment group identifier taken from the fragment
 *   frame;
 *
 *   total is the number of fragements in the group taken from the
 *   fragment frame;
 *
 *   index is the fragment identifier from the fragment frame;
 *
 *   count is the number of fragments received so far;
 *
 *
 *   Contributor(s):
 *      Charles Maier
 *      Matthieu Poullet
 *
 *--------------------------------------------------------------------*/

#ifndef UNWANTEDMESSAGE_SOURCE
#define UNWANTEDMESSAGE_SOURCE

#include <stdint.h>
#include <memory.h>

#include "../tools/endian.h"
#include "../tools/error.h"
#include "../mme/mme.h"

signed UnwantedMessage (void const * memory, size_t extent, uint8_t MMV, uint16_t MMTYPE)

{
	extern const byte localcast [ETHER_ADDR_LEN];
//	struct message * message = (struct message *)(memory);
	struct homeplug * homeplug = (struct homeplug *)(memory);
	if (!extent)
	{
		return (-1);
	}
	if (extent < (ETHER_MIN_LEN - ETHER_CRC_LEN))
	{

#if defined (__WHYNOT__)

		error (0, 0, "Wrong Ethernet Frame Size: Received " SIZE_T_SPEC " bytes but need at least %d", extent, ETHER_MIN_LEN - ETHER_CRC_LEN);

#endif

		return (-1);
	}
	if (extent > (ETHER_MAX_LEN))
	{

#if defined (__WHYNOT__)

		error (0, 0, "Wrong Ethernet Frame Size: Received " SIZE_T_SPEC " bytes but need at most %d", extent, ETHER_MAX_LEN);

#endif

		return (-1);
	}
	if (ntohs (homeplug->ethernet.MTYPE) != ETH_P_HPAV)
	{

#if defined (__WHYNOT__)

		error (0, 0, "Wrong Ethernet Frame Type: Received %04X while waiting for %04X", ntohs (homeplug->ethernet.MTYPE), ETH_P_HPAV);

#endif

		return (-1);
	}
	if (homeplug->homeplug.MMV != MMV)
	{

#if defined (__WHYNOT__)

		error (0, 0, "Wrong Message Version: Received %02X but expected %02X", homeplug->homeplug.MMV, MMV);

#endif

		return (-1);
	}
	if (homeplug->homeplug.MMV == 0)
	{
		struct qualcomm_hdr * qualcomm = (struct qualcomm_hdr *)(&homeplug->homeplug);
		if (LE16TOH (qualcomm->MMTYPE) != MMTYPE)
		{

#if defined (__WHYNOT__)

			error (0, 0, "Wrong Message Type: Received %04X while waiting for %04X", LE16TOH (qualcomm->MMTYPE), MMTYPE);

#endif

			return (-1);
		}
		if ((MMTYPE < VS_MMTYPE_MIN) || (MMTYPE > VS_MMTYPE_MAX))
		{
		}
		else if (memcmp (localcast, qualcomm->OUI, sizeof (qualcomm->OUI)))
		{

#if defined (__WHYNOT__)

			error (0, 0, "Wrong Message Vendor");

#endif

			return (-1);
		}
	}
	if (homeplug->homeplug.MMV == 1)
	{
		struct qualcomm_fmi * qualcomm = (struct qualcomm_fmi *)(&homeplug->homeplug);

#if FMI

		static unsigned total = 0;
		static unsigned index = 0;
		static unsigned count = 0;

#endif

		if (LE16TOH (qualcomm->MMTYPE) != MMTYPE)
		{

#if defined (__WHYNOT__)

			error (0, 0, "Wrong Message Type: Received %04X while waiting for %04X", LE16TOH (qualcomm->MMTYPE), MMTYPE);

#endif

			return (-1);
		}

#if FMI

		index = qualcomm->FMID >> 0 & 0x0F;
		if (!index)
		{
			total = qualcomm->FMID >> 4 & 0x0F;
			count = qualcomm->FMID >> 0 & 0x0F;
			if (memcmp (localcast, qualcomm->OUI, sizeof (qualcomm->OUI)))
			{

#if defined (__WHYNOT__)

				error (0, 0, "Wrong Message Vendor");

#endif

				return (-1);
			}
		}
		if (index != count)
		{

#if defined (__WHYNOT__)

			error (0, 0, "Message Fragment Out-of-order");

#endif

			return (-1);
		}
		if (count > total)
		{

#if defined (__WHYNOT__)

			error (0, 0, "Fragment Count Exceeds Total");

#endif

			return (-1);
		}
		count++;

#endif

	}
	return (0);
}


#endif