UnwantedMessage.c
Author: cmaier@cmassoc.net

    /*====================================================================*
     *
     *   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 <cmaier@qca.qualcomm.com>
     *      Matthieu Poullet <m.poullet@avm.de>
     *
     *--------------------------------------------------------------------*/

    #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

[PREV] [HOME] [NEXT]