Quelle  head.S   Sprache: Sparc

/* SPDX-License-Identifier: GPL-2.0 */
/*****************************************************************************/

/*
 * head.S -- common startup code for ColdFire CPUs.
 *
 * (C) Copyright 1999-2011, Greg Ungerer <gerg@snapgear.com>.
 */

/*****************************************************************************/

#include <linux/linkage.h>
#include <linux/init.h>
#include <asm/asm-offsets.h>
#include <asm/coldfire.h>
#include <asm/mcfsim.h>
#include <asm/mcfmmu.h>
#include <asm/thread_info.h>

/*****************************************************************************/

/*
 * If we don't have a fixed memory size, then lets build in code
 * to auto detect the DRAM size. Obviously this is the preferred
 * method, and should work for most boards. It won't work for those
 * that do not have their RAM starting at address 0, and it only
 * works on SDRAM (not boards fitted with SRAM).
 */
#if CONFIG_RAMSIZE != 0
.macro GET_MEM_SIZE
 movel #CONFIG_RAMSIZE,%d0 /* hard coded memory size */
.endm

#elif defined(CONFIG_M5206) || defined(CONFIG_M5206e) || \
      defined(CONFIG_M5249) || defined(CONFIG_M525x) || \
      defined(CONFIG_M527x) || defined(CONFIG_M528x) || \
      defined(CONFIG_M5307) || defined(CONFIG_M5407)
/*
 * Not all these devices have exactly the same DRAM controller,
 * but the DCMR register is virtually identical - give or take
 * a couple of bits. The only exception is the 5272 devices, their
 * DRAM controller is quite different.
 */
.macro GET_MEM_SIZE
 movel MCFSIM_DMR0,%d0  /* get mask for 1st bank */
 btst #0,%d0   /* check if region enabled */
 beq 1f
 andl #0xfffc0000,%d0
 beq 1f
 addl #0x00040000,%d0  /* convert mask to size */
1:
 movel MCFSIM_DMR1,%d1  /* get mask for 2nd bank */
 btst #0,%d1   /* check if region enabled */
 beq 2f
 andl #0xfffc0000,%d1
 beq 2f
 addl #0x00040000,%d1
 addl %d1,%d0   /* total mem size in d0 */
2:
.endm

#elif defined(CONFIG_M5272)
.macro GET_MEM_SIZE
 movel MCFSIM_CSOR7,%d0 /* get SDRAM address mask */
 andil #0xfffff000,%d0  /* mask out chip select options */
 negl %d0   /* negate bits */
.endm

#elif defined(CONFIG_M520x)
.macro GET_MEM_SIZE
 clrl %d0
 movel MCFSIM_SDCS0, %d2 /* Get SDRAM chip select 0 config */
 andl #0x1f, %d2  /* Get only the chip select size */
 beq 3f   /* Check if it is enabled */
 addql #1, %d2   /* Form exponent */
 moveql #1, %d0
 lsll %d2, %d0  /* 2 ^ exponent */
3:
 movel MCFSIM_SDCS1, %d2 /* Get SDRAM chip select 1 config */
 andl #0x1f, %d2  /* Get only the chip select size */
 beq 4f   /* Check if it is enabled */
 addql #1, %d2   /* Form exponent */
 moveql #1, %d1
 lsll %d2, %d1  /* 2 ^ exponent */
 addl %d1, %d0  /* Total size of SDRAM in d0 */
4:
.endm

#else
#error "ERROR: I don't know how to probe your boards memory size?"
#endif

/*****************************************************************************/

/*
 * Boards and platforms can do specific early hardware setup if
 * they need to. Most don't need this, define away if not required.
 */
#ifndef PLATFORM_SETUP
#define PLATFORM_SETUP
#endif

/*****************************************************************************/

.global _start
.global _rambase
.global _ramvec
.global _ramstart
.global _ramend
#if defined(CONFIG_UBOOT)
.global _init_sp
#endif

/*****************************************************************************/

.data

/*
 * During startup we store away the RAM setup. These are not in the
 * bss, since their values are determined and written before the bss
 * has been cleared.
 */
_rambase:
.long 0
_ramvec:
.long 0
_ramstart:
.long 0
_ramend:
.long 0
#if defined(CONFIG_UBOOT)
_init_sp:
.long 0
#endif

/*****************************************************************************/

__HEAD

#ifdef CONFIG_MMU
_start0:
 jmp _start
.global kernel_pg_dir
.equ kernel_pg_dir,_start0
.equ .,_start0+0x1000
#endif

/*
 * This is the codes first entry point. This is where it all
 * begins...
 */

_start:
 nop     /* filler */
 movew #0x2700, %sr   /* no interrupts */
 movel #CACHE_INIT,%d0   /* disable cache */
 movec %d0,%CACR
 nop
