SRIO problem number 2

void Init_SRIO ()
{
	int I_for;

	Param_SRIO_.DeviceId=0x0002;
	Param_SRIO_.VendorId=0x0001;
	Param_SRIO_.RevisionId=0x00000001;
	SRIO_PowerUp();
	
	m_Handle = CSL_SRIO_Open (0);

	CSL_SRIO_SetBootComplete(m_Handle, 0);

	CSL_SRIO_GlobalEnable(m_Handle);
	
	CSL_SRIO_EnableBlock(m_Handle, 0);

	CSL_SRIO_DisableBlock(m_Handle, 1);
	
	while(CSL_SRIO_IsSRIOBlockEnabled(m_Handle, 1));
	
	CSL_SRIO_SetLSUShadowRegs(m_Handle, 0x0, 0x0);
    for (I_for = 0; I_for < 8; I_for++)
	{
		CSL_SRIO_DisableSrcIDInterrupts(m_Handle, I_for);
	}
	CSL_SRIO_EnableBlock(m_Handle, 1);

	CSL_SRIO_EnableBlock(m_Handle, 2);
	CSL_SRIO_EnableBlock(m_Handle, 5);
	CSL_SRIO_EnableBlock(m_Handle, 6);
	CSL_SRIO_EnableBlock(m_Handle, 7);
	CSL_SRIO_EnableBlock(m_Handle, 8);
	CSL_SRIO_EnableBlock(m_Handle, 9);


	CSL_SRIO_DisableBlock(m_Handle, 3);
	CSL_SRIO_DisableBlock(m_Handle, 4);

    if (CSL_PSC_isModuleResetIsolationEnabled(CSL_PSC_LPSC_SRIO))
        CSL_PSC_disableModuleResetIsolation(CSL_PSC_LPSC_SRIO);


		CSL_SRIO_SetNormalMode(m_Handle, 0);
		CSL_SRIO_SetNormalMode(m_Handle, 1);
		CSL_SRIO_SetNormalMode(m_Handle, 2);
		CSL_SRIO_SetNormalMode(m_Handle, 3);

	CSL_SRIO_EnableAutomaticPriorityPromotion(m_Handle);

	CSL_SRIO_SetPrescalarSelect(m_Handle, 6);

    CSL_BootCfgUnlockKicker();


    //Enable PLL = 1
    //PLL multiply = 00101000 (10x)
    //VCO range = 1
    //Sleep PLL = 0
    //Loop bandwidth = 00
    //Clock Bypass = 00
    CSL_BootCfgSetSRIOSERDESConfigPLL(0x00000251);

    //Enable receiver = 1
    //Bus width = 010 (20 bit)
    //Operating rate = 01 (Half rate)
    //Invert polarity = 0
    //Input termination = 001
    //Symbol alignment = 01 (Comma alignment enabled)
    //Loss of signal = 000 (Disabled)
    //Clock/data recovery = 100 (First order)
    //Equalizer = 01 (Fully adaptive equalization)
    //Hold equalizer = 0
    //Enable offset compensation = 1
    //Loopback = 00 (Disabled)
    //Test patterns = 000 (Disabled)
		CSL_BootCfgSetSRIOSERDESRxConfig(0, 0x00460495);
		CSL_BootCfgSetSRIOSERDESRxConfig(1, 0x00460495);
		CSL_BootCfgSetSRIOSERDESRxConfig(2, 0x00460495);
		CSL_BootCfgSetSRIOSERDESRxConfig(3, 0x00460495);

    //Enable transmitter = 1
    //Bus width = 010 (20 bit)
    //Operating rate = 01 (Half rate)
    //Invert polarity = 0
    //Output swing = 0010 (870 mVdfpp)
    //Precursor Tap weight = 000
    //Adjacent post cursor Tap weight = 00000
    //Transmitter pre and post cursor FIR filter update = 1
    //Synchronization master = 1
    //Loopback = 00 (Disabled)
    //Test patterns = 000 (Disabled)
        CSL_BootCfgSetSRIOSERDESTxConfig(0, 0x00180115);
        CSL_BootCfgSetSRIOSERDESTxConfig(1, 0x00180115);
        CSL_BootCfgSetSRIOSERDESTxConfig(2, 0x00180115);
        CSL_BootCfgSetSRIOSERDESTxConfig(3, 0x00180115);


    while (1)
    {
        uint32_t    status;


        CSL_BootCfgGetSRIOSERDESStatus(&status);

        if (status & 0x1)
            break;
    }


    CSL_SRIO_ClearLSUPendingInterrupt(m_Handle, 0xFFFFFFFF, 0xFFFFFFFF);


    CSL_SRIO_SetDeviceInfo(m_Handle, Param_SRIO_.DeviceId, Param_SRIO_.VendorId, Param_SRIO_.RevisionId);
    CSL_SRIO_SetDeviceID(m_Handle, 0, Param_SRIO_.DeviceId, Param_SRIO_.DeviceId);


    CSL_SRIO_SetAssemblyInfo(m_Handle, SRIO_DEVICE_ASSEMBLY_ID, SRIO_DEVICE_ASSEMBLY_VENDOR_ID,
    		SRIO_DEVICE_ASSEMBLY_REVISION, SRIO_DEVICE_ASSEMBLY_INFO);

    /* TODO: Configure the processing element features
     *  The SRIO RL file is missing the Re-transmit Suppression Support (Bit6) field definition */
    SRIO_PE_FEATURES peFeatures;
    peFeatures.isBridge                          = 0;
    peFeatures.isEndpoint                        = 0;
    peFeatures.isProcessor                       = 1;
    peFeatures.isSwitch                          = 0;
    peFeatures.isMultiport                       = 0;
    peFeatures.isFlowArbiterationSupported       = 0;
    peFeatures.isMulticastSupported              = 0;
    peFeatures.isExtendedRouteConfigSupported    = 0;
    peFeatures.isStandardRouteConfigSupported    = 1;
    peFeatures.isFlowControlSupported            = 1;
    peFeatures.isCRFSupported                    = 0;
    peFeatures.isCTLSSupported                   = 1;
    peFeatures.isExtendedFeaturePtrValid         = 1;
    peFeatures.numAddressBitSupported            = 1;
    CSL_SRIO_SetProcessingElementFeatures(m_Handle, &peFeatures);

    /* Configure the source operation CAR */
    SRIO_OP_CAR opCar;
    memset ((void *) &opCar, 0, sizeof (opCar));
    opCar.portWriteOperationSupport = 1;
    opCar.atomicClearSupport        = 1;
    opCar.atomicSetSupport          = 1;
    opCar.atomicDecSupport          = 1;
    opCar.atomicIncSupport          = 1;
    opCar.atomicTestSwapSupport     = 1;
    opCar.doorbellSupport           = 1;
    opCar.dataMessageSupport        = 1;
    opCar.writeResponseSupport      = 1;
    opCar.streamWriteSupport        = 1;
    opCar.writeSupport              = 1;
    opCar.readSupport               = 1;
    opCar.dataStreamingSupport      = 1;
    CSL_SRIO_SetSourceOperationCAR(m_Handle, &opCar);

    /* Configure the destination operation CAR */
	memset ((void *) &opCar, 0, sizeof (opCar));
    opCar.portWriteOperationSupport  = 1;
    opCar.doorbellSupport            = 1;
    opCar.dataMessageSupport         = 1;
    opCar.writeResponseSupport       = 1;
    opCar.streamWriteSupport         = 1;
    opCar.writeSupport               = 1;
    opCar.readSupport                = 1;
    CSL_SRIO_SetDestOperationCAR(m_Handle, &opCar);

    CSL_SRIO_SetDeviceIDCSR(m_Handle, Param_SRIO_.DeviceId, Param_SRIO_.DeviceId);

    CSL_SRIO_SetHostDeviceID(m_Handle, Param_SRIO_.DeviceId);

    /* Configure the component tag CSR */
    CSL_SRIO_SetCompTagCSR(m_Handle, 0x00000000);

 	for (I_for = 0; I_for < SRIO_MAX_NUMBER_OF_PORTS; I_for++)
	{
	    /* Set the PLM Port Silence Timer. */
        CSL_SRIO_SetPLMPortSilenceTimer (m_Handle, I_for, 0x2);

        CSL_SRIO_EnableInputPort(m_Handle, I_for);
        CSL_SRIO_EnableOutputPort(m_Handle, I_for);

        /* Set the PLM Port Discovery Timer. */
        CSL_SRIO_SetPLMPortDiscoveryTimer (m_Handle, I_for, 0x2);

       
        CSL_SRIO_SetPortWriteReceptionCapture(m_Handle, I_for, 0x0);
    }

    
    CSL_SRIO_SetPortLinkTimeoutCSR(m_Handle, 0x000FFF);

    
    //HOST = 0
    //MASTER_ENABLE = 1
    //DISCOVERED = 0
    CSL_SRIO_SetPortGeneralCSR(m_Handle, 0, 1, 0);

   
    CSL_SRIO_SetLLMResetControl(m_Handle, 1);

    /* Set the device id to be 0 for the Maintenance Port-Write operation
     * to report errors to a system host. */
    CSL_SRIO_SetPortWriteDeviceId(m_Handle, 0x0, 0x0, 0x0);

   
    CSL_SRIO_SetDataStreamingMTU(m_Handle, 64);

   
    for (I_for = 0; I_for < SRIO_MAX_NUMBER_OF_PORTS; I_for++)
        CSL_SRIO_SetPLMPortPathControlMode(m_Handle, I_for, 0);

    /* Set the LLM Port IP Prescalar. */
    CSL_SRIO_SetLLMPortIPPrescalar(m_Handle, 0x21);

   
    CSL_SRIO_SetBootComplete(m_Handle, 1);

  
    CSL_SRIO_EnablePeripheral(m_Handle);

}

char SRIO_PowerUp()
{

    CSL_PSC_enablePowerDomain(CSL_PSC_PD_SRIO);


    CSL_PSC_setModuleNextState(CSL_PSC_LPSC_SRIO, PSC_MODSTATE_ENABLE);


    CSL_PSC_startStateTransition(CSL_PSC_PD_SRIO);


    while (!CSL_PSC_isStateTransitionDone(CSL_PSC_PD_SRIO));

 
    if ((CSL_PSC_getPowerDomainState(CSL_PSC_PD_SRIO) == PSC_PDSTATE_ON) &&
        (CSL_PSC_getModuleState(CSL_PSC_LPSC_SRIO) == PSC_MODSTATE_ENABLE))
    {
    
        return TRUE;
    }
   
    else
    {
       
        return FALSE;
    }
}