summaryrefslogtreecommitdiffstats
path: root/c/src/lib/libbsp/arm/gp32/startup/bspstart.c
blob: 0eca8a93a0feaf4e08520de411a5ca43ca84d7ff (plain) (blame)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
/*
 * This file contains the ARM BSP startup package. It includes application,
 * board, and monitor specific initialization and configuration. The generic CPU
 * dependent initialization has been performed before this routine is invoked.
 *
 *
 * Copyright (c) 2000 Canon Research Centre France SA.
 * Emmanuel Raguet, mailto:raguet@crf.canon.fr
 *
 *   The license and distribution terms for this file may be
 *   found in the file LICENSE in this distribution or at
 *   http://www.rtems.com/license/LICENSE.
 */

#include <bsp.h>
#include <bsp/irq-generic.h>
#include <rtems/bspIo.h>
#include <s3c24xx.h>

/*
 * External Prototypes
 */
extern void rtems_exception_init_mngt(void);

/*
 *  BSP specific Idle task
 */
Thread bsp_idle_task(uint32_t ignored)
{
  while(1) {
    __asm__ volatile ("MCR p15,0,r0,c7,c0,4     \n");
  }
}

/*
 *  BSP Specific Initialization in C
 */
void bsp_start_default( void )
{
  uint32_t cr;
  uint32_t pend,last;
  uint32_t REFCNT;
  int i;

  /* stop RTC */
  #ifdef CPU_S3C2400
    rTICINT = 0x0;
  #else
    rTICNT = 0x0;
  #endif
  /* stop watchdog,ADC and timers */
  rWTCON = 0x0;
  rTCON = 0x0;
  rADCCON = 0x0;

  /* disable interrupts */
  rINTMOD = 0x0;
  rINTMSK = BIT_ALLMSK; /* unmasked by drivers */

  last = 0;
  for(i=0; i<4; i++) {
    pend = rSRCPND;
    if(pend == 0 || pend == last)
      break;
    rSRCPND = pend;
    rINTPND = pend;
    last    = pend;
  }

  /* setup clocks */
  rCLKDIVN = M_CLKDIVN;
  rMPLLCON = ((M_MDIV<<12)+(M_PDIV<<4)+M_SDIV);
  /* setup rREFRESH
   * period = 15.6 us, HCLK=66Mhz, (2048+1-15.6*66)
   */
  REFCNT   = 2048+1-(15.6*get_HCLK()/1000000);
  rREFRESH = ((REFEN<<23)+(TREFMD<<22)+(Trp<<20)+(Trc<<18)+(Tchr<<16)+REFCNT);

  /* set prescaler for timers 2,3,4 to 16(15+1) */
  cr = rTCFG0 & 0xFFFF00FF;
  rTCFG0 = (cr | (15<<8));

  /* set prescaler for timers 0,1 to 1(0+1) */
  cr = rTCFG0 & 0xFFFFFF00;
  rTCFG0 = (cr | (0<<0));

  /*
   * Init rtems exceptions management
   */
  rtems_exception_init_mngt();

  /*
   * Init rtems interrupt management
   */
  if (bsp_interrupt_initialize() != RTEMS_SUCCESSFUL) {
    _CPU_Fatal_halt(0xe);
  }
}

/*
 *  By making this a weak alias for bsp_start_default, a brave soul
 *  can override the actual bsp_start routine used.
 */

void bsp_start (void) __attribute__ ((weak, alias("bsp_start_default")));