source: svn/trunk/newcon3bcm2_21bu/dta/src/nexus_msg.c

/******************************************************************************
 *    (c)2008-2010 Broadcom Corporation
 *
 * This program is the proprietary software of Broadcom Corporation and/or its licensors,
 * and may only be used, duplicated, modified or distributed pursuant to the terms and
 * conditions of a separate, written license agreement executed between you and Broadcom
 * (an "Authorized License").  Except as set forth in an Authorized License, Broadcom grants
 * no license (express or implied), right to use, or waiver of any kind with respect to the
 * Software, and Broadcom expressly reserves all rights in and to the Software and all
 * intellectual property rights therein.  IF YOU HAVE NO AUTHORIZED LICENSE, THEN YOU
 * HAVE NO RIGHT TO USE THIS SOFTWARE IN ANY WAY, AND SHOULD IMMEDIATELY
 * NOTIFY BROADCOM AND DISCONTINUE ALL USE OF THE SOFTWARE.
 *
 * Except as expressly set forth in the Authorized License,
 *
 * 1.     This program, including its structure, sequence and organization, constitutes the valuable trade
 * secrets of Broadcom, and you shall use all reasonable efforts to protect the confidentiality thereof,
 * and to use this information only in connection with your use of Broadcom integrated circuit products.
 *
 * 2.     TO THE MAXIMUM EXTENT PERMITTED BY LAW, THE SOFTWARE IS PROVIDED "AS IS"
 * AND WITH ALL FAULTS AND BROADCOM MAKES NO PROMISES, REPRESENTATIONS OR
 * WARRANTIES, EITHER EXPRESS, IMPLIED, STATUTORY, OR OTHERWISE, WITH RESPECT TO
 * THE SOFTWARE.  BROADCOM SPECIFICALLY DISCLAIMS ANY AND ALL IMPLIED WARRANTIES
 * OF TITLE, MERCHANTABILITY, NONINFRINGEMENT, FITNESS FOR A PARTICULAR PURPOSE,
 * LACK OF VIRUSES, ACCURACY OR COMPLETENESS, QUIET ENJOYMENT, QUIET POSSESSION
 * OR CORRESPONDENCE TO DESCRIPTION. YOU ASSUME THE ENTIRE RISK ARISING OUT OF
 * USE OR PERFORMANCE OF THE SOFTWARE.
 *
 * 3.     TO THE MAXIMUM EXTENT PERMITTED BY LAW, IN NO EVENT SHALL BROADCOM OR ITS
 * LICENSORS BE LIABLE FOR (i) CONSEQUENTIAL, INCIDENTAL, SPECIAL, INDIRECT, OR
 * EXEMPLARY DAMAGES WHATSOEVER ARISING OUT OF OR IN ANY WAY RELATING TO YOUR
 * USE OF OR INABILITY TO USE THE SOFTWARE EVEN IF BROADCOM HAS BEEN ADVISED OF
 * THE POSSIBILITY OF SUCH DAMAGES; OR (ii) ANY AMOUNT IN EXCESS OF THE AMOUNT
 * ACTUALLY PAID FOR THE SOFTWARE ITSELF OR U.S. $1, WHICHEVER IS GREATER. THESE
 * LIMITATIONS SHALL APPLY NOTWITHSTANDING ANY FAILURE OF ESSENTIAL PURPOSE OF
 * ANY LIMITED REMEDY.
 *
 * $brcm_Workfile:  $
 * $brcm_Revision:  $
 * $brcm_Date:  $
 *
 * Module Description:
 *
 * Revision History:
 *
 * $brcm_Log:  $
 *
 *****************************************************************************/
#include "nexus_msg.h"
#include "nexus_platform.h"
#include "nexus_pid_channel.h"
#include "nexus_parser_band.h"
#include "nexus_message.h"
#include "ministd.h"

#include "bstd.h"
#include "bkni.h"
BDBG_MODULE(nexus_msg);
#define NEXUS_MSG_STK_SIZE      1024
typedef struct nexus_p_msg_t
{
        b_task_t task_h;
        unsigned short pid;
        unsigned char name[64];
        unsigned int stack[NEXUS_MSG_STK_SIZE];
}nexus_p_msg_t;

