RTOS: Vision SDK - Switching between pipelines VID1 & GFX1

/******************************************************************************
Copyright (c) [2012 - 2017] Texas Instruments Incorporated

All rights reserved not granted herein.

Limited License.

 Texas Instruments Incorporated grants a world-wide, royalty-free, non-exclusive
 license under copyrights and patents it now or hereafter owns or controls to
 make,  have made, use, import, offer to sell and sell ("Utilize") this software
 subject to the terms herein.  With respect to the foregoing patent license,
 such license is granted  solely to the extent that any such patent is necessary
 to Utilize the software alone.  The patent license shall not apply to any
 combinations which include this software, other than combinations with devices
 manufactured by or for TI ("TI Devices").  No hardware patent is licensed
 hereunder.

 Redistributions must preserve existing copyright notices and reproduce this
 license (including the above copyright notice and the disclaimer and
 (if applicable) source code license limitations below) in the documentation
 and/or other materials provided with the distribution

 Redistribution and use in binary form, without modification, are permitted
 provided that the following conditions are met:

 * No reverse engineering, decompilation, or disassembly of this software
   is permitted with respect to any software provided in binary form.

 * Any redistribution and use are licensed by TI for use only with TI Devices.

 * Nothing shall obligate TI to provide you with source code for the software
   licensed and provided to you in object code.

 If software source code is provided to you, modification and redistribution of
 the source code are permitted provided that the following conditions are met:

 * Any redistribution and use of the source code, including any resulting
   derivative works, are licensed by TI for use only with TI Devices.

 * Any redistribution and use of any object code compiled from the source code
   and any resulting derivative works, are licensed by TI for use only with TI
   Devices.

 Neither the name of Texas Instruments Incorporated nor the names of its
 suppliers may be used to endorse or promote products derived from this software
 without specific prior written permission.

 DISCLAIMER.

 THIS SOFTWARE IS PROVIDED BY TI AND TI�S LICENSORS "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 TI AND TI�S LICENSORS 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.
******************************************************************************/

/*******************************************************************************
 *  INCLUDE FILES
 *******************************************************************************
 */
#include "weston_m4camera_priv.h"
#include <src/hlos/adas/include/chains.h>
#include <src/hlos/common/chains_common.h>
#include <src/hlos/system/system_gbm_allocator.h>
#include <src/include/chains_common_surround_view.h>
#include <system_cfg.h>



#include <stdio.h>
#include <stdlib.h>


#define CAPTURE_SENSOR_WIDTH      (1280)
#define CAPTURE_SENSOR_HEIGHT     (720)
#define LCD_DISPLAY_WIDTH         (800)
#define LCD_DISPLAY_HEIGHT        (480)

#define MAX_NUMBER_OF_CHANNELS    (1)
#define ENCDEC_MAX_FRAME_WIDTH    (1280)
#define ENCDEC_MAX_FRAME_HEIGHT   (720)
//#define DECODE_DISPLAY_WIDTH      (640)
//#define DECODE_DISPLAY_HEIGHT     (360)
#define DECODE_DISPLAY_WIDTH      (800)
#define DECODE_DISPLAY_HEIGHT     (480)
#define DECODE_DISPLAY_STARTX     (0)
#define DECODE_DISPLAY_STARTY     (0)
#define WESTON_DISPLAY_WIDTH      (800)
#define WESTON_DISPLAY_HEIGHT     (480)
#define WESTON_DISPLAY_STARTX     (0)
#define WESTON_DISPLAY_STARTY     (0)

/**
 *******************************************************************************
 *
 *  \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 {

    weston_m4cameraObj ucObj;
	VideoSensorCreateAndStartAppPrm  vidSensorPrm;

    /**< Link Id's and device IDs to use for this use-case */
    UInt32  appCtrlLinkId;

   UInt32  captureOutWidth;
    UInt32  captureOutHeight;

    UInt32  displayWidth;
    UInt32  displayHeight;

    Chains_Ctrl *chainsCfg;

    UInt32 codecType;
} Chains_NullSrcDisplayAppObj;

