Two channel input resize issue in VPE on TDA2x

/*
 *******************************************************************************
 *
 * Copyright (C) 2013 Texas Instruments Incorporated - http://www.ti.com/
 * ALL RIGHTS RESERVED
 *
 *******************************************************************************
 */

/*******************************************************************************
 *  INCLUDE FILES
 *******************************************************************************
 */
#include "chains_network_integrated_priv.h"
#include <examples/tda2xx/include/chains_common.h>

#define KPIT_MODIFICATIONS

#define CAPTURE_SENSOR_WIDTH      (1280)
#define CAPTURE_SENSOR_HEIGHT     (800)

#define ALGORITHM_WIDTH  (640)
#define ALGORITHM_HEIGHT  (400)
/**
 *******************************************************************************
 *
 *  \brief  Use-case object
 *
 *        This structure contains all the LinksId's and create Params.
 *        The same is passed to all create, start, stop functions.
 *
 *******************************************************************************
*/
typedef struct {

	chains_network_integratedObj ucObj;

    UInt32  captureOutWidth;
    UInt32  captureOutHeight;
    UInt32  displayWidth;
    UInt32  displayHeight;

    UInt32 numCh;
    UInt32  displayActiveChId;
    Chains_Ctrl *chainsCfg;

} chains_network_integratedAppObj;


/**
 *******************************************************************************
 * \brief   Set create parameters for NullSrc
 *******************************************************************************
*/
Void chains_network_integrated_SetNullSrcPrms(chains_network_integratedAppObj *pObj,
                        NullSrcLink_CreateParams *pPrm)
{
    UInt32 chId;
    System_LinkChInfo *pChInfo;

    pPrm->outQueInfo.numCh = 2;

    pObj->numCh = pPrm->outQueInfo.numCh;
#ifdef KPIT_MODIFICATIONS
    pPrm->timerPeriodMilliSecs = 100;
#else
    pPrm->timerPeriodMilliSecs = 1000;
#endif

    for (chId = 0; chId < pPrm->outQueInfo.numCh; chId++)
    {
        pPrm->channelParams[chId].numBuffers = 5;

        pChInfo = &pPrm->outQueInfo.chInfo[chId];

#ifdef KPIT_MODIFICATIONS
        pChInfo->flags = System_Link_Ch_Info_Set_Flag_Data_Format(pChInfo->flags,
                                                    SYSTEM_DF_YUV422I_YUYV);
#else
        pChInfo->flags = System_Link_Ch_Info_Set_Flag_Data_Format(pChInfo->flags,
                                                    SYSTEM_DF_YUV420SP_UV);
#endif
        pChInfo->flags = System_Link_Ch_Info_Set_Flag_Data_Format(pChInfo->flags,
                                                    SYSTEM_SF_PROGRESSIVE);
        pChInfo->flags = System_Link_Ch_Info_Set_Flag_Buf_Type(pChInfo->flags,
                                               SYSTEM_BUFFER_TYPE_VIDEO_FRAME);
        pChInfo->width  = pObj->captureOutWidth;
        pChInfo->height = pObj->captureOutHeight;
        pChInfo->startX = 0;
        pChInfo->startY = 0;
#ifdef KPIT_MODIFICATIONS
        pChInfo->pitch[0] = SystemUtils_align((pChInfo->width*2), 32);
        pChInfo->pitch[1] = SystemUtils_align((pChInfo->width*2), 32);
#else
        pChInfo->pitch[0] = SystemUtils_align(pChInfo->width, 32);
        pChInfo->pitch[1] = SystemUtils_align(pChInfo->width, 32);
#endif


    }

    pPrm->networkServerPort = NETWORK_RX_SERVER_PORT;
    pPrm->dataRxMode = NULLSRC_LINK_DATA_RX_MODE_NETWORK;
}


Void chains_network_integrated_SetNullPrms(NullLink_CreateParams *pPrm)
{
    pPrm->dumpDataType = NULL_LINK_COPY_TYPE_NETWORK;
    pPrm->networkServerPort = NETWORK_TX_SERVER_PORT;
}