void message_callback(void *context, int param)
{
        BSTD_UNUSED(param);
        BKNI_SetEvent((BKNI_EventHandle)context);
}
#if 1
void msg_main(void *data)
{
        NEXUS_PidChannelHandle pidChannel;
        NEXUS_MessageHandle msg;
        NEXUS_MessageSettings settings;
        NEXUS_MessageStartSettings startSettings;
        NEXUS_ParserBandSettings parserBandSettings;
        NEXUS_PidChannelSettings pidChannelSettings;
        BKNI_EventHandle event;
        NEXUS_Error rc;
        nexus_p_msg_t *p_msg = (nexus_p_msg_t*)data;
        BDBG_ERR(("Start filter for PID[0x%04x]\n",p_msg->pid)); 

        NEXUS_PidChannel_GetDefaultSettings(&pidChannelSettings);
        pidChannel = NEXUS_PidChannel_Open(NEXUS_ParserBand_e0, p_msg->pid, &pidChannelSettings);

        BKNI_CreateEvent(&event);

        NEXUS_Message_GetDefaultSettings(&settings);
        settings.dataReady.callback = message_callback;
        settings.dataReady.context = event;
        //settings.maxContiguousMessageSize = 4096;
        msg = NEXUS_Message_Open(&settings);
        BDBG_ASSERT(msg);

        NEXUS_Message_GetDefaultStartSettings(msg, &startSettings);
        startSettings.pidChannel = pidChannel;
        /* use the default filter for any data */


        /* Read the PAT a few times */
        while (1)
        {
                const uint8_t *buffer;
                size_t size;
                int message_length;
                rc = NEXUS_Message_Start(msg, &startSettings);
                BDBG_ASSERT(!rc);

                rc = NEXUS_Message_GetBuffer(msg, (const void **)&buffer, &size);
                BDBG_ASSERT(!rc);
                if (!size)
                {
                        BERR_Code rc = BKNI_WaitForEvent(event, 5 * 1000); /* wait 5 seconds */
                        if (rc)
                        {
                                BDBG_ERR(("Timeout waiting for section[0x%04x]\n",p_msg->pid)); 
                        }
                        NEXUS_Message_Stop(msg);
                        continue;
                }

#define TS_READ_16( BUF ) ((uint16_t)((BUF)[0]<<8|(BUF)[1]))
#define TS_PSI_GET_SECTION_LENGTH( BUF )    (uint16_t)(TS_READ_16( &(BUF)[1] ) & 0x0FFF)

                /* We should always get whole PAT's because maxContiguousMessageSize is 4K */
                message_length = TS_PSI_GET_SECTION_LENGTH(buffer) + 3;

                /* XPT HW is configured to pad all messages to 4 bytes. If we are calling NEXUS_Message_ReadComplete
                based on message length and not the size returned by NEXUS_Message_GetBuffer, then we must add that pad.
                If we are wrong, NEXUS_Message_ReadComplete will fail. */
                if (message_length % 4)
                {
                        message_length += 4 - (message_length % 4);
                }
                if (size < (size_t)message_length)
                {
                        BDBG_ERR(("Invalid Section Length[0x%04x](size %d < msg_length %d)\n",p_msg->pid,size,(size_t)message_length)); 
                }

                // printf("Found Section[0x%04x]: id=%d size=%d\n", p_msg->pid, buffer[0], message_length);

                /* only complete one PAT */
                rc = NEXUS_Message_ReadComplete(msg, size);
                BDBG_ASSERT(!rc);
                NEXUS_Message_Stop(msg);
           // bos_sleep(10);
        }

        NEXUS_Message_Stop(msg);
        NEXUS_Message_Close(msg);
        NEXUS_PidChannel_Close(pidChannel);

        NEXUS_Platform_Uninit();
        return;
}

