bsp.c

UCOS移植到atmel arm7x256上

  /*
*********************************************************************************************************
*                                            Atmel AT91 SAM7
*                                         Board Support Package
*
*                              (c) Copyright 2004, Micrium, Inc., Weston, FL
*                                          All Rights Reserved
*
*
* File : BSP.C
* By   : Jean J. Labrosse
*********************************************************************************************************
*/

#include <includes.h>

/*
*********************************************************************************************************
*                                              CONSTANTS
*********************************************************************************************************
*/

#define  BSP_XTAL_FREQ                                        18432L   /* onboard crystal frequency (khz) */

#define  BSP_RAM_REMAP_TEST_BYTE             (*(INT8U  *)0x00000030L)

#define  BSP_UNDEF_INSTRUCTION_VECTOR_ADDR   (*(INT32U *)0x00000004L)
#define  BSP_SWI_VECTOR_ADDR                 (*(INT32U *)0x00000008L)
#define  BSP_PREFETCH_ABORT_VECTOR_ADDR      (*(INT32U *)0x0000000CL)
#define  BSP_DATA_ABORT_VECTOR_ADDR          (*(INT32U *)0x00000010L)
#define  BSP_IRQ_VECTOR_ADDR                 (*(INT32U *)0x00000018L)
#define  BSP_FIQ_VECTOR_ADDR                 (*(INT32U *)0x0000001CL)

#define  BSP_IRQ_ISR_ADDR                    (*(INT32U *)0x00000038L)
#define  BSP_FIQ_ISR_ADDR                    (*(INT32U *)0x0000003CL)

/*
*********************************************************************************************************
*                                               DATA TYPES
*********************************************************************************************************
*/

typedef  void (*BSP_PFNCT)(void);

/*
*********************************************************************************************************
*                                              PROTOTYPES
*********************************************************************************************************
*/

static  void  BSP_DummyISR_Handler(void);

static  void  BSP_IntCtrlInit(void);
static  void  PLL_Init(void);

static  void  Tmr_TickInit(void);
static  void  Tmr_TickISR_Handler(void);

/*
*********************************************************************************************************
*                                           DUMMY IRQ HANDLER
*
* Description : This function is called to handle invalid IRQs
*
* Arguments   : none
*********************************************************************************************************
*/

static  void  BSP_DummyISR_Handler (void)
{
    AT91C_BASE_AIC->AIC_IVR = 0;              /* Debug variant of vector read (protect mode is used)   */
}


/*
*********************************************************************************************************
*                                          BSP INITIALIZATION
*
* Description : This function should be called by your application code before you make use of any of the
*               functions found in this module.
*
* Arguments   : none
*********************************************************************************************************
*/

void  BSP_Init (void)
{
    AT91C_BASE_WDTC->WDTC_WDMR = AT91C_WDTC_WDDIS;   /* Disable the Watchdog Timer                     */

    LED_Init();                                      /* Initialize the I/Os for the LEDs               */
    PLL_Init();                                      /* Initialize the PLL and select it for MCLK      */
    BSP_IntCtrlInit();                               /* Initialize the Interrupt Controller            */
    Tmr_TickInit();                                  /* Initialize uC/OS-II's Tick Rate                */
 }

/*
*********************************************************************************************************
*                                          PLL INITIALIZATION
*
* Description : This function initializes the AT91SAM7X256 PLL thereby setting the frequency of MCK
*               which is used by PIT to generate the OS tick interrupt.
*
* Arguments   : none
*********************************************************************************************************
*/

static  void  PLL_Init (void)
{
    AT91C_BASE_WDTC->WDTC_WDMR |= (1 << 15);            /* Disable the watchdog timer                  */
                                                        /* Set the number of flash wait states to 2    */
    AT91C_BASE_MC->MC_FMR      |= (1 << 8);             /* Since we are running > 30mhz out of flash   */

                                                        /* Enable the Main Oscillator                  */
    AT91C_BASE_CKGR->CKGR_MOR   = AT91C_CKGR_OSCOUNT | AT91C_CKGR_MOSCEN;

                                                        /* Wait for the Main Oscillator to start up    */
    while ((AT91C_BASE_PMC->PMC_SR & AT91C_PMC_MOSCS) == 0) {
        ;
    }

    AT91C_BASE_CKGR->CKGR_PLLR  = 0x01033F64;           /* Enable and set PLL to 48MHZ MCK, 48MHZ USB  */

                                                        /* Wait for the PLL to start up                */
    while ((AT91C_BASE_PMC->PMC_SR & AT91C_PMC_LOCK) == 0) {
        ;
    }
                                                         /* Master clock select = PLL w/ no prescaler   */
    AT91C_BASE_PMC->PMC_MCKR    = AT91C_PMC_PRES_CLK | AT91C_PMC_CSS_PLL_CLK;

                                                        /* Wait for the Master Clock (MCK) to start up */
    while ((AT91C_BASE_PMC->PMC_SR & AT91C_PMC_MCKRDY) == 0) {
        ;
    }
}

/*
*********************************************************************************************************
*                                    DETERMINE AND RETURN CPU OPERATING FREQUENCY
*
* Description : This function is called by OSView_c.c : OSView_GetCPUName().
*
* Arguments   : none
* Returns     : INT32U, CPU frequency in khz.
*********************************************************************************************************
*/

