162306a36Sopenharmony_ci/* SPDX-License-Identifier: GPL-2.0 */ 262306a36Sopenharmony_ci/* 362306a36Sopenharmony_ci * head.S - Common startup code for 68000 core based CPU's 462306a36Sopenharmony_ci * 562306a36Sopenharmony_ci * 2012.10.21, Luis Alves <ljalvs@gmail.com>, Single head.S file for all 662306a36Sopenharmony_ci * 68000 core based CPU's. Based on the sources from: 762306a36Sopenharmony_ci * Coldfire by Greg Ungerer <gerg@snapgear.com> 862306a36Sopenharmony_ci * 68328 by D. Jeff Dionne <jeff@ryeham.ee.ryerson.ca>, 962306a36Sopenharmony_ci * Kenneth Albanowski <kjahds@kjahds.com>, 1062306a36Sopenharmony_ci * The Silver Hammer Group, Ltd. 1162306a36Sopenharmony_ci * 1262306a36Sopenharmony_ci */ 1362306a36Sopenharmony_ci 1462306a36Sopenharmony_ci#include <linux/linkage.h> 1562306a36Sopenharmony_ci#include <linux/init.h> 1662306a36Sopenharmony_ci#include <asm/asm-offsets.h> 1762306a36Sopenharmony_ci#include <asm/thread_info.h> 1862306a36Sopenharmony_ci 1962306a36Sopenharmony_ci 2062306a36Sopenharmony_ci/***************************************************************************** 2162306a36Sopenharmony_ci * UCSIMM and UCDIMM use CONFIG_MEMORY_RESERVE to reserve some RAM 2262306a36Sopenharmony_ci *****************************************************************************/ 2362306a36Sopenharmony_ci#ifdef CONFIG_MEMORY_RESERVE 2462306a36Sopenharmony_ci#define RAMEND (CONFIG_RAMBASE+CONFIG_RAMSIZE)-(CONFIG_MEMORY_RESERVE*0x100000) 2562306a36Sopenharmony_ci#else 2662306a36Sopenharmony_ci#define RAMEND (CONFIG_RAMBASE+CONFIG_RAMSIZE) 2762306a36Sopenharmony_ci#endif 2862306a36Sopenharmony_ci/*****************************************************************************/ 2962306a36Sopenharmony_ci 3062306a36Sopenharmony_ci.global _start 3162306a36Sopenharmony_ci.global _rambase 3262306a36Sopenharmony_ci.global _ramvec 3362306a36Sopenharmony_ci.global _ramstart 3462306a36Sopenharmony_ci.global _ramend 3562306a36Sopenharmony_ci 3662306a36Sopenharmony_ci#if defined(CONFIG_PILOT) || defined(CONFIG_INIT_LCD) 3762306a36Sopenharmony_ci.global bootlogo_bits 3862306a36Sopenharmony_ci#endif 3962306a36Sopenharmony_ci 4062306a36Sopenharmony_ci/* Defining DEBUG_HEAD_CODE, serial port in 68x328 is inited */ 4162306a36Sopenharmony_ci/* #define DEBUG_HEAD_CODE */ 4262306a36Sopenharmony_ci#undef DEBUG_HEAD_CODE 4362306a36Sopenharmony_ci 4462306a36Sopenharmony_ci.data 4562306a36Sopenharmony_ci 4662306a36Sopenharmony_ci/***************************************************************************** 4762306a36Sopenharmony_ci * RAM setup pointers. Used by the kernel to determine RAM location and size. 4862306a36Sopenharmony_ci *****************************************************************************/ 4962306a36Sopenharmony_ci 5062306a36Sopenharmony_ci_rambase: 5162306a36Sopenharmony_ci .long 0 5262306a36Sopenharmony_ci_ramvec: 5362306a36Sopenharmony_ci .long 0 5462306a36Sopenharmony_ci_ramstart: 5562306a36Sopenharmony_ci .long 0 5662306a36Sopenharmony_ci_ramend: 5762306a36Sopenharmony_ci .long 0 5862306a36Sopenharmony_ci 5962306a36Sopenharmony_ci__HEAD 6062306a36Sopenharmony_ci 6162306a36Sopenharmony_ci/***************************************************************************** 6262306a36Sopenharmony_ci * Entry point, where all begins! 6362306a36Sopenharmony_ci *****************************************************************************/ 6462306a36Sopenharmony_ci 6562306a36Sopenharmony_ci_start: 6662306a36Sopenharmony_ci 6762306a36Sopenharmony_ci/* Pilot need this specific signature at the start of ROM */ 6862306a36Sopenharmony_ci#ifdef CONFIG_PILOT 6962306a36Sopenharmony_ci .byte 0x4e, 0xfa, 0x00, 0x0a /* bra opcode (jmp 10 bytes) */ 7062306a36Sopenharmony_ci .byte 'b', 'o', 'o', 't' 7162306a36Sopenharmony_ci .word 10000 7262306a36Sopenharmony_ci nop 7362306a36Sopenharmony_ci moveq #0, %d0 7462306a36Sopenharmony_ci movew %d0, 0xfffff618 /* Watchdog off */ 7562306a36Sopenharmony_ci movel #0x00011f07, 0xfffff114 /* CS A1 Mask */ 7662306a36Sopenharmony_ci#endif /* CONFIG_PILOT */ 7762306a36Sopenharmony_ci 7862306a36Sopenharmony_ci movew #0x2700, %sr /* disable all interrupts */ 7962306a36Sopenharmony_ci 8062306a36Sopenharmony_ci/***************************************************************************** 8162306a36Sopenharmony_ci * Setup PLL and wait for it to settle (in 68x328 cpu's). 8262306a36Sopenharmony_ci * Also, if enabled, init serial port. 8362306a36Sopenharmony_ci *****************************************************************************/ 8462306a36Sopenharmony_ci#if defined(CONFIG_M68328) || \ 8562306a36Sopenharmony_ci defined(CONFIG_M68EZ328) || \ 8662306a36Sopenharmony_ci defined(CONFIG_M68VZ328) 8762306a36Sopenharmony_ci 8862306a36Sopenharmony_ci/* Serial port setup. Should only be needed if debugging this startup code. */ 8962306a36Sopenharmony_ci#ifdef DEBUG_HEAD_CODE 9062306a36Sopenharmony_ci movew #0x0800, 0xfffff906 /* Ignore CTS */ 9162306a36Sopenharmony_ci movew #0x010b, 0xfffff902 /* BAUD to 9600 */ 9262306a36Sopenharmony_ci movew #0xe100, 0xfffff900 /* enable */ 9362306a36Sopenharmony_ci#endif /* DEBUG_HEAD */ 9462306a36Sopenharmony_ci 9562306a36Sopenharmony_ci#ifdef CONFIG_PILOT 9662306a36Sopenharmony_ci movew #0x2410, 0xfffff200 /* PLLCR */ 9762306a36Sopenharmony_ci#else 9862306a36Sopenharmony_ci movew #0x2400, 0xfffff200 /* PLLCR */ 9962306a36Sopenharmony_ci#endif 10062306a36Sopenharmony_ci movew #0x0123, 0xfffff202 /* PLLFSR */ 10162306a36Sopenharmony_ci moveq #0, %d0 10262306a36Sopenharmony_ci movew #16384, %d0 /* PLL settle wait loop */ 10362306a36Sopenharmony_ci_pll_settle: 10462306a36Sopenharmony_ci subw #1, %d0 10562306a36Sopenharmony_ci bne _pll_settle 10662306a36Sopenharmony_ci#endif /* CONFIG_M68x328 */ 10762306a36Sopenharmony_ci 10862306a36Sopenharmony_ci 10962306a36Sopenharmony_ci/***************************************************************************** 11062306a36Sopenharmony_ci * If running kernel from ROM some specific initialization has to be done. 11162306a36Sopenharmony_ci * (Assuming that everything is already init'ed when running from RAM) 11262306a36Sopenharmony_ci *****************************************************************************/ 11362306a36Sopenharmony_ci#ifdef CONFIG_ROMKERNEL 11462306a36Sopenharmony_ci 11562306a36Sopenharmony_ci/***************************************************************************** 11662306a36Sopenharmony_ci * Init chip registers (uCsimm specific) 11762306a36Sopenharmony_ci *****************************************************************************/ 11862306a36Sopenharmony_ci#ifdef CONFIG_UCSIMM 11962306a36Sopenharmony_ci moveb #0x00, 0xfffffb0b /* Watchdog off */ 12062306a36Sopenharmony_ci moveb #0x10, 0xfffff000 /* SCR */ 12162306a36Sopenharmony_ci moveb #0x00, 0xfffff40b /* enable chip select */ 12262306a36Sopenharmony_ci moveb #0x00, 0xfffff423 /* enable /DWE */ 12362306a36Sopenharmony_ci moveb #0x08, 0xfffffd0d /* disable hardmap */ 12462306a36Sopenharmony_ci moveb #0x07, 0xfffffd0e /* level 7 interrupt clear */ 12562306a36Sopenharmony_ci movew #0x8600, 0xfffff100 /* FLASH at 0x10c00000 */ 12662306a36Sopenharmony_ci movew #0x018b, 0xfffff110 /* 2Meg, enable, 0ws */ 12762306a36Sopenharmony_ci movew #0x8f00, 0xfffffc00 /* DRAM configuration */ 12862306a36Sopenharmony_ci movew #0x9667, 0xfffffc02 /* DRAM control */ 12962306a36Sopenharmony_ci movew #0x0000, 0xfffff106 /* DRAM at 0x00000000 */ 13062306a36Sopenharmony_ci movew #0x068f, 0xfffff116 /* 8Meg, enable, 0ws */ 13162306a36Sopenharmony_ci moveb #0x40, 0xfffff300 /* IVR */ 13262306a36Sopenharmony_ci movel #0x007FFFFF, %d0 /* IMR */ 13362306a36Sopenharmony_ci movel %d0, 0xfffff304 13462306a36Sopenharmony_ci moveb 0xfffff42b, %d0 13562306a36Sopenharmony_ci andb #0xe0, %d0 13662306a36Sopenharmony_ci moveb %d0, 0xfffff42b 13762306a36Sopenharmony_ci#endif 13862306a36Sopenharmony_ci 13962306a36Sopenharmony_ci/***************************************************************************** 14062306a36Sopenharmony_ci * Init LCD controller. 14162306a36Sopenharmony_ci * (Assuming that LCD controller is already init'ed when running from RAM) 14262306a36Sopenharmony_ci *****************************************************************************/ 14362306a36Sopenharmony_ci#ifdef CONFIG_INIT_LCD 14462306a36Sopenharmony_ci#ifdef CONFIG_PILOT 14562306a36Sopenharmony_ci moveb #0, 0xfffffA27 /* LCKCON */ 14662306a36Sopenharmony_ci movel #_start, 0xfffffA00 /* LSSA */ 14762306a36Sopenharmony_ci moveb #0xa, 0xfffffA05 /* LVPW */ 14862306a36Sopenharmony_ci movew #0x9f, 0xFFFFFa08 /* LXMAX */ 14962306a36Sopenharmony_ci movew #0x9f, 0xFFFFFa0a /* LYMAX */ 15062306a36Sopenharmony_ci moveb #9, 0xfffffa29 /* LBAR */ 15162306a36Sopenharmony_ci moveb #0, 0xfffffa25 /* LPXCD */ 15262306a36Sopenharmony_ci moveb #0x04, 0xFFFFFa20 /* LPICF */ 15362306a36Sopenharmony_ci moveb #0x58, 0xfffffA27 /* LCKCON */ 15462306a36Sopenharmony_ci moveb #0x85, 0xfffff429 /* PFDATA */ 15562306a36Sopenharmony_ci moveb #0xd8, 0xfffffA27 /* LCKCON */ 15662306a36Sopenharmony_ci moveb #0xc5, 0xfffff429 /* PFDATA */ 15762306a36Sopenharmony_ci moveb #0xd5, 0xfffff429 /* PFDATA */ 15862306a36Sopenharmony_ci movel #bootlogo_bits, 0xFFFFFA00 /* LSSA */ 15962306a36Sopenharmony_ci moveb #10, 0xFFFFFA05 /* LVPW */ 16062306a36Sopenharmony_ci movew #160, 0xFFFFFA08 /* LXMAX */ 16162306a36Sopenharmony_ci movew #160, 0xFFFFFA0A /* LYMAX */ 16262306a36Sopenharmony_ci#else /* CONFIG_PILOT */ 16362306a36Sopenharmony_ci movel #bootlogo_bits, 0xfffffA00 /* LSSA */ 16462306a36Sopenharmony_ci moveb #0x28, 0xfffffA05 /* LVPW */ 16562306a36Sopenharmony_ci movew #0x280, 0xFFFFFa08 /* LXMAX */ 16662306a36Sopenharmony_ci movew #0x1df, 0xFFFFFa0a /* LYMAX */ 16762306a36Sopenharmony_ci moveb #0, 0xfffffa29 /* LBAR */ 16862306a36Sopenharmony_ci moveb #0, 0xfffffa25 /* LPXCD */ 16962306a36Sopenharmony_ci moveb #0x08, 0xFFFFFa20 /* LPICF */ 17062306a36Sopenharmony_ci moveb #0x01, 0xFFFFFA21 /* -ve pol */ 17162306a36Sopenharmony_ci moveb #0x81, 0xfffffA27 /* LCKCON */ 17262306a36Sopenharmony_ci movew #0xff00, 0xfffff412 /* LCD pins */ 17362306a36Sopenharmony_ci#endif /* CONFIG_PILOT */ 17462306a36Sopenharmony_ci#endif /* CONFIG_INIT_LCD */ 17562306a36Sopenharmony_ci 17662306a36Sopenharmony_ci/***************************************************************************** 17762306a36Sopenharmony_ci * Kernel is running from FLASH/ROM (XIP) 17862306a36Sopenharmony_ci * Copy init text & data to RAM 17962306a36Sopenharmony_ci *****************************************************************************/ 18062306a36Sopenharmony_ci moveal #_etext, %a0 18162306a36Sopenharmony_ci moveal #_sdata, %a1 18262306a36Sopenharmony_ci moveal #__bss_start, %a2 18362306a36Sopenharmony_ci_copy_initmem: 18462306a36Sopenharmony_ci movel %a0@+, %a1@+ 18562306a36Sopenharmony_ci cmpal %a1, %a2 18662306a36Sopenharmony_ci bhi _copy_initmem 18762306a36Sopenharmony_ci#endif /* CONFIG_ROMKERNEL */ 18862306a36Sopenharmony_ci 18962306a36Sopenharmony_ci/***************************************************************************** 19062306a36Sopenharmony_ci * Setup basic memory information for kernel 19162306a36Sopenharmony_ci *****************************************************************************/ 19262306a36Sopenharmony_ci movel #CONFIG_VECTORBASE,_ramvec /* set vector base location */ 19362306a36Sopenharmony_ci movel #CONFIG_RAMBASE,_rambase /* set the base of RAM */ 19462306a36Sopenharmony_ci movel #RAMEND, _ramend /* set end ram addr */ 19562306a36Sopenharmony_ci lea __bss_stop,%a1 19662306a36Sopenharmony_ci movel %a1,_ramstart 19762306a36Sopenharmony_ci 19862306a36Sopenharmony_ci/***************************************************************************** 19962306a36Sopenharmony_ci * If the kernel is in RAM, move romfs to right above bss and 20062306a36Sopenharmony_ci * adjust _ramstart to where romfs ends. 20162306a36Sopenharmony_ci * 20262306a36Sopenharmony_ci * (Do this only if CONFIG_MTD_UCLINUX is true) 20362306a36Sopenharmony_ci *****************************************************************************/ 20462306a36Sopenharmony_ci 20562306a36Sopenharmony_ci#if defined(CONFIG_ROMFS_FS) && defined(CONFIG_RAMKERNEL) && \ 20662306a36Sopenharmony_ci defined(CONFIG_MTD_UCLINUX) 20762306a36Sopenharmony_ci lea __bss_start, %a0 /* get start of bss */ 20862306a36Sopenharmony_ci lea __bss_stop, %a1 /* set up destination */ 20962306a36Sopenharmony_ci movel %a0, %a2 /* copy of bss start */ 21062306a36Sopenharmony_ci 21162306a36Sopenharmony_ci movel 8(%a0), %d0 /* get size of ROMFS */ 21262306a36Sopenharmony_ci addql #8, %d0 /* allow for rounding */ 21362306a36Sopenharmony_ci andl #0xfffffffc, %d0 /* whole words */ 21462306a36Sopenharmony_ci 21562306a36Sopenharmony_ci addl %d0, %a0 /* copy from end */ 21662306a36Sopenharmony_ci addl %d0, %a1 /* copy from end */ 21762306a36Sopenharmony_ci movel %a1, _ramstart /* set start of ram */ 21862306a36Sopenharmony_ci_copy_romfs: 21962306a36Sopenharmony_ci movel -(%a0), -(%a1) /* copy dword */ 22062306a36Sopenharmony_ci cmpl %a0, %a2 /* check if at end */ 22162306a36Sopenharmony_ci bne _copy_romfs 22262306a36Sopenharmony_ci#endif /* CONFIG_ROMFS_FS && CONFIG_RAMKERNEL && CONFIG_MTD_UCLINUX */ 22362306a36Sopenharmony_ci 22462306a36Sopenharmony_ci/***************************************************************************** 22562306a36Sopenharmony_ci * Clear bss region 22662306a36Sopenharmony_ci *****************************************************************************/ 22762306a36Sopenharmony_ci lea __bss_start, %a0 /* get start of bss */ 22862306a36Sopenharmony_ci lea __bss_stop, %a1 /* get end of bss */ 22962306a36Sopenharmony_ci_clear_bss: 23062306a36Sopenharmony_ci movel #0, (%a0)+ /* clear each word */ 23162306a36Sopenharmony_ci cmpl %a0, %a1 /* check if at end */ 23262306a36Sopenharmony_ci bne _clear_bss 23362306a36Sopenharmony_ci 23462306a36Sopenharmony_ci/***************************************************************************** 23562306a36Sopenharmony_ci * Load the current task pointer and stack. 23662306a36Sopenharmony_ci *****************************************************************************/ 23762306a36Sopenharmony_ci lea init_thread_union,%a0 23862306a36Sopenharmony_ci lea THREAD_SIZE(%a0),%sp 23962306a36Sopenharmony_ci jsr start_kernel /* start Linux kernel */ 24062306a36Sopenharmony_ci_exit: 24162306a36Sopenharmony_ci jmp _exit /* should never get here */ 242