#else
void msg_main(void *data)
{
        NEXUS_PidChannelHandle pidChannel;
        NEXUS_MessageHandle msg;
        NEXUS_MessageSettings settings;
        NEXUS_MessageStartSettings startSettings;
        NEXUS_ParserBandSettings parserBandSettings;
        NEXUS_PidChannelSettings pidChannelSettings;
        BKNI_EventHandle event;
        NEXUS_Error rc;
        nexus_p_msg_t *p_msg = (nexus_p_msg_t*)data;
        BDBG_ERR(("Start filter for PID[0x%04x]\n",p_msg->pid)); 

        NEXUS_PidChannel_GetDefaultSettings(&pidChannelSettings);
        pidChannel = NEXUS_PidChannel_Open(NEXUS_ParserBand_e0, p_msg->pid, &pidChannelSettings);

        BKNI_CreateEvent(&event);

        NEXUS_Message_GetDefaultSettings(&settings);
        settings.dataReady.callback = message_callback;
        settings.dataReady.context = event;
        settings.maxContiguousMessageSize = 4096;
        msg = NEXUS_Message_Open(&settings);
        BDBG_ASSERT(msg);

        NEXUS_Message_GetDefaultStartSettings(msg, &startSettings);
        startSettings.pidChannel = pidChannel;
        /* use the default filter for any data */

        rc = NEXUS_Message_Start(msg, &startSettings);
        BDBG_ASSERT(!rc);

        /* Read the PAT a few times */
        while (1)
        {
                const uint8_t *buffer;
                size_t size;
                int message_length;

                rc = NEXUS_Message_GetBuffer(msg, (const void **)&buffer, &size);
                BDBG_ASSERT(!rc);
                if (!size)
                {
                        BERR_Code rc = BKNI_WaitForEvent(event, 5 * 1000); /* wait 5 seconds */
                        if (rc)
                        {
                                BDBG_ERR(("Timeout waiting for section[0x%04x]\n",p_msg->pid)); 
                        }
                        continue;
                }

#define TS_READ_16( BUF ) ((uint16_t)((BUF)[0]<<8|(BUF)[1]))
#define TS_PSI_GET_SECTION_LENGTH( BUF )    (uint16_t)(TS_READ_16( &(BUF)[1] ) & 0x0FFF)

                /* We should always get whole PAT's because maxContiguousMessageSize is 4K */
                message_length = TS_PSI_GET_SECTION_LENGTH(buffer) + 3;

                /* XPT HW is configured to pad all messages to 4 bytes. If we are calling NEXUS_Message_ReadComplete
                based on message length and not the size returned by NEXUS_Message_GetBuffer, then we must add that pad.
                If we are wrong, NEXUS_Message_ReadComplete will fail. */
                if (message_length % 4)
                {
                        message_length += 4 - (message_length % 4);
                }
                if (size < (size_t)message_length)
                {
                        BDBG_ERR(("Invalid Section Length[0x%04x](size %d < msg_length %d)\n",p_msg->pid,size,(size_t)message_length)); 
                }

                // printf("Found Section[0x%04x]: id=%d size=%d\n", p_msg->pid, buffer[0], message_length);

                /* only complete one PAT */
                rc = NEXUS_Message_ReadComplete(msg, size);
                BDBG_ASSERT(!rc);
           // bos_sleep(10);
        }

        NEXUS_Message_Stop(msg);
        NEXUS_Message_Close(msg);
        NEXUS_PidChannel_Close(pidChannel);

        NEXUS_Platform_Uninit();
        return;
}
#endif
static int s_msg_thread_cnt = 0;
int nexus_msg_start(unsigned short pid)
{
        b_task_params task_params;

        nexus_p_msg_t *p_msg = (nexus_p_msg_t*)malloc(sizeof(nexus_p_msg_t));

        BDBG_ASSERT(p_msg);
        p_msg->pid = pid;
        snprintf(p_msg->name,64,"nexus_msg_%d",pid);
        task_params.name=p_msg->name;
        task_params.priority = 60 + s_msg_thread_cnt++;
        task_params.stack_size = NEXUS_MSG_STK_SIZE;
        task_params.stack = p_msg->stack;

        bos_start_task(&(p_msg->task_h), &task_params, msg_main,p_msg);
}