1
2
3
4
5
6
7
8
9
10
11
12#define BFIN_IN_INITCODE
13
14#include <config.h>
15#include <asm/blackfin.h>
16#include <asm/mach-common/bits/watchdog.h>
17#include <asm/mach-common/bits/bootrom.h>
18#include <asm/mach-common/bits/core.h>
19#include <asm/serial.h>
20
21#ifndef __ADSPBF60x__
22#include <asm/mach-common/bits/ebiu.h>
23#include <asm/mach-common/bits/pll.h>
24#else
25#include <asm/mach-common/bits/cgu.h>
26
27#define CONFIG_BFIN_GET_DCLK_M \
28 ((CONFIG_CLKIN_HZ*CONFIG_VCO_MULT)/(CONFIG_DCLK_DIV*1000000))
29
30#ifndef CONFIG_DMC_DDRCFG
31#if ((CONFIG_BFIN_GET_DCLK_M != 125) && \
32 (CONFIG_BFIN_GET_DCLK_M != 133) && \
33 (CONFIG_BFIN_GET_DCLK_M != 150) && \
34 (CONFIG_BFIN_GET_DCLK_M != 166) && \
35 (CONFIG_BFIN_GET_DCLK_M != 200) && \
36 (CONFIG_BFIN_GET_DCLK_M != 225) && \
37 (CONFIG_BFIN_GET_DCLK_M != 250))
38#error "DDR2 CLK must be in (125, 133, 150, 166, 200, 225, 250)MHz"
39#endif
40#endif
41
42
43#define SRREQ 0x8
44
45
46#define IDLE 0x1
47#define MEMINITDONE 0x4
48#define SRACK 0x8
49#define PDACK 0x10
50#define DPDACK 0x20
51#define DLLCALDONE 0x2000
52#define PENDREF 0xF0000
53#define PHYRDPHASE 0xF00000
54#define PHYRDPHASE_OFFSET 20
55
56
57#define DLLCALRDCNT 0xFF
58#define DATACYC_OFFSET 8
59
60struct ddr_config {
61 u32 ddr_clk;
62 u32 dmc_ddrctl;
63 u32 dmc_ddrcfg;
64 u32 dmc_ddrtr0;
65 u32 dmc_ddrtr1;
66 u32 dmc_ddrtr2;
67 u32 dmc_ddrmr;
68 u32 dmc_ddrmr1;
69};
70
71static struct ddr_config ddr_config_table[] = {
72 [0] = {
73 .ddr_clk = 125,
74 .dmc_ddrctl = 0x00000904,
75 .dmc_ddrcfg = 0x00000422,
76 .dmc_ddrtr0 = 0x20705212,
77 .dmc_ddrtr1 = 0x201003CF,
78 .dmc_ddrtr2 = 0x00320107,
79 .dmc_ddrmr = 0x00000422,
80 .dmc_ddrmr1 = 0x4,
81 },
82 [1] = {
83 .ddr_clk = 133,
84 .dmc_ddrctl = 0x00000904,
85 .dmc_ddrcfg = 0x00000422,
86 .dmc_ddrtr0 = 0x20806313,
87 .dmc_ddrtr1 = 0x2013040D,
88 .dmc_ddrtr2 = 0x00320108,
89 .dmc_ddrmr = 0x00000632,
90 .dmc_ddrmr1 = 0x4,
91 },
92 [2] = {
93 .ddr_clk = 150,
94 .dmc_ddrctl = 0x00000904,
95 .dmc_ddrcfg = 0x00000422,
96 .dmc_ddrtr0 = 0x20A07323,
97 .dmc_ddrtr1 = 0x20160492,
98 .dmc_ddrtr2 = 0x00320209,
99 .dmc_ddrmr = 0x00000632,
100 .dmc_ddrmr1 = 0x4,
101 },
102 [3] = {
103 .ddr_clk = 166,
104 .dmc_ddrctl = 0x00000904,
105 .dmc_ddrcfg = 0x00000422,
106 .dmc_ddrtr0 = 0x20A07323,
107 .dmc_ddrtr1 = 0x2016050E,
108 .dmc_ddrtr2 = 0x00320209,
109 .dmc_ddrmr = 0x00000632,
110 .dmc_ddrmr1 = 0x4,
111 },
112 [4] = {
113 .ddr_clk = 200,
114 .dmc_ddrctl = 0x00000904,
115 .dmc_ddrcfg = 0x00000422,
116 .dmc_ddrtr0 = 0x20a07323,
117 .dmc_ddrtr1 = 0x2016050f,
118 .dmc_ddrtr2 = 0x00320509,
119 .dmc_ddrmr = 0x00000632,
120 .dmc_ddrmr1 = 0x4,
121 },
122 [5] = {
123 .ddr_clk = 225,
124 .dmc_ddrctl = 0x00000904,
125 .dmc_ddrcfg = 0x00000422,
126 .dmc_ddrtr0 = 0x20E0A424,
127 .dmc_ddrtr1 = 0x302006DB,
128 .dmc_ddrtr2 = 0x0032020D,
129 .dmc_ddrmr = 0x00000842,
130 .dmc_ddrmr1 = 0x4,
131 },
132 [6] = {
133 .ddr_clk = 250,
134 .dmc_ddrctl = 0x00000904,
135 .dmc_ddrcfg = 0x00000422,
136 .dmc_ddrtr0 = 0x20E0A424,
137 .dmc_ddrtr1 = 0x3020079E,
138 .dmc_ddrtr2 = 0x0032050D,
139 .dmc_ddrmr = 0x00000842,
140 .dmc_ddrmr1 = 0x4,
141 },
142};
143#endif
144
145__attribute__((always_inline))
146static inline void serial_init(void)
147{
148#if defined(__ADSPBF54x__) || defined(__ADSPBF60x__)
149# ifdef BFIN_BOOT_UART_USE_RTS
150# define BFIN_UART_USE_RTS 1
151# else
152# define BFIN_UART_USE_RTS 0
153# endif
154 if (BFIN_UART_USE_RTS && CONFIG_BFIN_BOOT_MODE == BFIN_BOOT_UART) {
155 uint32_t uart_base = UART_BASE;
156 size_t i;
157
158
159#if BFIN_UART_HW_VER < 4
160 bfin_write16(&pUART->mcr, bfin_read16(&pUART->mcr) | FCPOL);
161#else
162 bfin_write32(&pUART->control, bfin_read32(&pUART->control) |
163 FCPOL);
164#endif
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181#define _NUMBITS (10)
182#define _LOWBAUD (9600)
183#define _SCLK ((0x14 * CONFIG_CLKIN_HZ) / 5)
184#define _DIVISOR ((_SCLK / _LOWBAUD) / 16)
185#define _NUMINS (3)
186#define _CCLK (((16 * _DIVISOR * 5) * (_LOWBAUD / _NUMBITS)) / _NUMINS)
187 i = _CCLK;
188 while (i--)
189 asm volatile("" : : : "memory");
190 }
191#endif
192
193#if CONFIG_BFIN_BOOT_MODE != BFIN_BOOT_BYPASS
194 if (BFIN_DEBUG_EARLY_SERIAL) {
195 serial_early_init(UART_BASE);
196 serial_early_set_baud(UART_BASE, CONFIG_BAUDRATE);
197 }
198#endif
199}
200
201__attribute__((always_inline))
202static inline void serial_deinit(void)
203{
204#if defined(__ADSPBF54x__) || defined(__ADSPBF60x__)
205 uint32_t uart_base = UART_BASE;
206
207 if (BFIN_UART_USE_RTS && CONFIG_BFIN_BOOT_MODE == BFIN_BOOT_UART) {
208
209#if BFIN_UART_HW_VER < 4
210 bfin_write16(&pUART->mcr, bfin_read16(&pUART->mcr) & ~FCPOL);
211#else
212 bfin_write32(&pUART->control, bfin_read32(&pUART->control) &
213 ~FCPOL);
214#endif
215 }
216#endif
217}
218
219__attribute__((always_inline))
220static inline void serial_putc(char c)
221{
222 uint32_t uart_base = UART_BASE;
223
224 if (!BFIN_DEBUG_EARLY_SERIAL)
225 return;
226
227 if (c == '\n')
228 serial_putc('\r');
229
230 bfin_write(&pUART->thr, c);
231
232 while (!(_lsr_read(pUART) & TEMT))
233 continue;
234}
235
236#include "initcode.h"
237
238__attribute__((always_inline)) static inline void
239program_nmi_handler(void)
240{
241 u32 tmp1, tmp2;
242
243
244
245
246 if (CONFIG_BFIN_BOOT_MODE != BFIN_BOOT_BYPASS && !ANOMALY_05000219)
247 return;
248
249 asm volatile (
250 "%0 = RETS;"
251 "CALL 1f;"
252 "RTN;"
253 "1:"
254 "%1 = RETS;"
255 "RETS = %0;"
256 "[%2] = %1;"
257 : "=d"(tmp1), "=d"(tmp2)
258 : "ab"(EVT2)
259 );
260}
261
262
263
264
265
266#if !defined(CONFIG_SPI_FLASH_SLOW_READ) && \
267 ((defined(__ADSPBF52x__) && __SILICON_REVISION__ >= 2) || \
268 (defined(__ADSPBF54x__) && __SILICON_REVISION__ >= 1))
269# define BOOTROM_SUPPORTS_SPI_FAST_READ 1
270#else
271# define BOOTROM_SUPPORTS_SPI_FAST_READ 0
272#endif
273#ifndef CONFIG_SPI_BAUD_INITBLOCK
274# define CONFIG_SPI_BAUD_INITBLOCK (BOOTROM_SUPPORTS_SPI_FAST_READ ? 2 : 4)
275#endif
276#ifdef SPI0_BAUD
277# define bfin_write_SPI_BAUD bfin_write_SPI0_BAUD
278#endif
279
280#ifdef __ADSPBF60x__
281
282#ifndef CONFIG_CGU_CTL_VAL
283# define CONFIG_CGU_CTL_VAL ((CONFIG_VCO_MULT << 8) | CONFIG_CLKIN_HALF)
284#endif
285
286#ifndef CONFIG_CGU_DIV_VAL
287# define CONFIG_CGU_DIV_VAL \
288 ((CONFIG_CCLK_DIV << CSEL_P) | \
289 (CONFIG_SCLK0_DIV << S0SEL_P) | \
290 (CONFIG_SCLK_DIV << SYSSEL_P) | \
291 (CONFIG_SCLK1_DIV << S1SEL_P) | \
292 (CONFIG_DCLK_DIV << DSEL_P) | \
293 (CONFIG_OCLK_DIV << OSEL_P))
294#endif
295
296#else
297
298
299#ifndef CONFIG_PLL_DIV_VAL
300# if (CONFIG_CCLK_DIV == 1)
301# define CONFIG_CCLK_ACT_DIV CCLK_DIV1
302# elif (CONFIG_CCLK_DIV == 2)
303# define CONFIG_CCLK_ACT_DIV CCLK_DIV2
304# elif (CONFIG_CCLK_DIV == 4)
305# define CONFIG_CCLK_ACT_DIV CCLK_DIV4
306# elif (CONFIG_CCLK_DIV == 8)
307# define CONFIG_CCLK_ACT_DIV CCLK_DIV8
308# else
309# define CONFIG_CCLK_ACT_DIV CONFIG_CCLK_DIV_not_defined_properly
310# endif
311# define CONFIG_PLL_DIV_VAL (CONFIG_CCLK_ACT_DIV | CONFIG_SCLK_DIV)
312#endif
313
314#ifndef CONFIG_PLL_LOCKCNT_VAL
315# define CONFIG_PLL_LOCKCNT_VAL 0x0300
316#endif
317
318#ifndef CONFIG_PLL_CTL_VAL
319# define CONFIG_PLL_CTL_VAL (SPORT_HYST | (CONFIG_VCO_MULT << 9) | CONFIG_CLKIN_HALF)
320#endif
321
322
323#ifndef CONFIG_VR_CTL_VAL
324# define BFIN_CCLK ((CONFIG_CLKIN_HZ * CONFIG_VCO_MULT) / CONFIG_CCLK_DIV)
325# if defined(__ADSPBF533__) || defined(__ADSPBF532__) || defined(__ADSPBF531__)
326# define CCLK_VLEV_120 400000000
327# define CCLK_VLEV_125 533000000
328# elif defined(__ADSPBF537__) || defined(__ADSPBF536__) || defined(__ADSPBF534__)
329# define CCLK_VLEV_120 401000000
330# define CCLK_VLEV_125 401000000
331# elif defined(__ADSPBF561__)
332# define CCLK_VLEV_120 300000000
333# define CCLK_VLEV_125 501000000
334# endif
335# if BFIN_CCLK < CCLK_VLEV_120
336# define CONFIG_VR_CTL_VLEV VLEV_120
337# elif BFIN_CCLK < CCLK_VLEV_125
338# define CONFIG_VR_CTL_VLEV VLEV_125
339# else
340# define CONFIG_VR_CTL_VLEV VLEV_130
341# endif
342# if defined(__ADSPBF52x__)
343# undef CONFIG_VR_CTL_VLEV
344# define CONFIG_VR_CTL_VLEV VLEV_110
345# elif defined(__ADSPBF54x__)
346# undef CONFIG_VR_CTL_VLEV
347# define CONFIG_VR_CTL_VLEV VLEV_120
348# elif defined(__ADSPBF538__) || defined(__ADSPBF539__)
349# undef CONFIG_VR_CTL_VLEV
350# define CONFIG_VR_CTL_VLEV VLEV_125
351# endif
352
353# ifdef CONFIG_BFIN_MAC
354# define CONFIG_VR_CTL_CLKBUF CLKBUFOE
355# else
356# define CONFIG_VR_CTL_CLKBUF 0
357# endif
358
359# if defined(__ADSPBF52x__)
360# define CONFIG_VR_CTL_FREQ FREQ_1000
361# else
362# define CONFIG_VR_CTL_FREQ (GAIN_20 | FREQ_1000)
363# endif
364
365# define CONFIG_VR_CTL_VAL (CONFIG_VR_CTL_CLKBUF | CONFIG_VR_CTL_VLEV | CONFIG_VR_CTL_FREQ)
366#endif
367
368
369#if defined(__ADSPBF51x__)
370# define CONFIG_HAS_VR 0
371# undef CONFIG_VR_CTL_VAL
372# define CONFIG_VR_CTL_VAL 0
373#else
374# define CONFIG_HAS_VR 1
375#endif
376
377#if CONFIG_MEM_SIZE
378#ifndef EBIU_RSTCTL
379
380#ifndef CONFIG_EBIU_SDBCTL_VAL
381# if CONFIG_MEM_SIZE == 16
382# define CONFIG_EBSZ_VAL EBSZ_16
383# elif CONFIG_MEM_SIZE == 32
384# define CONFIG_EBSZ_VAL EBSZ_32
385# elif CONFIG_MEM_SIZE == 64
386# define CONFIG_EBSZ_VAL EBSZ_64
387# elif CONFIG_MEM_SIZE == 128
388# define CONFIG_EBSZ_VAL EBSZ_128
389# elif CONFIG_MEM_SIZE == 256
390# define CONFIG_EBSZ_VAL EBSZ_256
391# elif CONFIG_MEM_SIZE == 512
392# define CONFIG_EBSZ_VAL EBSZ_512
393# else
394# error You need to define CONFIG_EBIU_SDBCTL_VAL or CONFIG_MEM_SIZE
395# endif
396# if CONFIG_MEM_ADD_WDTH == 8
397# define CONFIG_EBCAW_VAL EBCAW_8
398# elif CONFIG_MEM_ADD_WDTH == 9
399# define CONFIG_EBCAW_VAL EBCAW_9
400# elif CONFIG_MEM_ADD_WDTH == 10
401# define CONFIG_EBCAW_VAL EBCAW_10
402# elif CONFIG_MEM_ADD_WDTH == 11
403# define CONFIG_EBCAW_VAL EBCAW_11
404# else
405# error You need to define CONFIG_EBIU_SDBCTL_VAL or CONFIG_MEM_ADD_WDTH
406# endif
407# define CONFIG_EBIU_SDBCTL_VAL (CONFIG_EBCAW_VAL | CONFIG_EBSZ_VAL | EBE)
408#endif
409#endif
410#endif
411
412
413
414
415#if ANOMALY_05000362
416# if ((CONFIG_EBIU_SDBCTL_VAL & 0x30000000) >> 8) != (CONFIG_EBIU_SDBCTL_VAL & 0x00300000)
417# error "Anomaly 05000362: EB2CAW and EB3CAW must be the same"
418# endif
419#endif
420
421#endif
422
423__attribute__((always_inline)) static inline void
424program_early_devices(ADI_BOOT_DATA *bs, uint *sdivB, uint *divB, uint *vcoB)
425{
426 serial_putc('a');
427
428
429 if (BFIN_DEBUG_EARLY_SERIAL || CONFIG_BFIN_BOOT_MODE == BFIN_BOOT_UART) {
430 serial_putc('b');
431#ifdef __ADSPBF60x__
432 *sdivB = bfin_read_CGU_DIV();
433 *sdivB = ((*sdivB >> 8) & 0x1f) * ((*sdivB >> 5) & 0x7);
434 *vcoB = (bfin_read_CGU_CTL() >> 8) & 0x7f;
435#else
436 *sdivB = bfin_read_PLL_DIV() & 0xf;
437 *vcoB = (bfin_read_PLL_CTL() >> 9) & 0x3f;
438#endif
439 *divB = serial_early_get_div();
440 serial_putc('c');
441 }
442
443 serial_putc('d');
444
445#ifdef CONFIG_HW_WATCHDOG
446# ifndef CONFIG_HW_WATCHDOG_TIMEOUT_INITCODE
447# define CONFIG_HW_WATCHDOG_TIMEOUT_INITCODE 20000
448# endif
449
450
451
452
453
454
455 if (CONFIG_BFIN_BOOT_MODE != BFIN_BOOT_BYPASS) {
456 serial_putc('e');
457#ifdef __ADSPBF60x__
458
459 bfin_write_SEC_GCTL(0x2);
460 bfin_write_SEC_CCTL(0x2);
461 SSYNC();
462
463
464
465
466 bfin_write_SEC_FCTL(0xc1);
467
468 bfin_write_SEC_SCTL(2, bfin_read_SEC_SCTL(2) | 0x6);
469 SSYNC();
470
471
472 bfin_write_SEC_GCTL(0x1);
473 bfin_write_SEC_CCTL(0x1);
474 SSYNC();
475#endif
476 bfin_write_WDOG_CTL(WDDIS);
477 SSYNC();
478 bfin_write_WDOG_CNT(MSEC_TO_SCLK(CONFIG_HW_WATCHDOG_TIMEOUT_INITCODE));
479#if CONFIG_BFIN_BOOT_MODE != BFIN_BOOT_UART
480 bfin_write_WDOG_CTL(WDEN);
481#endif
482 serial_putc('f');
483 }
484#endif
485
486 serial_putc('g');
487
488
489
490
491
492
493#ifdef SPI_BAUD
494 if (CONFIG_BFIN_BOOT_MODE == BFIN_BOOT_SPI_MASTER) {
495 serial_putc('h');
496 if (BOOTROM_SUPPORTS_SPI_FAST_READ && CONFIG_SPI_BAUD_INITBLOCK < 4)
497 bs->dFlags |= BFLAG_FASTREAD;
498 bfin_write_SPI_BAUD(CONFIG_SPI_BAUD_INITBLOCK);
499 serial_putc('i');
500 }
501#endif
502
503 serial_putc('j');
504}
505
506__attribute__((always_inline)) static inline bool
507maybe_self_refresh(ADI_BOOT_DATA *bs)
508{
509 serial_putc('a');
510
511 if (!CONFIG_MEM_SIZE)
512 return false;
513
514#ifdef __ADSPBF60x__
515
516 if ((bfin_read32(DPM0_STAT) & 0xF0) == 0x50) {
517 serial_putc('b');
518 return false;
519 }
520
521#else
522
523
524#if defined(EBIU_RSTCTL)
525 if (bfin_read_EBIU_RSTCTL() & DDR_SRESET) {
526 serial_putc('b');
527 bfin_write_EBIU_RSTCTL(bfin_read_EBIU_RSTCTL() | SRREQ);
528 return true;
529 }
530#elif defined(EBIU_SDGCTL)
531 if (bfin_read_EBIU_SDBCTL() & EBE) {
532 serial_putc('b');
533 bfin_write_EBIU_SDGCTL(bfin_read_EBIU_SDGCTL() | SRFS);
534 return true;
535 }
536#endif
537
538#endif
539 serial_putc('c');
540
541 return false;
542}
543
544__attribute__((always_inline)) static inline u16
545program_clocks(ADI_BOOT_DATA *bs, bool put_into_srfs)
546{
547 u16 vr_ctl = 0;
548
549 serial_putc('a');
550
551#ifdef __ADSPBF60x__
552 if (bfin_read_DMC0_STAT() & MEMINITDONE) {
553 bfin_write_DMC0_CTL(bfin_read_DMC0_CTL() | SRREQ);
554 SSYNC();
555 while (!(bfin_read_DMC0_STAT() & SRACK))
556 continue;
557 }
558
559
560 if ((bfin_read_CGU_CTL() & (MSEL_MASK | DF_MASK))
561 != CONFIG_CGU_CTL_VAL) {
562 bfin_write_CGU_DIV(CONFIG_CGU_DIV_VAL);
563 bfin_write_CGU_CTL(CONFIG_CGU_CTL_VAL);
564 while ((bfin_read_CGU_STAT() & (CLKSALGN | PLLBP)) ||
565 !(bfin_read_CGU_STAT() & PLLLK))
566 continue;
567 }
568
569 bfin_write_CGU_DIV(CONFIG_CGU_DIV_VAL | UPDT);
570 while (bfin_read_CGU_STAT() & CLKSALGN)
571 continue;
572
573 if (bfin_read_DMC0_STAT() & MEMINITDONE) {
574 bfin_write_DMC0_CTL(bfin_read_DMC0_CTL() & ~SRREQ);
575 SSYNC();
576 while (bfin_read_DMC0_STAT() & SRACK)
577 continue;
578 }
579
580#else
581
582 vr_ctl = bfin_read_VR_CTL();
583
584 serial_putc('b');
585
586
587 if (put_into_srfs)
588#if defined(EBIU_RSTCTL)
589 while (!(bfin_read_EBIU_RSTCTL() & SRACK))
590 continue;
591#elif defined(EBIU_SDGCTL)
592 while (!(bfin_read_EBIU_SDSTAT() & SDSRA))
593 continue;
594#else
595 ;
596#endif
597
598 serial_putc('c');
599
600
601
602
603
604 if (!ANOMALY_05000386) {
605 serial_putc('d');
606
607
608 ADI_SYSCTRL_VALUES memory_settings;
609 uint32_t actions = SYSCTRL_WRITE | SYSCTRL_PLLCTL | SYSCTRL_LOCKCNT;
610 if (!ANOMALY_05000440)
611 actions |= SYSCTRL_PLLDIV;
612 if (CONFIG_HAS_VR) {
613 actions |= SYSCTRL_VRCTL;
614 if (CONFIG_VR_CTL_VAL & FREQ_MASK)
615 actions |= SYSCTRL_INTVOLTAGE;
616 else
617 actions |= SYSCTRL_EXTVOLTAGE;
618 memory_settings.uwVrCtl = CONFIG_VR_CTL_VAL;
619 } else
620 actions |= SYSCTRL_EXTVOLTAGE;
621 memory_settings.uwPllCtl = CONFIG_PLL_CTL_VAL;
622 memory_settings.uwPllDiv = CONFIG_PLL_DIV_VAL;
623 memory_settings.uwPllLockCnt = CONFIG_PLL_LOCKCNT_VAL;
624#if ANOMALY_05000432
625 bfin_write_SIC_IWR1(0);
626#endif
627 serial_putc('e');
628 bfrom_SysControl(actions, &memory_settings, NULL);
629 serial_putc('f');
630 if (ANOMALY_05000440)
631 bfin_write_PLL_DIV(CONFIG_PLL_DIV_VAL);
632#if ANOMALY_05000432
633 bfin_write_SIC_IWR1(-1);
634#endif
635#if ANOMALY_05000171
636 bfin_write_SICA_IWR0(-1);
637 bfin_write_SICA_IWR1(-1);
638#endif
639 serial_putc('g');
640 } else {
641 serial_putc('h');
642
643
644#ifdef SIC_IWR0
645 bfin_write_SIC_IWR0(1);
646 bfin_write_SIC_IWR1(0);
647# ifdef SIC_IWR2
648 bfin_write_SIC_IWR2(0);
649# endif
650#elif defined(SICA_IWR0)
651 bfin_write_SICA_IWR0(1);
652 bfin_write_SICA_IWR1(0);
653#elif defined(SIC_IWR)
654 bfin_write_SIC_IWR(1);
655#endif
656
657 serial_putc('i');
658
659
660 bfin_write_PLL_LOCKCNT(CONFIG_PLL_LOCKCNT_VAL);
661
662 serial_putc('j');
663
664
665
666
667 if (vr_ctl != CONFIG_VR_CTL_VAL) {
668 serial_putc('?');
669 bfin_write_VR_CTL(CONFIG_VR_CTL_VAL);
670 asm("idle;");
671 serial_putc('!');
672 }
673
674 serial_putc('k');
675
676 bfin_write_PLL_DIV(CONFIG_PLL_DIV_VAL);
677
678 serial_putc('l');
679
680
681
682
683 if (ANOMALY_05000242 || bfin_read_PLL_CTL() != CONFIG_PLL_CTL_VAL) {
684 serial_putc('?');
685 bfin_write_PLL_CTL(CONFIG_PLL_CTL_VAL);
686 asm("idle;");
687 serial_putc('!');
688 }
689
690 serial_putc('m');
691
692
693#ifdef SIC_IWR0
694 bfin_write_SIC_IWR0(-1);
695 bfin_write_SIC_IWR1(-1);
696# ifdef SIC_IWR2
697 bfin_write_SIC_IWR2(-1);
698# endif
699#elif defined(SICA_IWR0)
700 bfin_write_SICA_IWR0(-1);
701 bfin_write_SICA_IWR1(-1);
702#elif defined(SIC_IWR)
703 bfin_write_SIC_IWR(-1);
704#endif
705
706 serial_putc('n');
707 }
708
709#endif
710
711 serial_putc('o');
712
713 return vr_ctl;
714}
715
716__attribute__((always_inline)) static inline void
717update_serial_clocks(ADI_BOOT_DATA *bs, uint sdivB, uint divB, uint vcoB)
718{
719
720
721
722
723
724 unsigned int sdivR, vcoR;
725 unsigned int dividend;
726 unsigned int divisor;
727 unsigned int quotient;
728
729 serial_putc('a');
730
731 if (BFIN_DEBUG_EARLY_SERIAL ||
732 CONFIG_BFIN_BOOT_MODE == BFIN_BOOT_UART) {
733#ifdef __ADSPBF60x__
734 sdivR = bfin_read_CGU_DIV();
735 sdivR = ((sdivR >> 8) & 0x1f) * ((sdivR >> 5) & 0x7);
736 vcoR = (bfin_read_CGU_CTL() >> 8) & 0x7f;
737#else
738 sdivR = bfin_read_PLL_DIV() & 0xf;
739 vcoR = (bfin_read_PLL_CTL() >> 9) & 0x3f;
740#endif
741
742 dividend = sdivB * divB * vcoR;
743 divisor = vcoB * sdivR;
744 quotient = early_division(dividend, divisor);
745 serial_early_put_div(quotient - ANOMALY_05000230);
746 }
747
748 serial_putc('c');
749}
750
751__attribute__((always_inline)) static inline void
752program_memory_controller(ADI_BOOT_DATA *bs, bool put_into_srfs)
753{
754 serial_putc('a');
755
756 if (!CONFIG_MEM_SIZE)
757 return;
758
759 serial_putc('b');
760
761#ifdef __ADSPBF60x__
762 int dlldatacycle;
763 int dll_ctl;
764 int i = 0;
765
766 if (CONFIG_BFIN_GET_DCLK_M == 125)
767 i = 0;
768 else if (CONFIG_BFIN_GET_DCLK_M == 133)
769 i = 1;
770 else if (CONFIG_BFIN_GET_DCLK_M == 150)
771 i = 2;
772 else if (CONFIG_BFIN_GET_DCLK_M == 166)
773 i = 3;
774 else if (CONFIG_BFIN_GET_DCLK_M == 200)
775 i = 4;
776 else if (CONFIG_BFIN_GET_DCLK_M == 225)
777 i = 5;
778 else if (CONFIG_BFIN_GET_DCLK_M == 250)
779 i = 6;
780
781#if 0
782 for (i = 0; i < ARRAY_SIZE(ddr_config_table); i++)
783 if (CONFIG_BFIN_GET_DCLK_M == ddr_config_table[i].ddr_clk)
784 break;
785#endif
786
787#ifndef CONFIG_DMC_DDRCFG
788 bfin_write_DMC0_CFG(ddr_config_table[i].dmc_ddrcfg);
789#else
790 bfin_write_DMC0_CFG(CONFIG_DMC_DDRCFG);
791#endif
792#ifndef CONFIG_DMC_DDRTR0
793 bfin_write_DMC0_TR0(ddr_config_table[i].dmc_ddrtr0);
794#else
795 bfin_write_DMC0_TR0(CONFIG_DMC_DDRTR0);
796#endif
797#ifndef CONFIG_DMC_DDRTR1
798 bfin_write_DMC0_TR1(ddr_config_table[i].dmc_ddrtr1);
799#else
800 bfin_write_DMC0_TR1(CONFIG_DMC_DDRTR1);
801#endif
802#ifndef CONFIG_DMC_DDRTR2
803 bfin_write_DMC0_TR2(ddr_config_table[i].dmc_ddrtr2);
804#else
805 bfin_write_DMC0_TR2(CONFIG_DMC_DDRTR2);
806#endif
807#ifndef CONFIG_DMC_DDRMR
808 bfin_write_DMC0_MR(ddr_config_table[i].dmc_ddrmr);
809#else
810 bfin_write_DMC0_MR(CONFIG_DMC_DDRMR);
811#endif
812#ifndef CONFIG_DMC_DDREMR1
813 bfin_write_DMC0_EMR1(ddr_config_table[i].dmc_ddrmr1);
814#else
815 bfin_write_DMC0_EMR1(CONFIG_DMC_DDREMR1);
816#endif
817#ifndef CONFIG_DMC_DDRCTL
818 bfin_write_DMC0_CTL(ddr_config_table[i].dmc_ddrctl);
819#else
820 bfin_write_DMC0_CTL(CONFIG_DMC_DDRCTL);
821#endif
822
823 SSYNC();
824 while (!(bfin_read_DMC0_STAT() & MEMINITDONE))
825 continue;
826
827 dlldatacycle = (bfin_read_DMC0_STAT() & PHYRDPHASE) >>
828 PHYRDPHASE_OFFSET;
829 dll_ctl = bfin_read_DMC0_DLLCTL();
830 dll_ctl &= 0x0ff;
831 bfin_write_DMC0_DLLCTL(dll_ctl | (dlldatacycle << DATACYC_OFFSET));
832
833 SSYNC();
834 while (!(bfin_read_DMC0_STAT() & DLLCALDONE))
835 continue;
836 serial_putc('!');
837
838#else
839
840
841
842
843#ifdef EBIU_SDGCTL
844# ifdef CONFIG_EBIU_SDRRC_VAL
845 bfin_write_EBIU_SDRRC(CONFIG_EBIU_SDRRC_VAL);
846# endif
847# ifdef CONFIG_EBIU_SDBCTL_VAL
848 bfin_write_EBIU_SDBCTL(CONFIG_EBIU_SDBCTL_VAL);
849# endif
850# ifdef CONFIG_EBIU_SDGCTL_VAL
851 bfin_write_EBIU_SDGCTL(CONFIG_EBIU_SDGCTL_VAL);
852# endif
853#endif
854
855 serial_putc('c');
856
857
858 if (put_into_srfs)
859#if defined(EBIU_RSTCTL)
860 bfin_write_EBIU_RSTCTL(bfin_read_EBIU_RSTCTL() & ~(SRREQ));
861#elif defined(EBIU_SDGCTL)
862 bfin_write_EBIU_SDGCTL(bfin_read_EBIU_SDGCTL() & ~(SRFS));
863#endif
864
865 serial_putc('d');
866
867
868
869
870#ifdef EBIU_RSTCTL
871# ifdef CONFIG_EBIU_RSTCTL_VAL
872 bfin_write_EBIU_RSTCTL(bfin_read_EBIU_RSTCTL() | 0x1 | CONFIG_EBIU_RSTCTL_VAL);
873# endif
874# ifdef CONFIG_EBIU_DDRCTL0_VAL
875 bfin_write_EBIU_DDRCTL0(CONFIG_EBIU_DDRCTL0_VAL);
876# endif
877# ifdef CONFIG_EBIU_DDRCTL1_VAL
878 bfin_write_EBIU_DDRCTL1(CONFIG_EBIU_DDRCTL1_VAL);
879# endif
880# ifdef CONFIG_EBIU_DDRCTL2_VAL
881 bfin_write_EBIU_DDRCTL2(CONFIG_EBIU_DDRCTL2_VAL);
882# endif
883# ifdef CONFIG_EBIU_DDRCTL3_VAL
884
885 bfin_write_EBIU_DDRCTL3(CONFIG_EBIU_DDRCTL3_VAL);
886# endif
887# ifdef CONFIG_EBIU_DDRQUE_VAL
888 bfin_write_EBIU_DDRQUE(bfin_read_EBIU_DDRQUE() | CONFIG_EBIU_DDRQUE_VAL);
889# endif
890#endif
891
892#endif
893 serial_putc('e');
894}
895
896__attribute__((always_inline)) static inline void
897check_hibernation(ADI_BOOT_DATA *bs, u16 vr_ctl, bool put_into_srfs)
898{
899 serial_putc('a');
900
901 if (!CONFIG_MEM_SIZE)
902 return;
903
904 serial_putc('b');
905#ifdef __ADSPBF60x__
906 if (bfin_read32(DPM0_RESTORE0) != 0) {
907 uint32_t reg = bfin_read_DMC0_CTL();
908 reg &= ~0x8;
909 bfin_write_DMC0_CTL(reg);
910
911 while ((bfin_read_DMC0_STAT() & 0x8))
912 continue;
913 while (!(bfin_read_DMC0_STAT() & 0x1))
914 continue;
915
916 serial_putc('z');
917 uint32_t *hibernate_magic =
918 (uint32_t *)bfin_read32(DPM0_RESTORE4);
919 SSYNC();
920 if (hibernate_magic[0] == 0xDEADBEEF) {
921 serial_putc('c');
922 SSYNC();
923 bfin_write_EVT15(hibernate_magic[1]);
924 bfin_write_IMASK(EVT_IVG15);
925 __asm__ __volatile__ (
926
927 "reti = %2;"
928
929 "[%0] = %1;"
930
931 "SP = [%0 + 8];"
932
933 "raise 15;"
934 "nop;nop;nop;"
935 "rti;"
936 :
937 : "p"(hibernate_magic),
938 "d"(0x2000 ),
939 "d"(0xffa00000)
940 );
941 }
942
943
944 }
945#else
946
947
948
949
950
951
952
953
954 if (ANOMALY_05000307 || vr_ctl & 0x8000) {
955 uint32_t *hibernate_magic = 0;
956
957 SSYNC();
958
959 if (hibernate_magic[0] == 0xDEADBEEF) {
960 serial_putc('c');
961 bfin_write_EVT15(hibernate_magic[1]);
962 bfin_write_IMASK(EVT_IVG15);
963 __asm__ __volatile__ (
964
965 "reti = %0;"
966
967 "[%0] = %1;"
968
969 "SP = [%0 + 8];"
970
971 "raise 15;"
972 "rti;"
973 :
974 : "p"(hibernate_magic), "d"(0x2000 )
975 );
976 }
977 serial_putc('d');
978 }
979#endif
980
981 serial_putc('e');
982}
983
984BOOTROM_CALLED_FUNC_ATTR
985void initcode(ADI_BOOT_DATA *bs)
986{
987 ADI_BOOT_DATA bootstruct_scratch;
988
989
990 program_nmi_handler();
991
992 serial_init();
993
994 serial_putc('A');
995
996
997
998
999
1000 if (!bs)
1001 bs = &bootstruct_scratch;
1002
1003 serial_putc('B');
1004 bool put_into_srfs = maybe_self_refresh(bs);
1005
1006 serial_putc('C');
1007 uint sdivB, divB, vcoB;
1008 program_early_devices(bs, &sdivB, &divB, &vcoB);
1009
1010 serial_putc('D');
1011 u16 vr_ctl = program_clocks(bs, put_into_srfs);
1012
1013 serial_putc('E');
1014 update_serial_clocks(bs, sdivB, divB, vcoB);
1015
1016 serial_putc('F');
1017 program_memory_controller(bs, put_into_srfs);
1018
1019 serial_putc('G');
1020 check_hibernation(bs, vr_ctl, put_into_srfs);
1021
1022 serial_putc('H');
1023 program_async_controller(bs);
1024
1025#ifdef CONFIG_BFIN_BOOTROM_USES_EVT1
1026 serial_putc('I');
1027
1028
1029
1030
1031
1032
1033 if (CONFIG_BFIN_BOOT_MODE != BFIN_BOOT_BYPASS)
1034 bfin_write_EVT1(CONFIG_SYS_MONITOR_BASE);
1035#endif
1036
1037 serial_putc('>');
1038 serial_putc('\n');
1039
1040 serial_deinit();
1041}
1042