INT32U  BSP_CPU_ClkFreq (void)
{
    INT32U cpu_freq;
    INT32U multiplier;
    INT32U divider;

    multiplier = (AT91C_BASE_CKGR->CKGR_PLLR & 0x07FF0000) >> 16;
    divider    = (AT91C_BASE_CKGR->CKGR_PLLR & 0x000000FF) >>  0;

    if (divider == 0) {
        return 0;
    }

    cpu_freq   =  (BSP_XTAL_FREQ * (multiplier + 1)) / divider;

    return cpu_freq;
}

/*
*********************************************************************************************************
*                                    INITIALIZE THE INTERRUPT CONTROLLER
*
* Description : This function is called to disable ALL interrupts.
*
* Arguments   : none
*********************************************************************************************************
*/

static  void  BSP_IntCtrlInit (void)
{
    INT16U  i;


    BSP_RAM_REMAP_TEST_BYTE           =  0xAA;                     /* Write a byte to RAM              */

    if (BSP_RAM_REMAP_TEST_BYTE      ==  0xAA) {                   /* Check if the write to RAM worked */
        AT91C_BASE_MC->MC_RCR         =  1;                        /* If so, toggle REMAP register     */
    }

#ifdef RAM_REMAPPED
    BSP_IRQ_VECTOR_ADDR               =  0xE59FF018;               /* LDR PC,[PC,#0x18] instruction    */
    BSP_IRQ_ISR_ADDR                  =  (INT32U)OS_CPU_IRQ_ISR;   /* IRQ exception vector address     */

    BSP_FIQ_VECTOR_ADDR               =  0xE59FF018;               /* LDR PC,[PC,#0x18] instruction    */
    BSP_FIQ_ISR_ADDR                  =  (INT32U)OS_CPU_FIQ_ISR;   /* FIQ exception vector address     */

    BSP_UNDEF_INSTRUCTION_VECTOR_ADDR =  0xEAFFFFFE;               /* Jump to itself                   */
    BSP_SWI_VECTOR_ADDR               =  0xEAFFFFFE;
    BSP_PREFETCH_ABORT_VECTOR_ADDR    =  0xEAFFFFFE;
    BSP_DATA_ABORT_VECTOR_ADDR        =  0xEAFFFFFE;
    BSP_FIQ_VECTOR_ADDR               =  0xEAFFFFFE;
                                                                   /* - END CODE RUNNING OUT OF RAM -- */
#endif


    AT91C_BASE_AIC->AIC_EOICR         =  0x00000000;               /* End-of-interrupt command         */

    for (i = 0; i < 32; i++) {                                     /* Disable all ISRs                 */
        AT91C_BASE_AIC->AIC_SVR[i] = (INT32U)BSP_DummyISR_Handler;
        AT91C_BASE_AIC->AIC_SMR[i] = 0;
    }
}

/*
*********************************************************************************************************
*                                          DISABLE ALL INTERRUPTS
*
* Description : This function is called to disable ALL interrupts.
*
* Arguments   : none
*********************************************************************************************************
*/

void  BSP_IntDisAll (void)
{
    AT91C_BASE_AIC->AIC_IDCR = 0xFFFFFFFF;                         /* Disable all interrupts           */
}

/*
*********************************************************************************************************
*                                         BSP INITIALIZATION
*
* Description : This function should be called by your application code before you make use of any of the
*               functions found in this module.
*
* Arguments   : none
*********************************************************************************************************
*/

void  LED_Init (void)
{
    AT91C_BASE_PIOB->PIO_PER  = BSP_LED4 | BSP_LED3 | BSP_LED2 | BSP_LED1; /* Enable register          */
    AT91C_BASE_PIOB->PIO_OER  = BSP_LED4 | BSP_LED3 | BSP_LED2 | BSP_LED1; /* Output enable            */
    AT91C_BASE_PIOB->PIO_IDR  = BSP_LED4 | BSP_LED3 | BSP_LED2 | BSP_LED1; /* Disable LED pin interrupt*/
    LED_Off(BSP_LED_ALL);                                                  /* Turn OFF all the LEDs    */
}

/*
*********************************************************************************************************
*                                             LED ON
*
* Description : This function is used to control any or all the LEDs on the board.
*
* Arguments   : led    is the number of the LED to control
*                      0    indicates that you want ALL the LEDs to be ON
*                      1    turns ON LED1 on the board
*                      .
*                      .
*                      4    turns ON LED4 on the board
*********************************************************************************************************
*/

void  LED_On (INT8U led)
{
    switch (led) {
        case 0:
             AT91C_BASE_PIOB->PIO_CODR = BSP_LED4 | BSP_LED3 | BSP_LED2 | BSP_LED1;
             break;

        case 1:
             AT91C_BASE_PIOB->PIO_CODR = BSP_LED1;
             break;

        case 2:
             AT91C_BASE_PIOB->PIO_CODR = BSP_LED2;
             break;

        case 3:
             AT91C_BASE_PIOB->PIO_CODR = BSP_LED3;
             break;

        case 4:
             AT91C_BASE_PIOB->PIO_CODR = BSP_LED4;
             break;
    }
}

/*
*********************************************************************************************************
*                                             LED OFF
*
* Description : This function is used to control any or all the LEDs on the board.
*
* Arguments   : led    is the number of the LED to turn OFF
*                      0    indicates that you want ALL the LEDs to be OFF
*                      1    turns OFF LED1 on the board
*                      .
*                      .
*                      4    turns OFF LED4 on the board
*********************************************************************************************************
*/

void  LED_Off (INT8U led)
{
    switch (led) {
        case 0:
             AT91C_BASE_PIOB->PIO_SODR = BSP_LED4 | BSP_LED3 | BSP_LED2 | BSP_LED1;