/**
 *******************************************************************************
 *
 * \brief   Set VPE Create Parameters
 *
 * \param   pPrm    [OUT]    VpeLink_CreateParams
 *
 *******************************************************************************
*/
Void chains_network_integrated_SetVpePrm(
                    VpeLink_CreateParams *pPrm1,
                    VpeLink_CreateParams *pPrm2,
                    UInt32 outWidth,
                    UInt32 outHeight,
                    UInt32 srcWidth,
                    UInt32 srcHeight,
                    System_VideoDataFormat dataFormat
                    )
{
    pPrm1->enableOut[0] = TRUE;

    pPrm1->chParams[0].outParams[0].width = SystemUtils_floor(outWidth,4);
    pPrm1->chParams[0].outParams[0].height = SystemUtils_floor(outHeight, 2);
    pPrm1->chParams[0].outParams[0].numBufsPerCh = 5;

    pPrm1->chParams[0].scCropCfg.cropStartX = 0;
    pPrm1->chParams[0].scCropCfg.cropStartY = 0;
    pPrm1->chParams[0].scCropCfg.cropWidth  = srcWidth;
    pPrm1->chParams[0].scCropCfg.cropHeight = srcHeight;

    pPrm1->chParams[0].outParams[0].dataFormat = dataFormat;

    pPrm1->chParams[0].scCfg.bypass       = FALSE;
    pPrm1->chParams[0].scCfg.nonLinear    = FALSE;
    pPrm1->chParams[0].scCfg.stripSize    = 0;

    pPrm2->enableOut[0] = TRUE;
    pPrm2->chParams[0].outParams[0].width = SystemUtils_floor(outWidth,4);
    pPrm2->chParams[0].outParams[0].height = SystemUtils_floor(outHeight, 2);
    pPrm2->chParams[0].outParams[0].numBufsPerCh = 5;

    pPrm2->chParams[0].scCropCfg.cropStartX = 0;
    pPrm2->chParams[0].scCropCfg.cropStartY = 0;
    pPrm2->chParams[0].scCropCfg.cropWidth  = srcWidth;
    pPrm2->chParams[0].scCropCfg.cropHeight = srcHeight;

    pPrm2->chParams[0].outParams[0].dataFormat = dataFormat;

    pPrm2->chParams[0].scCfg.bypass       = FALSE;
    pPrm2->chParams[0].scCfg.nonLinear    = FALSE;
    pPrm2->chParams[0].scCfg.stripSize    = 0;

}


Void chains_network_integrated_SetDisplayPrms(
                                DisplayLink_CreateParams *pPrm,
                                UInt32 displayID,
                                UInt32 displayWinStartX,
                                UInt32 displayWinStartY,
                                UInt32 displayWinWidth,
                                UInt32 displayWinHeight
                                )
{
    pPrm->displayId = displayID;
    pPrm->rtParams.posX = displayWinStartX;
    pPrm->rtParams.posY = displayWinStartY;
    pPrm->rtParams.tarWidth  = displayWinWidth;
    pPrm->rtParams.tarHeight = displayWinHeight;
}

Void chains_network_integrated_Set_AlgPrms(
		AlgorithmLink_FrameCopyCreateParams *FrameCopy1,
		AlgorithmLink_FrameCopyCreateParams *FrameCopy2,
                                        Chains_Ctrl *chainsCfg)
{
	FrameCopy1->maxWidth    = ALGORITHM_WIDTH;
	FrameCopy1->maxHeight   = ALGORITHM_HEIGHT;
	FrameCopy1->numOutputFrames = 5;

	FrameCopy2->maxWidth    = ALGORITHM_WIDTH;
	FrameCopy2->maxHeight   = ALGORITHM_HEIGHT;
	FrameCopy2->numOutputFrames = 5;
}

Void chains_network_integrated_SetSyncPrm(SyncLink_CreateParams *Sync)
{
    Sync->syncDelta = 1100;
    Sync->syncThreshold = 11000;
}