/**
 *******************************************************************************
 *
 * \brief   Set link Parameters
 *
 *          It is called in Create function of the auto generated use-case file.
 *
 * \param pUcObj    [IN] Auto-generated usecase object
 * \param appObj    [IN] Application specific object
 *
 *******************************************************************************
*/
Void weston_m4camera_SetAppPrms(weston_m4cameraObj *pUcObj, Void *appObj)
{
	 UInt32 displayWidth, displayHeight;

   // DisplayLink_CreateParams *pPrm_Video;
    DisplayLink_CreateParams *pPrm_Weston;
    DispDistSrcLink_CreateParams *pPrm;
    Chains_NullSrcDisplayAppObj *pObj
        = (Chains_NullSrcDisplayAppObj*)appObj;

    ChainsCommon_GetDisplayWidthHeight(
        pObj->chainsCfg->displayType,
        &pObj->displayWidth,
        &pObj->displayHeight
        );
	
	 ChainsCommon_GetDisplayWidthHeight(
        pObj->chainsCfg->displayType,
        &displayWidth,
        &displayHeight
        );
	
 pObj->captureOutWidth  = CAPTURE_SENSOR_WIDTH;
    pObj->captureOutHeight = CAPTURE_SENSOR_HEIGHT;


   ChainsCommon_SingleCam_SetCapturePrms(&(pUcObj->CapturePrm),
            CAPTURE_SENSOR_WIDTH,
            CAPTURE_SENSOR_HEIGHT,
            pObj->captureOutWidth,
            pObj->captureOutHeight,
            pObj->chainsCfg->captureSrc
            );

#if 0	
	ChainsCommon_SetGrpxSrcPrms(&pUcObj->GrpxSrcPrm,
                                displayWidth,
                                displayHeight
                                );	
		
	pUcObj->Display_GrpxPrm.rtParams.tarWidth       = displayWidth;
    pUcObj->Display_GrpxPrm.rtParams.tarHeight      = displayHeight;
    pUcObj->Display_GrpxPrm.rtParams.posX           = 0;
    pUcObj->Display_GrpxPrm.rtParams.posY           = 0;
    pUcObj->Display_GrpxPrm.displayId               = DISPLAY_LINK_INST_DSS_GFX1;
		
#endif

	ChainsCommon_SetDisplayPrms(&pUcObj->Display_VideoPrm,
                                NULL,
                                pObj->chainsCfg->displayType,
                                displayWidth,
                                displayHeight
                               );
							   
    pPrm = &pUcObj->DispDistSrcPrm;

    sprintf((char *)(&pPrm->exportedName[0]), "gfx");
    pPrm->exportedWidth = WESTON_DISPLAY_WIDTH;
    pPrm->exportedHeight = WESTON_DISPLAY_HEIGHT;
    pPrm->exportedFramesPerSecond = 60;

    pPrm->numExportedDataFormats = 1;
    pPrm->exportedDataFormats[0] = SYSTEM_DF_ARGB32_8888;

  
    pPrm_Weston = &pUcObj->Display_GfxPrm;
    pPrm_Weston->rtParams.tarWidth       = WESTON_DISPLAY_WIDTH;
    pPrm_Weston->rtParams.tarHeight      = WESTON_DISPLAY_HEIGHT;
    pPrm_Weston->rtParams.posX           = WESTON_DISPLAY_STARTX;
    pPrm_Weston->rtParams.posY           = WESTON_DISPLAY_STARTY;
    pPrm_Weston->displayId               = DISPLAY_LINK_INST_DSS_GFX1;

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

/**
 *******************************************************************************
 *
 * \brief   Start the capture display Links
 *
 *          Function sends a control command to capture 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_VipSingleCameraViewObj
 *
 * \return  SYSTEM_LINK_STATUS_SOK on success
 *
 *******************************************************************************
*/
Void weston_m4camera_StartApp(Chains_NullSrcDisplayAppObj *pObj)
{
    ChainsCommon_statCollectorReset();
    ChainsCommon_memPrintHeapStatus();
	
	 //pObj->vidSensorPrm.captureSrcId = CHAINS_CAPTURE_SRC_OV10635;
    pObj->vidSensorPrm.captureSrcId = CHAINS_CAPTURE_SRC_VIDDEC_ADV7182 ;
    pObj->vidSensorPrm.isLVDSCaptMode = FALSE;
    pObj->vidSensorPrm.numLvdsCh = 0;

    System_linkControl(SYSTEM_LINK_ID_APP_CTRL,
                                APP_CTRL_LINK_CMD_VIDEO_SENSOR_CREATE_AND_START,
                                &pObj->vidSensorPrm,
                                sizeof(VideoSensorCreateAndStartAppPrm),
                                TRUE);
	OSA_waitMsecs(1000);
 Vps_printf("\n APP_CTRL_LINK_CMD_VIDEO_SENSOR_CREATE_AND_START done \n" );

    weston_m4camera_Start(&pObj->ucObj);

    ChainsCommon_prfLoadCalcEnable(TRUE, FALSE, FALSE);
}

/**
 *******************************************************************************
 *
 * \brief   Delete the capture display Links
 *
 *          Function sends a control command to capture 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_VipSingleCameraViewObj
 *
 *******************************************************************************
*/
Void weston_m4camera_StopAndDeleteApp(Chains_NullSrcDisplayAppObj *pObj)
{
    weston_m4camera_Stop(&pObj->ucObj);
    weston_m4camera_Delete(&pObj->ucObj);

    ChainsCommon_StopDisplayCtrl();
	
	  System_linkControl(SYSTEM_LINK_ID_APP_CTRL,
                        APP_CTRL_LINK_CMD_VIDEO_SENSOR_STOP_AND_DELETE,
                        &pObj->vidSensorPrm,
                        sizeof(VideoSensorCreateAndStartAppPrm),
                        TRUE);

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

/**
 *******************************************************************************
 * \brief Run Time Menu string for codec Type Selection.
 *******************************************************************************
 */
#if 0
char chains_nullSrc_Display_codecTypeSelect[] = {
    "\r\n "
    "\r\n ========================================="
    "\r\n Chains Run-time Codec Type Selection Menu"
    "\r\n ========================================="
    "\r\n "
    "\r\n Enter '0' for MJPEG "
    "\r\n "
    "\r\n Enter '1' for H.264 "
    "\r\n "
    "\r\n Enter Choice: "
    "\r\n "
};
#endif
/**
 *******************************************************************************
 *
 * \brief   Single Channel Capture Display usecase function
 *`
 *          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_m4camera_weston(Chains_Ctrl *chainsCfg)
{
    char ch = 'a';
	    volatile UInt32 temp;
    UInt32 done = FALSE;
    Chains_NullSrcDisplayAppObj chainsObj;

    chainsObj.chainsCfg = chainsCfg;
#if 0
{
    while(!done)
    {
        Vps_printf(chains_nullSrc_Display_codecTypeSelect);
        chainsObj.codecType = Chains_readChar();

        switch(chainsObj.codecType)
        {
            case '0':
                done = TRUE;
                break;
            case '1':
                done = TRUE;
                break;
            default:
                Vps_printf("\nUnsupported option '%c'. Please try again\n",
                           chainsObj.codecType);
                break;
        }
    }
}
#endif
    weston_m4camera_Create(&chainsObj.ucObj, &chainsObj);

    weston_m4camera_StartApp(&chainsObj);

    done = FALSE;
    while(!done)
    {
        ch = '1';
        ch = Chains_menuRunTime();
        switch(ch)
        {
            case '0':
                done = TRUE;
                break;

            case 'p':
            case 'P':
                ChainsCommon_PrintStatistics();
                weston_m4camera_printStatistics(&chainsObj.ucObj);
                break;
	   case 'h':
	   case 'H':	

        temp = *((volatile UInt32 *) 0x58001074);
	printf("DISPC_GLOBAL_ALPHA reg value is %x \n ",temp);
        *((volatile UInt32 *) 0x58001074) = temp & (UInt32) 0xFFFFFF00;
        temp = *((volatile UInt32 *) 0x58001074);
	printf("Affet set DISPC_GLOBAL_ALPHA reg value is %x \n ",temp);
	 break;	
            default:
                Vps_printf("\nUnsupported option '%c'. Please try again\n", ch);
                break;
        }
    }

    weston_m4camera_StopAndDeleteApp(&chainsObj);
}