654 lines
26 KiB
C
654 lines
26 KiB
C
|
|
#include <common.h>
|
|
#include <mpc8xx.h>
|
|
#include <commproc.h>
|
|
|
|
#include "atm.h"
|
|
#include <linux/stddef.h>
|
|
|
|
#define SYNC __asm__("sync")
|
|
#define ALIGN(p, a) ((char *)(((uint32)(p)+(a)-1) & ~((uint32)(a)-1)))
|
|
|
|
#define FALSE 1
|
|
#define TRUE 0
|
|
#define OK 0
|
|
#define ERROR -1
|
|
|
|
struct atm_connection_t g_conn[NUM_CONNECTIONS] =
|
|
{
|
|
{ NULL, 10, NULL, 10, NULL, NULL, NULL, NULL }, /* OAM */
|
|
};
|
|
|
|
struct atm_driver_t g_atm =
|
|
{
|
|
FALSE, /* loaded */
|
|
FALSE, /* started */
|
|
NULL, /* csram */
|
|
0, /* csram_size */
|
|
NULL, /* am_top */
|
|
NULL, /* ap_top */
|
|
NULL, /* int_reload_ptr */
|
|
NULL, /* int_serv_ptr */
|
|
NULL, /* rbd_base_ptr */
|
|
NULL, /* tbd_base_ptr */
|
|
0 /* linerate */
|
|
};
|
|
|
|
char csram[1024]; /* more than enough for doing nothing*/
|
|
|
|
int atmLoad(void);
|
|
void atmUnload(void);
|
|
int atmMemInit(void);
|
|
void atmIntInit(void);
|
|
void atmApcInit(void);
|
|
void atmAmtInit(void);
|
|
void atmCpmInit(void);
|
|
void atmUtpInit(void);
|
|
|
|
/*****************************************************************************
|
|
*
|
|
* FUNCTION NAME: atmLoad
|
|
*
|
|
* DESCRIPTION: Basic ATM initialization.
|
|
*
|
|
* PARAMETERS: none
|
|
*
|
|
* RETURNS: OK or ERROR
|
|
*
|
|
****************************************************************************/
|
|
int atmLoad()
|
|
{
|
|
volatile immap_t *immap = (immap_t *)CFG_IMMR;
|
|
volatile cpmtimer8xx_t *timers = &immap->im_cpmtimer;
|
|
volatile iop8xx_t *iop = &immap->im_ioport;
|
|
|
|
timers->cpmt_tgcr &= 0x0FFF; SYNC; /* Disable Timer 4 */
|
|
immap->im_cpm.cp_scc[4].scc_gsmrl = 0x0; SYNC; /* Disable SCC4 */
|
|
iop->iop_pdpar &= 0x3FFF; SYNC; /* Disable SAR and UTOPIA */
|
|
|
|
if ( atmMemInit() != OK ) return ERROR;
|
|
|
|
atmIntInit();
|
|
atmApcInit();
|
|
atmAmtInit();
|
|
atmCpmInit();
|
|
atmUtpInit();
|
|
|
|
g_atm.loaded = TRUE;
|
|
|
|
return OK;
|
|
}
|
|
|
|
/*****************************************************************************
|
|
*
|
|
* FUNCTION NAME: atmUnload
|
|
*
|
|
* DESCRIPTION: Disables ATM and UTOPIA.
|
|
*
|
|
* PARAMETERS: none
|
|
*
|
|
* RETURNS: void
|
|
*
|
|
****************************************************************************/
|
|
void atmUnload()
|
|
{
|
|
volatile immap_t *immap = (immap_t *)CFG_IMMR;
|
|
volatile cpmtimer8xx_t *timers = &immap->im_cpmtimer;
|
|
volatile iop8xx_t *iop = &immap->im_ioport;
|
|
|
|
timers->cpmt_tgcr &= 0x0FFF; SYNC; /* Disable Timer 4 */
|
|
immap->im_cpm.cp_scc[4].scc_gsmrl = 0x0; SYNC; /* Disable SCC4 */
|
|
iop->iop_pdpar &= 0x3FFF; SYNC; /* Disable SAR and UTOPIA */
|
|
g_atm.loaded = FALSE;
|
|
}
|
|
|
|
/*****************************************************************************
|
|
*
|
|
* FUNCTION NAME: atmMemInit
|
|
*
|
|
* DESCRIPTION:
|
|
*
|
|
* The ATM driver uses the following resources:
|
|
*
|
|
* A. Memory in DPRAM to hold
|
|
*
|
|
* 1/ CT = Connection Table ( RCT & TCT )
|
|
* 2/ TCTE = Transmit Connection Table Extension
|
|
* 3/ MPHYPT = Multi-PHY Pointing Table
|
|
* 4/ APCP = APC Parameter Table
|
|
* 5/ APCT_PRIO_1 = APC Table ( priority 1 for AAL1/2 )
|
|
* 6/ APCT_PRIO_2 = APC Table ( priority 2 for VBR )
|
|
* 7/ APCT_PRIO_3 = APC Table ( priority 3 for UBR )
|
|
* 8/ TQ = Transmit Queue
|
|
* 9/ AM = Address Matching Table
|
|
* 10/ AP = Address Pointing Table
|
|
*
|
|
* B. Memory in cache safe RAM to hold
|
|
*
|
|
* 1/ INT = Interrupt Queue
|
|
* 2/ RBD = Receive Buffer Descriptors
|
|
* 3/ TBD = Transmit Buffer Descriptors
|
|
*
|
|
* This function
|
|
* 1. clears the ATM DPRAM area,
|
|
* 2. Allocates and clears cache safe memory,
|
|
* 3. Initializes 'g_conn'.
|
|
*
|
|
* PARAMETERS: none
|
|
*
|
|
* RETURNS: OK or ERROR
|
|
*
|
|
****************************************************************************/
|
|
int atmMemInit()
|
|
{
|
|
int i;
|
|
unsigned immr = CFG_IMMR;
|
|
int total_num_rbd = 0;
|
|
int total_num_tbd = 0;
|
|
|
|
memset((char *)CFG_IMMR + 0x2000 + ATM_DPRAM_BEGIN, 0x00, ATM_DPRAM_SIZE);
|
|
|
|
g_atm.csram_size = NUM_INT_ENTRIES * SIZE_OF_INT_ENTRY;
|
|
|
|
for ( i = 0; i < NUM_CONNECTIONS; ++i ) {
|
|
total_num_rbd += g_conn[i].num_rbd;
|
|
total_num_tbd += g_conn[i].num_tbd;
|
|
}
|
|
|
|
g_atm.csram_size += total_num_rbd * SIZE_OF_RBD + total_num_tbd * SIZE_OF_TBD + 4;
|
|
|
|
g_atm.csram = &csram[0];
|
|
memset(&(g_atm.csram), 0x00, g_atm.csram_size);
|
|
|
|
g_atm.int_reload_ptr = (uint32 *)ALIGN(g_atm.csram, 4);
|
|
g_atm.rbd_base_ptr = (struct atm_bd_t *)(g_atm.int_reload_ptr + NUM_INT_ENTRIES);
|
|
g_atm.tbd_base_ptr = (struct atm_bd_t *)(g_atm.rbd_base_ptr + total_num_rbd);
|
|
|
|
g_conn[0].rbd_ptr = g_atm.rbd_base_ptr;
|
|
g_conn[0].tbd_ptr = g_atm.tbd_base_ptr;
|
|
g_conn[0].ct_ptr = CT_PTR(immr);
|
|
g_conn[0].tcte_ptr = TCTE_PTR(immr);
|
|
|
|
return OK;
|
|
}
|
|
|
|
/*****************************************************************************
|
|
*
|
|
* FUNCTION NAME: atmIntInit
|
|
*
|
|
* DESCRIPTION:
|
|
*
|
|
* Initialization of the MPC860 ESAR Interrupt Queue.
|
|
* This function
|
|
* - clears all entries in the INT,
|
|
* - sets the WRAP bit of the last INT entry,
|
|
* - initializes the 'int_serv_ptr' attribuut of the AtmDriver structure
|
|
* to the first INT entry.
|
|
*
|
|
* PARAMETERS: none
|
|
*
|
|
* RETURNS: void
|
|
*
|
|
* REMARKS:
|
|
*
|
|
* - The INT resides in external cache safe memory.
|
|
* - The base address of the INT is stored in g_atm.int_reload_ptr.
|
|
* - The number of entries in the INT is given by NUM_INT_ENTRIES.
|
|
* - The INTBASE field in SAR Parameter RAM is set by atmCpmInit().
|
|
*
|
|
****************************************************************************/
|
|
void atmIntInit()
|
|
{
|
|
int i;
|
|
for ( i = 0; i < NUM_INT_ENTRIES - 1; ++i) g_atm.int_reload_ptr[i] = 0;
|
|
g_atm.int_reload_ptr[i] = INT_WRAP;
|
|
g_atm.int_serv_ptr = g_atm.int_reload_ptr;
|
|
}
|
|
|
|
/*****************************************************************************
|
|
*
|
|
* FUNCTION NAME: atmApcInit
|
|
*
|
|
* DESCRIPTION:
|
|
*
|
|
* This function initializes the following ATM Pace Controller related
|
|
* data structures:
|
|
*
|
|
* - 1 MPHY Pointing Table (contains only one entry)
|
|
* - 3 APC Parameter Tables (one PHY with 3 priorities)
|
|
* - 3 APC Tables (one table for each priority)
|
|
* - 1 Transmit Queue (one transmit queue per PHY)
|
|
*
|
|
* PARAMETERS: none
|
|
*
|
|
* RETURNS: void
|
|
*
|
|
****************************************************************************/
|
|
void atmApcInit()
|
|
{
|
|
int i;
|
|
/* unsigned immr = CFG_IMMR; */
|
|
uint16 * mphypt_ptr = MPHYPT_PTR(CFG_IMMR);
|
|
struct apc_params_t * apcp_ptr = APCP_PTR(CFG_IMMR);
|
|
uint16 * apct_prio1_ptr = APCT1_PTR(CFG_IMMR);
|
|
uint16 * tq_ptr = TQ_PTR(CFG_IMMR);
|
|
/***************************************************/
|
|
/* Initialize MPHY Pointing Table (only one entry) */
|
|
/***************************************************/
|
|
*mphypt_ptr = APCP_BASE;
|
|
|
|
/********************************************/
|
|
/* Initialize APC parameters for priority 1 */
|
|
/********************************************/
|
|
apcp_ptr->apct_base1 = APCT_PRIO_1_BASE;
|
|
apcp_ptr->apct_end1 = APCT_PRIO_1_BASE + NUM_APCT_PRIO_1_ENTRIES * 2;
|
|
apcp_ptr->apct_ptr1 = APCT_PRIO_1_BASE;
|
|
apcp_ptr->apct_sptr1 = APCT_PRIO_1_BASE;
|
|
apcp_ptr->etqbase = TQ_BASE;
|
|
apcp_ptr->etqend = TQ_BASE + ( NUM_TQ_ENTRIES - 1 ) * 2;
|
|
apcp_ptr->etqaptr = TQ_BASE;
|
|
apcp_ptr->etqtptr = TQ_BASE;
|
|
apcp_ptr->apc_mi = 8;
|
|
apcp_ptr->ncits = 0x0100; /* NCITS = 1 */
|
|
apcp_ptr->apcnt = 0;
|
|
apcp_ptr->reserved1 = 0;
|
|
apcp_ptr->eapcst = 0x2009; /* LAST, ESAR, MPHY */
|
|
apcp_ptr->ptp_counter = 0;
|
|
apcp_ptr->ptp_txch = 0;
|
|
apcp_ptr->reserved2 = 0;
|
|
|
|
|
|
/***************************************************/
|
|
/* Initialize APC Tables with empty slots (0xFFFF) */
|
|
/***************************************************/
|
|
for ( i = 0; i < NUM_APCT_PRIO_1_ENTRIES; ++i ) *(apct_prio1_ptr++) = 0xFFFF;
|
|
|
|
/************************/
|
|
/* Clear Transmit Queue */
|
|
/************************/
|
|
for ( i = 0; i < NUM_TQ_ENTRIES; ++i ) *(tq_ptr++) = 0;
|
|
}
|
|
|
|
/*****************************************************************************
|
|
*
|
|
* FUNCTION NAME: atmAmtInit
|
|
*
|
|
* DESCRIPTION:
|
|
*
|
|
* This function clears the first entry in the Address Matching Table and
|
|
* lets the first entry in the Address Pointing table point to the first
|
|
* entry in the TCT table (i.e. the raw cell channel).
|
|
*
|
|
* PARAMETERS: none
|
|
*
|
|
* RETURNS: void
|
|
*
|
|
* REMARKS:
|
|
*
|
|
* The values for the AMBASE, AMEND and APBASE registers in SAR parameter
|
|
* RAM are initialized by atmCpmInit().
|
|
*
|
|
****************************************************************************/
|
|
void atmAmtInit()
|
|
{
|
|
unsigned immr = CFG_IMMR;
|
|
|
|
g_atm.am_top = AM_PTR(immr);
|
|
g_atm.ap_top = AP_PTR(immr);
|
|
|
|
*(g_atm.ap_top--) = CT_BASE;
|
|
*(g_atm.am_top--) = 0;
|
|
}
|
|
|
|
/*****************************************************************************
|
|
*
|
|
* FUNCTION NAME: atmCpmInit
|
|
*
|
|
* DESCRIPTION:
|
|
*
|
|
* This function initializes the Utopia Interface Parameter RAM Map
|
|
* (SCC4, ATM Protocol) of the Communication Processor Modudule.
|
|
*
|
|
* PARAMETERS: none
|
|
*
|
|
* RETURNS: void
|
|
*
|
|
****************************************************************************/
|
|
void atmCpmInit()
|
|
{
|
|
unsigned immr = CFG_IMMR;
|
|
|
|
memset((char *)immr + 0x3F00, 0x00, 0xC0);
|
|
|
|
/*-----------------------------------------------------------------*/
|
|
/* RBDBASE - Receive buffer descriptors base address */
|
|
/* The RBDs reside in cache safe external memory. */
|
|
/*-----------------------------------------------------------------*/
|
|
*RBDBASE(immr) = (uint32)g_atm.rbd_base_ptr;
|
|
|
|
/*-----------------------------------------------------------------*/
|
|
/* SRFCR - SAR receive function code */
|
|
/* 0-2 rsvd = 000 */
|
|
/* 3-4 BO = 11 Byte ordering (big endian). */
|
|
/* 5-7 FC = 000 Value driven on the address type signals AT[1-3] */
|
|
/* when the SDMA channel accesses memory. */
|
|
/*-----------------------------------------------------------------*/
|
|
*SRFCR(immr) = 0x18;
|
|
|
|
/*-----------------------------------------------------------------*/
|
|
/* SRSTATE - SAR receive status */
|
|
/* 0 EXT = 0 Extended mode off. */
|
|
/* 1 ACP = 0 Valid only if EXT = 1. */
|
|
/* 2 EC = 0 Standard 53-byte ATM cell. */
|
|
/* 3 SNC = 0 In sync. Must be set to 0 during initialization. */
|
|
/* 4 ESAR = 1 Enhanced SAR functionality enabled. */
|
|
/* 5 MCF = 1 Management Cell Filter active. */
|
|
/* 6 SER = 0 UTOPIA mode. */
|
|
/* 7 MPY = 1 Multiple PHY mode. */
|
|
/*-----------------------------------------------------------------*/
|
|
*SRSTATE(immr) = 0x0D;
|
|
|
|
/*-----------------------------------------------------------------*/
|
|
/* MRBLR - Maximum receive buffer length register. */
|
|
/* Must be cleared for ATM operation (see also SMRBLR). */
|
|
/*-----------------------------------------------------------------*/
|
|
*MRBLR(immr) = 0;
|
|
|
|
/*-----------------------------------------------------------------*/
|
|
/* RSTATE - SCC internal receive state parameters */
|
|
/* The first byte must be initialized with the value of SRFCR. */
|
|
/*-----------------------------------------------------------------*/
|
|
*RSTATE(immr) = (uint32)(*SRFCR(immr)) << 24;
|
|
|
|
/*-----------------------------------------------------------------*/
|
|
/* STFCR - SAR transmit function code */
|
|
/* 0-2 rsvd = 000 */
|
|
/* 3-4 BO = 11 Byte ordering (big endian). */
|
|
/* 5-7 FC = 000 Value driven on the address type signals AT[1-3] */
|
|
/* when the SDMA channel accesses memory. */
|
|
/*-----------------------------------------------------------------*/
|
|
*STFCR(immr) = 0x18;
|
|
|
|
/*-----------------------------------------------------------------*/
|
|
/* SRSTATE - SAR transmit status */
|
|
/* 0 EXT = 0 : Extended mode off */
|
|
/* 1 rsvd = 0 : */
|
|
/* 2 EC = 0 : Standard 53-byte ATM cell */
|
|
/* 3 rsvd = 0 : */
|
|
/* 4 ESAR = 1 : Enhanced SAR functionality enabled */
|
|
/* 5 rsvd = 0 : */
|
|
/* 6 SER = 0 : UTOPIA mode */
|
|
/* 7 MPY = 1 : Multiple PHY mode */
|
|
/*-----------------------------------------------------------------*/
|
|
*STSTATE(immr) = 0x09;
|
|
|
|
/*-----------------------------------------------------------------*/
|
|
/* TBDBASE - Transmit buffer descriptors base address */
|
|
/* The TBDs reside in cache safe external memory. */
|
|
/*-----------------------------------------------------------------*/
|
|
*TBDBASE(immr) = (uint32)g_atm.tbd_base_ptr;
|
|
|
|
/*-----------------------------------------------------------------*/
|
|
/* TSTATE - SCC internal transmit state parameters */
|
|
/* The first byte must be initialized with the value of STFCR. */
|
|
/*-----------------------------------------------------------------*/
|
|
*TSTATE(immr) = (uint32)(*STFCR(immr)) << 24;
|
|
|
|
/*-----------------------------------------------------------------*/
|
|
/* CTBASE - Connection table base address */
|
|
/* Offset from the beginning of DPRAM (64-byte aligned). */
|
|
/*-----------------------------------------------------------------*/
|
|
*CTBASE(immr) = CT_BASE;
|
|
|
|
/*-----------------------------------------------------------------*/
|
|
/* INTBASE - Interrupt queue base pointer. */
|
|
/* The interrupt queue resides in cache safe external memory. */
|
|
/*-----------------------------------------------------------------*/
|
|
*INTBASE(immr) = (uint32)g_atm.int_reload_ptr;
|
|
|
|
/*-----------------------------------------------------------------*/
|
|
/* INTPTR - Pointer into interrupt queue. */
|
|
/* Initialize to INTBASE. */
|
|
/*-----------------------------------------------------------------*/
|
|
*INTPTR(immr) = *INTBASE(immr);
|
|
|
|
/*-----------------------------------------------------------------*/
|
|
/* C_MASK - Constant mask for CRC32 */
|
|
/* Must be initialized to 0xDEBB20E3. */
|
|
/*-----------------------------------------------------------------*/
|
|
*C_MASK(immr) = 0xDEBB20E3;
|
|
|
|
/*-----------------------------------------------------------------*/
|
|
/* INT_ICNT - Interrupt threshold value */
|
|
/*-----------------------------------------------------------------*/
|
|
*INT_ICNT(immr) = 1;
|
|
|
|
/*-----------------------------------------------------------------*/
|
|
/* INT_CNT - Interrupt counter */
|
|
/* Initalize to INT_ICNT. Decremented for each interrupt entry */
|
|
/* reported in the interrupt queue. On zero an interrupt is */
|
|
/* signaled to the host by setting the GINT bit in the event */
|
|
/* register. The counter is reinitialized with INT_ICNT. */
|
|
/*-----------------------------------------------------------------*/
|
|
*INT_CNT(immr) = *INT_ICNT(immr);
|
|
|
|
/*-----------------------------------------------------------------*/
|
|
/* SMRBLR - SAR maximum receive buffer length register. */
|
|
/* Must be a multiple of 48 bytes. Common for all ATM connections. */
|
|
/*-----------------------------------------------------------------*/
|
|
*SMRBLR(immr) = SAR_RXB_SIZE;
|
|
|
|
/*-----------------------------------------------------------------*/
|
|
/* APCST - APC status register. */
|
|
/* 0 rsvd 0 */
|
|
/* 1-2 CSER 11 Initialize with the same value as NSER. */
|
|
/* 3-4 NSER 11 Next serial or UTOPIA channel. */
|
|
/* 5-7 rsvd 000 */
|
|
/* 8-10 rsvd 000 */
|
|
/* 11 rsvd 0 */
|
|
/* 12 ESAR 1 UTOPIA Level 2 MPHY enabled. */
|
|
/* 13 DIS 0 APC disable. Must be initiazed to 0. */
|
|
/* 14 PL2 0 Not used. */
|
|
/* 15 MPY 1 Multiple PHY mode on. */
|
|
/*-----------------------------------------------------------------*/
|
|
*APCST(immr) = 0x7809;
|
|
|
|
/*-----------------------------------------------------------------*/
|
|
/* APCPTR - Pointer to the APC parameter table */
|
|
/* In MPHY master mode this parameter points to the MPHY pointing */
|
|
/* table. 2-byte aligned. */
|
|
/*-----------------------------------------------------------------*/
|
|
*APCPTR(immr) = MPHYPT_BASE;
|
|
|
|
/*-----------------------------------------------------------------*/
|
|
/* HMASK - Header mask */
|
|
/* Each incoming cell is masked with HMASK before being compared */
|
|
/* to the entries in the address matching table. */
|
|
/*-----------------------------------------------------------------*/
|
|
*HMASK(immr) = AM_HMASK;
|
|
|
|
/*-----------------------------------------------------------------*/
|
|
/* AMBASE - Address matching table base address */
|
|
/*-----------------------------------------------------------------*/
|
|
*AMBASE(immr) = AM_BASE;
|
|
|
|
/*-----------------------------------------------------------------*/
|
|
/* AMEND - Address matching table end address */
|
|
/*-----------------------------------------------------------------*/
|
|
*AMEND(immr) = AM_BASE;
|
|
|
|
/*-----------------------------------------------------------------*/
|
|
/* APBASE - Address pointing table base address */
|
|
/*-----------------------------------------------------------------*/
|
|
*APBASE(immr) = AP_BASE;
|
|
|
|
/*-----------------------------------------------------------------*/
|
|
/* MPHYST - MPHY status register */
|
|
/* 0-1 rsvd 00 */
|
|
/* 2-6 NMPHY 00000 1 PHY */
|
|
/* 7-9 rsvd 000 */
|
|
/* 10-14 CMPHY 00000 Initialize with same value as NMPHY */
|
|
/*-----------------------------------------------------------------*/
|
|
*MPHYST(immr) = 0x0000;
|
|
|
|
/*-----------------------------------------------------------------*/
|
|
/* TCTEBASE - Transmit connection table extension base address */
|
|
/* Offset from the beginning of DPRAM (32-byte aligned). */
|
|
/*-----------------------------------------------------------------*/
|
|
*TCTEBASE(immr) = TCTE_BASE;
|
|
|
|
/*-----------------------------------------------------------------*/
|
|
/* Clear not used registers. */
|
|
/*-----------------------------------------------------------------*/
|
|
}
|
|
|
|
/*****************************************************************************
|
|
*
|
|
* FUNCTION NAME: atmUtpInit
|
|
*
|
|
* DESCRIPTION:
|
|
*
|
|
* This function initializes the ATM interface for
|
|
*
|
|
* - UTOPIA mode
|
|
* - muxed bus
|
|
* - master operation
|
|
* - multi PHY (because of a bug in the MPC860P rev. E.0)
|
|
* - internal clock = SYSCLK / 2
|
|
*
|
|
* EXTERNAL EFFECTS:
|
|
*
|
|
* After calling this function, the MPC860ESAR UTOPIA bus is
|
|
* active and uses the following ports/pins:
|
|
*
|
|
* Port Pin Signal Description
|
|
* ------ --- ------- -------------------------------------------
|
|
* PB[15] R17 TxClav Transmit cell available input/output signal
|
|
* PC[15] D16 RxClav Receive cell available input/output signal
|
|
* PD[15] U17 UTPB[0] UTOPIA bus bit 0 input/output signal
|
|
* PD[14] V19 UTPB[1] UTOPIA bus bit 1 input/output signal
|
|
* PD[13] V18 UTPB[2] UTOPIA bus bit 2 input/output signal
|
|
* PD[12] R16 UTPB[3] UTOPIA bus bit 3 input/output signal
|
|
* PD[11] T16 RXENB Receive enable input/output signal
|
|
* PD[10] W18 TXENB Transmit enable input/output signal
|
|
* PD[9] V17 UTPCLK UTOPIA clock input/output signal
|
|
* PD[7] T15 UTPB[4] UTOPIA bus bit 4 input/output signal
|
|
* PD[6] V16 UTPB[5] UTOPIA bus bit 5 input/output signal
|
|
* PD[5] U15 UTPB[6] UTOPIA bus bit 6 input/output signal
|
|
* PD[4] U16 UTPB[7] UTOPIA bus bit 7 input/output signal
|
|
* PD[3] W16 SOC Start of cell input/output signal
|
|
*
|
|
* PARAMETERS: none
|
|
*
|
|
* RETURNS: void
|
|
*
|
|
* REMARK:
|
|
*
|
|
* The ATM parameters and data structures must be configured before
|
|
* initializing the UTOPIA port. The UTOPIA port activates immediately
|
|
* upon initialization, and if its associated data structures are not
|
|
* initialized, the CPM will lock up.
|
|
*
|
|
****************************************************************************/
|
|
void atmUtpInit()
|
|
{
|
|
volatile immap_t *immap = (immap_t *)CFG_IMMR;
|
|
volatile iop8xx_t *iop = &immap->im_ioport;
|
|
volatile car8xx_t *car = &immap->im_clkrst;
|
|
volatile cpm8xx_t *cpm = &immap->im_cpm;
|
|
int flag;
|
|
|
|
flag = disable_interrupts();
|
|
|
|
/*-----------------------------------------------------------------*/
|
|
/* SCCR - System Clock Control Register */
|
|
/* */
|
|
/* The UTOPIA clock can be selected to be internal clock or */
|
|
/* external clock (selected by the UTOPIA mode register). */
|
|
/* In case of internal clock, the UTOPIA clock is derived from */
|
|
/* the system frequency divided by two dividers. */
|
|
/* Bits 27-31 of the SCCR register are defined to control the */
|
|
/* UTOPIA clock. */
|
|
/* */
|
|
/* SCCR[27:29] DFUTP Division factor. Divide the system clock */
|
|
/* by 2^DFUTP. */
|
|
/* SCCR[30:31] DFAUTP Additional division factor. Divide the */
|
|
/* system clock by the following value: */
|
|
/* 00 = divide by 1 */
|
|
/* 00 = divide by 3 */
|
|
/* 10 = divide by 5 */
|
|
/* 11 = divide by 7 */
|
|
/* */
|
|
/* Note that the UTOPIA clock must be programmed as to operate */
|
|
/* within the range SYSCLK/10 .. 50Mhz. */
|
|
/*-----------------------------------------------------------------*/
|
|
car->car_sccr &= 0xFFFFFFE0;
|
|
car->car_sccr |= 0x00000008; /* UTPCLK = SYSCLK / 4 */
|
|
|
|
/*-----------------------------------------------------------------*/
|
|
/* RCCR - RISC Controller Configuration Register */
|
|
/* */
|
|
/* RCCR[8] DR1M IDMA Request 0 Mode */
|
|
/* 0 = edge sensitive */
|
|
/* 1 = level sensitive */
|
|
/* RCCR[9] DR0M IDMA Request 0 Mode */
|
|
/* 0 = edge sensitive */
|
|
/* 1 = level sensitive */
|
|
/* RCCR[10:11] DRQP IDMA Request Priority */
|
|
/* 00 = IDMA req. have more prio. than SCCs */
|
|
/* 01 = IDMA req. have less prio. then SCCs */
|
|
/* 10 = IDMA requests have the lowest prio. */
|
|
/* 11 = reserved */
|
|
/* */
|
|
/* The RCCR[DR0M] and RCCR[DR1M] bits must be set to enable UTOPIA */
|
|
/* operation. Also, program RCCR[DPQP] to 01 to give SCC transfers */
|
|
/* higher priority. */
|
|
/*-----------------------------------------------------------------*/
|
|
cpm->cp_rccr &= 0xFF0F;
|
|
cpm->cp_rccr |= 0x00D0;
|
|
|
|
/*-----------------------------------------------------------------*/
|
|
/* Port B - TxClav Signal */
|
|
/*-----------------------------------------------------------------*/
|
|
cpm->cp_pbpar |= 0x00010000; /* PBPAR[15] = 1 */
|
|
cpm->cp_pbdir &= 0xFFFEFFFF; /* PBDIR[15] = 0 */
|
|
|
|
/*-----------------------------------------------------------------*/
|
|
/* UTOPIA Mode Register */
|
|
/* */
|
|
/* - muxed bus (master operation only) */
|
|
/* - multi PHY (because of a bug in the MPC860P rev.E.0) */
|
|
/* - internal clock */
|
|
/* - no loopback */
|
|
/* - do no activate statistical counters */
|
|
/*-----------------------------------------------------------------*/
|
|
iop->utmode = 0x00000004; SYNC;
|
|
|
|
/*-----------------------------------------------------------------*/
|
|
/* Port D - UTOPIA Data and Control Signals */
|
|
/* */
|
|
/* 15-12 UTPB[0:3] UTOPIA bus bit 0 - 3 input/output signals */
|
|
/* 11 RXENB UTOPIA receive enable input/output signal */
|
|
/* 10 TXENB UTOPIA transmit enable input/output signal */
|
|
/* 9 TUPCLK UTOPIA clock input/output signal */
|
|
/* 8 MII-MDC Used by MII in simult. MII and UTOPIA operation */
|
|
/* 7-4 UTPB[4:7] UTOPIA bus bit 4 - 7 input/output signals */
|
|
/* 3 SOC UTOPIA Start of cell input/output signal */
|
|
/* 2 Reserved */
|
|
/* 1 Enable UTOPIA mode */
|
|
/* 0 Enable SAR */
|
|
/*-----------------------------------------------------------------*/
|
|
iop->iop_pdpar |= 0xDF7F; SYNC;
|
|
iop->iop_pddir &= 0x2080; SYNC;
|
|
|
|
/*-----------------------------------------------------------------*/
|
|
/* Port C - RxClav Signal */
|
|
/*-----------------------------------------------------------------*/
|
|
iop->iop_pcpar |= 0x0001; /* PCPAR[15] = 1 */
|
|
iop->iop_pcdir &= 0xFFFE; /* PCDIR[15] = 0 */
|
|
iop->iop_pcso &= 0xFFFE; /* PCSO[15] = 0 */
|
|
|
|
if (flag)
|
|
enable_interrupts();
|
|
}
|