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