Void chains_network_integrated_SetSelectlinkPrms(SelectLink_CreateParams *pPrm)
{
    pPrm->numOutQue = 2;

    pPrm->outQueChInfo[0].outQueId   = 0;
    pPrm->outQueChInfo[0].numOutCh   = 1;
    pPrm->outQueChInfo[0].inChNum[0] = 0;

    pPrm->outQueChInfo[1].outQueId   = 1;
    pPrm->outQueChInfo[1].numOutCh   = 1;
    pPrm->outQueChInfo[1].inChNum[0] = 1;
}

Void chains_network_integrated_Set_DrawPrms( AlgorithmLink_IntegratedDrawCreateParams *OutputDrawParams,
													 Chains_Ctrl *chainsCfg)
{

	OutputDrawParams->imgFrameHeight = ALGORITHM_HEIGHT;
	OutputDrawParams->imgFrameWidth = ALGORITHM_WIDTH;
	OutputDrawParams->imgFrameStartX = 0;
	OutputDrawParams->imgFrameStartY = 0;
	OutputDrawParams->numOutBuffers = 5;

}
/**
 *******************************************************************************
 *
 * \brief   Set link Parameters
 *
 *          It is called in Create function of the auto generated use-case file.
 *
 * \param pUcObj    [IN] Auto-generated use case object
 * \param appObj    [IN] Application specific object
 *
 *******************************************************************************
*/
Void chains_network_integrated_SetAppPrms(chains_network_integratedObj *pUcObj, Void *appObj)
{
    chains_network_integratedAppObj *pObj
        = (chains_network_integratedAppObj*)appObj;

    pObj->captureOutWidth  = CAPTURE_SENSOR_WIDTH;
    pObj->captureOutHeight = CAPTURE_SENSOR_HEIGHT;

    ChainsCommon_GetDisplayWidthHeight(
        pObj->chainsCfg->displayType,
        &pObj->displayWidth,
        &pObj->displayHeight
        );

    chains_network_integrated_SetNullSrcPrms(
        pObj,
        &pUcObj->NullSourcePrm
        );

    chains_network_integrated_SetNullPrms(&pUcObj->NullPrm);

    chains_network_integrated_SetVpePrm(
                           &pUcObj->VPE_1Prm,
                           &pUcObj->VPE_2Prm,
                           ALGORITHM_WIDTH,
                           ALGORITHM_HEIGHT,
                           pObj->captureOutWidth,
                           pObj->captureOutHeight,
                           SYSTEM_DF_YUV422I_YUYV
                       );
    chains_network_integrated_SetSelectlinkPrms(&pUcObj->Select_algPrm);

    ChainsCommon_SetGrpxSrcPrms(&pUcObj->GrpxSrcPrm,
                                               pObj->displayWidth,
                                               pObj->displayHeight
                                              );

    ChainsCommon_SetDisplayPrms(NULL,//&pUcObj->Display_algPrm,
                                &pUcObj->Display_GrpxPrm,
                                pObj->chainsCfg->displayType,
                                pObj->displayWidth,
                                pObj->displayHeight
                               );

//    pUcObj->Display_VideoPrm.displayId                 = DISPLAY_LINK_INST_DSS_VID1;

    chains_network_integrated_Set_AlgPrms(          &pUcObj->Alg_FrameCopy_1Prm,
            									&pUcObj->Alg_FrameCopy_2Prm,
                                                pObj->chainsCfg);

    chains_network_integrated_Set_DrawPrms( &pUcObj->Alg_IntegratedDrawPrm,pObj->chainsCfg);

    chains_network_integrated_SetSyncPrm(       &pUcObj->Sync_algPrm);
#ifdef KPIT_MODIFICATIONS
    pUcObj->Display_VideoPrm.rtParams.tarWidth = ALGORITHM_WIDTH;
    pUcObj->Display_VideoPrm.rtParams.tarHeight = ALGORITHM_HEIGHT;

    //Swapnil: Assertion when Image Width/height more than Display Height/Width
    UTILS_assert(pUcObj->Display_VideoPrm.rtParams.tarWidth <= pObj->displayWidth);
    UTILS_assert(pUcObj->Display_VideoPrm.rtParams.tarHeight <= pObj->displayHeight);

    //Swapnil: To Place the Frame at centre of display.Calculate Start PosX and Y based on Display and Frame Width /Height.
    pUcObj->Display_VideoPrm.rtParams.posX = (pObj->displayWidth >> 1) - (ALGORITHM_WIDTH >>1);
    pUcObj->Display_VideoPrm.rtParams.posY = (pObj->displayHeight >> 1) - (ALGORITHM_HEIGHT >>1);

    pUcObj->GrpxSrcPrm.logoDisplayEnable = FALSE;

#endif
    ChainsCommon_StartDisplayCtrl(
        pObj->chainsCfg->displayType,
        pObj->displayWidth,
        pObj->displayHeight
        );

}

