|
@@ -0,0 +1,281 @@
|
|
|
+/*
|
|
|
+ * Copyright (C) 2008, Guennadi Liakhovetski <lg@denx.de>
|
|
|
+ *
|
|
|
+ * This program is free software; you can redistribute it and/or
|
|
|
+ * modify it under the terms of the GNU General Public License as
|
|
|
+ * published by the Free Software Foundation; either version 2 of
|
|
|
+ * the License, or (at your option) any later version.
|
|
|
+ *
|
|
|
+ * This program is distributed in the hope that it will be useful,
|
|
|
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
|
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
|
+ * GNU General Public License for more details.
|
|
|
+ *
|
|
|
+ * You should have received a copy of the GNU General Public License
|
|
|
+ * along with this program; if not, write to the Free Software
|
|
|
+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
|
|
|
+ * MA 02111-1307 USA
|
|
|
+ */
|
|
|
+
|
|
|
+#include <asm/arch/mx31-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, #0x16
|
|
|
+
|
|
|
+ /* 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 0x1ff, 7, 3, 5, 1, 3, 0 */
|
|
|
+/* REG CCM_PDR0, PDR0_CSI_PODF(0x1ff) | 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))
|