source: svn/trunk/newcon3bcm2_21bu/magnum/commonutils/udp/budp_jp3dparse.c @ 63

/***************************************************************************
 *     Copyright (c) 2003-2011, Broadcom Corporation
 *     All Rights Reserved
 *     Confidential Property of Broadcom Corporation
 *
 *  THIS SOFTWARE MAY ONLY BE USED SUBJECT TO AN EXECUTED SOFTWARE LICENSE
 *  AGREEMENT  BETWEEN THE USER AND BROADCOM.  YOU HAVE NO RIGHT TO USE OR
 *  EXPLOIT THIS MATERIAL EXCEPT SUBJECT TO THE TERMS OF SUCH AN AGREEMENT.
 *
 * $brcm_Workfile: budp_jp3dparse.c $
 * $brcm_Revision: Hydra_Software_Devel/3 $
 * $brcm_Date: 1/18/11 1:28p $
 *
 * Module Description:
 *
 * Revision History:
 *
 * $brcm_Log: /magnum/commonutils/udp/budp_jp3dparse.c $
 * 
 * Hydra_Software_Devel/3   1/18/11 1:28p darnstein
 * SW7405-4817: add new Stereo_Video_Format_Type values, per N11462.
 * 
 * Hydra_Software_Devel/2   10/28/10 3:59p darnstein
 * SW3548-2364: trivial implementation of _isr functions for parsing.
 * 
 * Hydra_Software_Devel/1   10/7/10 10:27a darnstein
 * SW7405-4817: Parser for the Dpa 3D signaling message used in Japan.
 * 
 ***************************************************************************/

/* For debugging */
/* #define BUDP_P_GETUD_DUMP 1 */
#ifdef BUDP_P_GETUD_DUMP
static const char* BUDP_P_Getud_Filename = "userdata.getud";
#include <stdio.h>
#endif

#include "bstd.h"
#include "bavc.h"
#include "bdbg.h"
#include "budp.h"
#include "budp_jp3dparse.h"

BDBG_MODULE(BUDP);


/***************************************************************************
* Forward declarations of static (private) functions
***************************************************************************/

static size_t FindJp3dStart (
        const uint8_t* userdata, size_t length);

#ifdef BUDP_P_GETUD_DUMP
static void dump_getud (
        const BAVC_USERDATA_info* pUserdata_info, size_t offset);
#endif

/***************************************************************************
* Static data (tables, etc.)
***************************************************************************/


/***************************************************************************
* Implementation of "BUDP_JP3Dparse_" API functions
***************************************************************************/


/***************************************************************************
 *
 */
BERR_Code BUDP_JP3Dstart_isr ( 
        const BAVC_USERDATA_info* pUserdata_info, 
        size_t         offset, 
        size_t*  pBytesParsed  
)
{
        size_t bytesParsedSub;
        size_t length;
        uint8_t* userdata;

        BDBG_ENTER(BUDP_JP3Dstart_isr);

        /* Check for obvious errors from user */
        if ((pUserdata_info == 0x0) ||
            (pBytesParsed   == 0x0)   )
        {
                return BERR_INVALID_PARAMETER;
        }

        /* Programming note:  all function parameters are now validated */

#ifdef BUDP_P_GETUD_DUMP
        dump_getud (pUserdata_info, offset);
#endif

        /* Take care of a special case */
        userdata = (uint8_t*)(pUserdata_info->pUserDataBuffer) + offset;
        length   = pUserdata_info->ui32UserDataBufSize - offset;
        if (length < 8)
        {
                *pBytesParsed = length;
                return BERR_BUDP_NO_DATA;
        }

        /* jump past the first SEI userdata start code */
        bytesParsedSub = FindJp3dStart (userdata, length);
        *pBytesParsed = bytesParsedSub;
        length -= bytesParsedSub;
        /* userdata += bytesParsedSub; */

        /* If we did not find a start code, bail out now */
        if (length == 0)
        {
                return BERR_BUDP_NO_DATA;
        }

        BDBG_LEAVE(BUDP_JP3Dstart_isr);
        return BERR_SUCCESS;
}


BERR_Code BUDP_JP3Dparse_isr ( 
        const BAVC_USERDATA_info* pUserdata_info,
        size_t         offset,
        size_t*  pBytesParsed,
        uint16_t*     sigtype  
)
{
        size_t length;
        uint8_t* userdata;
        uint8_t val8;
        uint16_t val16;

        BDBG_ENTER(BUDP_JP3Dparse_isr);

        /* Check for obvious errors from user */
        if ((pUserdata_info == 0x0) ||
            (pBytesParsed   == 0x0) ||
                (sigtype        == 0x0)   )
        {
                return BERR_INVALID_PARAMETER;
        }

        /* Programming note:  all function parameters are now validated */

        /* Take care of a special case */
        userdata = (uint8_t*)(pUserdata_info->pUserDataBuffer) + offset;
        length   = pUserdata_info->ui32UserDataBufSize - offset;
        if (length < 4)
        {
                *pBytesParsed = length;
                return BERR_BUDP_NO_DATA;
        }

        /* Stereo_Video_Format_Signaling_Length */
        if ((*userdata++) != 3)
        {
                *pBytesParsed = 1;
                return BERR_BUDP_PARSE_ERROR;
        }

        /* Reserved (bit) and Stereo_Video_Format_Signaling_Type */
        val8 = *userdata++;
        if ((val8 & 0x80) == 0)
        {
                *pBytesParsed = 2;
                return BERR_BUDP_PARSE_ERROR;
        }
        val8 &= 0x7F;
        switch (val8)
        {
        case 0x03:
        case 0x04:
        case 0x08:
                break;
        default:
                *pBytesParsed = 2;
                return BERR_BUDP_PARSE_ERROR;
                break;
        }
        /* The heart of the matter */
        *sigtype = val8;

        /* Reserved (2 bytes) */
        val16 = (*userdata++) << 8;
        val16 |= *userdata++;
        *pBytesParsed = 4;
        if (val16 != 0x04FF)
        {
                return BERR_BUDP_PARSE_ERROR;
        }

        BDBG_LEAVE(BUDP_JP3Dparse_isr);
        return BERR_SUCCESS;
}


static size_t FindJp3dStart (
        const uint8_t* userdata, size_t length)
{
        uint8_t saved[8];
    size_t count = 0;

        /* Special case (failure) */
        if (length < 8)
                return length;

        /* Initialize */
        saved[1] = *userdata++;
        saved[2] = *userdata++;
        saved[3] = *userdata++;
        saved[4] = *userdata++;
        saved[5] = *userdata++;
        saved[6] = *userdata++;
        saved[7] = *userdata++;

        while (length >= 8)
        { 
                /* Read in another byte */
                saved[0] = saved[1];
                saved[1] = saved[2];
                saved[2] = saved[3];
                saved[3] = saved[4];
                saved[4] = saved[5];
                saved[5] = saved[6];
                saved[6] = saved[7];
                saved[7] = *userdata++;

                if ((saved[0] == 0x00) &&
                    (saved[1] == 0x00) &&
                        (saved[2] == 0x01) &&
                        (saved[3] == 0xb2) &&
                        (saved[4] == 0x4a) &&
                        (saved[5] == 0x50) &&
                        (saved[6] == 0x33) &&
                        (saved[7] == 0x44)   )
                {
                        /* Found it! */
                        break;
                }

                /* proceed to the next byte */
                --length;
                ++count;
        }

        if (length >= 8)
        {
                /* found the pattern before the end of stream */   
                return count + 8;
        }
        else
        {
                /* Didn't find any start code */
                return count + 7;
        }
}