hc
2024-12-19 9370bb92b2d16684ee45cf24e879c93c509162da
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
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
/*
 * Copyright (C) 2008, Guennadi Liakhovetski <lg@denx.de>
 *
 * SPDX-License-Identifier:    GPL-2.0+
 */
 
#include <asm/arch/imx-regs.h>
 
.macro REG reg, val
   ldr r2, =\reg
   ldr r3, =\val
   str r3, [r2]
.endm
 
.macro REG8 reg, val
   ldr r2, =\reg
   ldr r3, =\val
   strb r3, [r2]
.endm
 
.macro DELAY loops
   ldr r2, =\loops
1:
   subs    r2, r2, #1
   nop
   bcs 1b
.endm
 
/* RedBoot: AIPS setup - Only setup MPROTx registers.
 * The PACR default values are good.*/
.macro init_aips
   /*
    * Set all MPROTx to be non-bufferable, trusted for R/W,
    * not forced to user-mode.
    */
   ldr r0, =0x43F00000
   ldr r1, =0x77777777
   str r1, [r0, #0x00]
   str r1, [r0, #0x04]
   ldr r0, =0x53F00000
   str r1, [r0, #0x00]
   str r1, [r0, #0x04]
 
   /*
    * Clear the on and off peripheral modules Supervisor Protect bit
    * for SDMA to access them. Did not change the AIPS control registers
    * (offset 0x20) access type
    */
   ldr r0, =0x43F00000
   ldr r1, =0x0
   str r1, [r0, #0x40]
   str r1, [r0, #0x44]
   str r1, [r0, #0x48]
   str r1, [r0, #0x4C]
   ldr r1, [r0, #0x50]
   and r1, r1, #0x00FFFFFF
   str r1, [r0, #0x50]
 
   ldr r0, =0x53F00000
   ldr r1, =0x0
   str r1, [r0, #0x40]
   str r1, [r0, #0x44]
   str r1, [r0, #0x48]
   str r1, [r0, #0x4C]
   ldr r1, [r0, #0x50]
   and r1, r1, #0x00FFFFFF
   str r1, [r0, #0x50]
.endm /* init_aips */
 
/* RedBoot: MAX (Multi-Layer AHB Crossbar Switch) setup */
.macro init_max
   ldr r0, =0x43F04000
   /* MPR - priority is M4 > M2 > M3 > M5 > M0 > M1 */
   ldr r1, =0x00302154
   str r1, [r0, #0x000]        /* for S0 */
   str r1, [r0, #0x100]        /* for S1 */
   str r1, [r0, #0x200]        /* for S2 */
   str r1, [r0, #0x300]        /* for S3 */
   str r1, [r0, #0x400]        /* for S4 */
   /* SGPCR - always park on last master */
   ldr r1, =0x10
   str r1, [r0, #0x010]        /* for S0 */
   str r1, [r0, #0x110]        /* for S1 */
   str r1, [r0, #0x210]        /* for S2 */
   str r1, [r0, #0x310]        /* for S3 */
   str r1, [r0, #0x410]        /* for S4 */
   /* MGPCR - restore default values */
   ldr r1, =0x0
   str r1, [r0, #0x800]        /* for M0 */
   str r1, [r0, #0x900]        /* for M1 */
   str r1, [r0, #0xA00]        /* for M2 */
   str r1, [r0, #0xB00]        /* for M3 */
   str r1, [r0, #0xC00]        /* for M4 */
   str r1, [r0, #0xD00]        /* for M5 */
.endm /* init_max */
 
/* RedBoot: M3IF setup */
.macro init_m3if
   /* Configure M3IF registers */
   ldr r1, =0xB8003000
   /*
   * M3IF Control Register (M3IFCTL)
   * MRRP[0] = L2CC0 not on priority list (0 << 0)    = 0x00000000
   * MRRP[1] = L2CC1 not on priority list (0 << 0)    = 0x00000000
   * MRRP[2] = MBX not on priority list (0 << 0)    = 0x00000000
   * MRRP[3] = MAX1 not on priority list (0 << 0)    = 0x00000000
   * MRRP[4] = SDMA not on priority list (0 << 0)    = 0x00000000
   * MRRP[5] = MPEG4 not on priority list (0 << 0)    = 0x00000000
   * MRRP[6] = IPU1 on priority list (1 << 6)    = 0x00000040
   * MRRP[7] = IPU2 not on priority list (0 << 0)    = 0x00000000
   *                        ------------
   *                          0x00000040
   */
   ldr r0, =0x00000040
   str r0, [r1]  /* M3IF control reg */
.endm /* init_m3if */
 
/* RedBoot: To support 133MHz DDR */
.macro  init_drive_strength
   /*
    * Disable maximum drive strength SDRAM/DDR lines by clearing DSE1 bits
    * in SW_PAD_CTL registers
    */
 
   /* SDCLK */
   ldr r1, =0x43FAC200
   ldr r0, [r1, #0x6C]
   bic r0, r0, #(1 << 12)
   str r0, [r1, #0x6C]
 
   /* CAS */
   ldr r0, [r1, #0x70]
   bic r0, r0, #(1 << 22)
   str r0, [r1, #0x70]
 
   /* RAS */
   ldr r0, [r1, #0x74]
   bic r0, r0, #(1 << 2)
   str r0, [r1, #0x74]
 
   /* CS2 (CSD0) */
   ldr r0, [r1, #0x7C]
   bic r0, r0, #(1 << 22)
   str r0, [r1, #0x7C]
 
   /* DQM3 */
   ldr r0, [r1, #0x84]
   bic r0, r0, #(1 << 22)
   str r0, [r1, #0x84]
 
   /* DQM2, DQM1, DQM0, SD31-SD0, A25-A0, MA10 (0x288..0x2DC) */
   ldr r2, =22    /* (0x2E0 - 0x288) / 4 = 22 */
pad_loop:
   ldr r0, [r1, #0x88]
   bic r0, r0, #(1 << 22)
   bic r0, r0, #(1 << 12)
   bic r0, r0, #(1 << 2)
   str r0, [r1, #0x88]
   add r1, r1, #4
   subs r2, r2, #0x1
   bne pad_loop
.endm /* init_drive_strength */
 
/* CPLD on CS4 setup */
.macro init_cs4
   ldr r0, =WEIM_BASE
   ldr r1, =0x0000D843
   str r1, [r0, #0x40]
   ldr r1, =0x22252521
   str r1, [r0, #0x44]
   ldr r1, =0x22220A00
   str r1, [r0, #0x48]
.endm /* init_cs4 */
 
.globl lowlevel_init
lowlevel_init:
 
   /* Redboot initializes very early AIPS, what for?
    * Then it also initializes Multi-Layer AHB Crossbar Switch,
    * M3IF */
   /* Also setup the Peripheral Port Remap register inside the core */
   ldr r0, =0x40000015        /* start from AIPS 2GB region */
   mcr p15, 0, r0, c15, c2, 4
 
   init_aips
 
   init_max
 
   init_m3if
 
   init_drive_strength
 
   init_cs4
 
   /* Image Processing Unit: */
   /* Too early to switch display on? */
   REG    IPU_CONF, IPU_CONF_DI_EN    /* Switch on Display Interface */
   /* Clock Control Module: */
   REG    CCM_CCMR, 0x074B0BF5        /* Use CKIH, MCU PLL off */
 
   DELAY 0x40000
 
   REG    CCM_CCMR, 0x074B0BF5 | CCMR_MPE            /* MCU PLL on */
   REG    CCM_CCMR, (0x074B0BF5 | CCMR_MPE) & ~CCMR_MDS    /* Switch to MCU PLL */
 
   /* PBC CPLD on CS4 */
   mov    r1, #CS4_BASE
   ldrh    r1, [r1, #0x2]
   /* Is 27MHz switch set? */
   ands    r1, r1, #0x10
 
   /* 532-133-66.5 */
   ldr    r0, =CCM_BASE
   ldr    r1, =0xFF871D58
   /* PDR0 */
   str    r1, [r0, #0x4]
   ldreq    r1, MPCTL_PARAM_532
   ldrne    r1, MPCTL_PARAM_532_27
   /* MPCTL */
   str    r1, [r0, #0x10]
 
   /* Set UPLL=240MHz, USB=60MHz */
   ldr    r1, =0x49FCFE7F
   /* PDR1 */
   str    r1, [r0, #0x8]
   ldreq    r1, UPCTL_PARAM_240
   ldrne    r1, UPCTL_PARAM_240_27
   /* UPCTL */
   str    r1, [r0, #0x14]
   /* default CLKO to 1/8 of the ARM core */
   mov    r1, #0x000002C0
   add    r1, r1, #0x00000006
   /* COSR */
   str    r1, [r0, #0x1c]
 
   /* RedBoot sets 0x3f, 7, 7, 3, 5, 1, 3, 0 */
/*    REG    CCM_PDR0, PDR0_CSI_PODF(0x3f) | PDR0_CSI_PRDF(7) | PDR0_PER_PODF(7) | PDR0_HSP_PODF(2) | PDR0_NFC_PODF(6) | PDR0_IPG_PODF(1) | PDR0_MAX_PODF(2) | PDR0_MCU_PODF(0)*/
 
   /* Redboot: 0, 51, 10, 12 / 0, 14, 9, 13 */
/*    REG    CCM_MPCTL, PLL_PD(0) | PLL_MFD(0x33) | PLL_MFI(7) | PLL_MFN(0x23)*/
   /* Default: 1, 4, 12, 1 */
   REG    CCM_SPCTL, PLL_PD(1) | PLL_MFD(4) | PLL_MFI(12) | PLL_MFN(1)
 
   /* B8xxxxxx - NAND, 8xxxxxxx - CSD0 RAM */
   REG    0xB8001010, 0x00000004
   REG    0xB8001004, 0x006ac73a
   REG    0xB8001000, 0x92100000
   REG    0x80000f00, 0x12344321
   REG    0xB8001000, 0xa2100000
   REG    0x80000000, 0x12344321
   REG    0x80000000, 0x12344321
   REG    0xB8001000, 0xb2100000
   REG8    0x80000033, 0xda
   REG8    0x81000000, 0xff
   REG    0xB8001000, 0x82226080
   REG    0x80000000, 0xDEADBEEF
   REG    0xB8001010, 0x0000000c
 
   mov    pc, lr
 
MPCTL_PARAM_532:
   .word (((1-1) << 26) + ((52-1) << 16) + (10 << 10) + (12 << 0))
MPCTL_PARAM_532_27:
   .word (((1-1) << 26) + ((15-1) << 16) + (9  << 10) + (13 << 0))
UPCTL_PARAM_240:
   .word (((2-1) << 26) + ((13-1) << 16) + (9  << 10) + (3  << 0))
UPCTL_PARAM_240_27:
   .word (((2-1) << 26) + ((9 -1) << 16) + (8  << 10) + (8  << 0))