#if defined(CONFIG_UBOOT)
 movel %sp,_init_sp   /* save initial stack pointer */
#endif
#ifdef CONFIG_MBAR
 movel #CONFIG_MBAR+1,%d0  /* configured MBAR address */
 movec %d0,%MBAR   /* set it */
#endif

 /*
 * Do any platform or board specific setup now. Most boards
 * don't need anything. Those exceptions are define this in
 * their board specific includes.
 */
 PLATFORM_SETUP

 /*
 * Create basic memory configuration. Set VBR accordingly,
 * and size memory.
 */
 movel #CONFIG_VECTORBASE,%a7
 movec   %a7,%VBR   /* set vectors addr */
 movel %a7,_ramvec

 movel #CONFIG_RAMBASE,%a7  /* mark the base of RAM */
 movel %a7,_rambase

 GET_MEM_SIZE    /* macro code determines size */
 addl %a7,%d0
 movel %d0,_ramend   /* set end ram addr */

 /*
 * Now that we know what the memory is, lets enable cache
 * and get things moving. This is Coldfire CPU specific. Not
 * all version cores have identical cache register setup. But
 * it is very similar. Define the exact settings in the headers
 * then the code here is the same for all.
 */
 movel #ACR0_MODE,%d0   /* set RAM region for caching */
 movec %d0,%ACR0
 movel #ACR1_MODE,%d0   /* anything else to cache? */
 movec %d0,%ACR1
#ifdef ACR2_MODE
 movel #ACR2_MODE,%d0
 movec %d0,%ACR2
 movel #ACR3_MODE,%d0
 movec %d0,%ACR3
#endif
 movel #CACHE_MODE,%d0   /* enable cache */
 movec %d0,%CACR
 nop

#ifdef CONFIG_MMU
 /*
 * Identity mapping for the kernel region.
 */
 movel #(MMUBASE+1),%d0  /* enable MMUBAR registers */
 movec %d0,%MMUBAR
 movel #MMUOR_CA,%d0   /* clear TLB entries */
 movel %d0,MMUOR
 movel #0,%d0    /* set ASID to 0 */
 movec %d0,%asid

 movel #MMUCR_EN,%d0   /* Enable the identity map */
 movel %d0,MMUCR
 nop     /* sync i-pipeline */

 movel #_vstart,%a0   /* jump to "virtual" space */
 jmp %a0@
_vstart:
#endif /* CONFIG_MMU */

#ifdef CONFIG_ROMFS_FS
 /*
 * Move ROM filesystem above bss :-)
 */
 lea __bss_start,%a0   /* get start of bss */
 lea __bss_stop,%a1   /* set up destination  */
 movel %a0,%a2    /* copy of bss start */

 movel 8(%a0),%d0   /* get size of ROMFS */
 addql #8,%d0    /* allow for rounding */
 andl #0xfffffffc, %d0  /* whole words */

 addl %d0,%a0    /* copy from end */
 addl %d0,%a1    /* copy from end */
 movel %a1,_ramstart   /* set start of ram */

_copy_romfs:
 movel -(%a0),%d0   /* copy dword */
 movel %d0,-(%a1)
 cmpl %a0,%a2    /* check if at end */
 bne _copy_romfs

#else /* CONFIG_ROMFS_FS */
 lea __bss_stop,%a1
 movel %a1,_ramstart
#endif /* CONFIG_ROMFS_FS */


 /*
 * Zero out the bss region.
 */
 lea __bss_start,%a0   /* get start of bss */
 lea __bss_stop,%a1   /* get end of bss */
 clrl %d0    /* set value */
_clear_bss:
 movel %d0,(%a0)+   /* clear each word */
 cmpl %a0,%a1    /* check if at end */
 bne _clear_bss

 /*
 * Load the current task pointer and stack.
 */
 lea init_thread_union,%a0
 lea THREAD_SIZE(%a0),%sp

#ifdef CONFIG_MMU
.global m68k_cputype
.global m68k_mmutype
.global m68k_fputype
.global m68k_machtype
 movel #CPU_COLDFIRE,%d0
 movel %d0,m68k_cputype  /* Mark us as a ColdFire */
 movel #MMU_COLDFIRE,%d0
 movel %d0,m68k_mmutype
 movel #FPUTYPE,%d0
 movel %d0,m68k_fputype  /* Mark FPU type */
 movel #MACHINE,%d0
 movel %d0,m68k_machtype  /* Mark machine type */
 lea init_task,%a2   /* Set "current" init task */
#endif

 /*
 * Assembler start up done, start code proper.
 */
 jsr start_kernel   /* start Linux kernel */

_exit:
 jmp _exit    /* should never get here */

/*****************************************************************************/