/**
 *******************************************************************************
 *
 * \brief   Start the Multiple Algorithm Demonstration Links
 *
 *          Function sends a control command to Null Source, Algorithm and display link to
 *          to Start all the required links . Links are started in reverce
 *          order as information of next link is required to connect.
 *          System_linkStart is called with LinkId to start the links.
 *
 * \param   pObj  [IN] chains_network_integratedAppObj
 *
 * \return  SYSTEM_LINK_STATUS_SOK on success
 *
 *******************************************************************************
*/
Void chains_network_integrated_StartApp(chains_network_integratedAppObj *pObj)
{

    Chains_memPrintHeapStatus();

    ChainsCommon_StartDisplayDevice(pObj->chainsCfg->displayType);

    chains_network_integrated_Start(&pObj->ucObj);


    Chains_prfLoadCalcEnable(TRUE, FALSE, FALSE);
}

/**
 *******************************************************************************
 *
 * \brief   Delete the Multiple Algorithm Demonstration Links
 *
 *          Function sends a control command to Null Source, Algorithm and display link to
 *          to delete all the prior created links
 *          System_linkDelete is called with LinkId to delete the links.
 *
 * \param   pObj   [IN]   chains_network_integratedAppObj
 *
 *******************************************************************************
*/
Void chains_network_integrated_StopAndDeleteApp(chains_network_integratedAppObj *pObj)
{
    chains_network_integrated_Stop(&pObj->ucObj);
    chains_network_integrated_Delete(&pObj->ucObj);

    ChainsCommon_StopDisplayCtrl();
    ChainsCommon_StopDisplayDevice(pObj->chainsCfg->displayType);

    /* Print the HWI, SWI and all tasks load */
    /* Reset the accumulated timer ticks */
    Chains_prfLoadCalcEnable(FALSE, TRUE, TRUE);
}

/**
 *******************************************************************************
 *
 * \brief   Multiple Algorithm Demonstration Usecase
 *
 *          This functions executes the create, start functions
 *
 *          Further in a while loop displays run time menu and waits
 *          for user inputs to print the statistics or to end the demo.
 *
 *          Once the user inputs end of demo stop and delete
 *          functions are executed.
 *
 * \param   chainsCfg       [IN]   Chains_Ctrl
 *
 *******************************************************************************
*/
Void chains_network_integrated(Chains_Ctrl *chainsCfg)
{
    char ch;
    UInt32 done = FALSE;
    chains_network_integratedAppObj chainsObj;

    chainsObj.chainsCfg = chainsCfg;

    chains_network_integrated_Create(&chainsObj.ucObj, &chainsObj);

    chains_network_integrated_StartApp(&chainsObj);

    chainsObj.displayActiveChId = 0;
    while(!done)
    {
        ch = Chains_menuRunTime();

        switch(ch)
        {
            case '0':
                done = TRUE;
                break;
            case 'p':
            case 'P':
                chains_network_integrated_printStatistics(&chainsObj.ucObj);
                ChainsCommon_PrintStatistics();
                break;
            default:
                Vps_printf("\nUnsupported option '%c'. Please try again\n", ch);
                break;
        }
    }

    chains_network_integrated_StopAndDeleteApp(&chainsObj);
}