arch/arm/mm/proc-arm740.S

   1 /*
   2  *  linux/arch/arm/mm/arm740.S: utility functions for ARM740
   3  *
   4  *  Copyright (C) 2004-2006 Hyok S. Choi (hyok.choi@samsung.com)
   5  *
   6  * This program is free software; you can redistribute it and/or modify
   7  * it under the terms of the GNU General Public License version 2 as
   8  * published by the Free Software Foundation.
   9  *
  10  */
  11 #include <linux/linkage.h>
  12 #include <linux/init.h>
  13 #include <asm/assembler.h>
  14 #include <asm/asm-offsets.h>
  15 #include <asm/hwcap.h>
  16 #include <asm/pgtable-hwdef.h>
  17 #include <asm/pgtable.h>
  18 #include <asm/ptrace.h>
  19
  20 #include "proc-macros.S"
  21
  22         .text
  23 /*
  24  * cpu_arm740_proc_init()
  25  * cpu_arm740_do_idle()
  26  * cpu_arm740_dcache_clean_area()
  27  * cpu_arm740_switch_mm()
  28  *
  29  * These are not required.
  30  */
  31 ENTRY(cpu_arm740_proc_init)
  32 ENTRY(cpu_arm740_do_idle)
  33 ENTRY(cpu_arm740_dcache_clean_area)
  34 ENTRY(cpu_arm740_switch_mm)
  35         mov     pc, lr
  36
  37 /*
  38  * cpu_arm740_proc_fin()
  39  */
  40 ENTRY(cpu_arm740_proc_fin)
  41         mrc     p15, 0, r0, c1, c0, 0
  42         bic     r0, r0, #0x3f000000             @ bank/f/lock/s
  43         bic     r0, r0, #0x0000000c             @ w-buffer/cache
  44         mcr     p15, 0, r0, c1, c0, 0           @ disable caches
  45         mov     pc, lr
  46
  47 /*
  48  * cpu_arm740_reset(loc)
  49  * Params  : r0 = address to jump to
  50  * Notes   : This sets up everything for a reset
  51  */
  52         .pushsection    .idmap.text, "ax"
  53 ENTRY(cpu_arm740_reset)
  54         mov     ip, #0
  55         mcr     p15, 0, ip, c7, c0, 0           @ invalidate cache
  56         mrc     p15, 0, ip, c1, c0, 0           @ get ctrl register
  57         bic     ip, ip, #0x0000000c             @ ............wc..
  58         mcr     p15, 0, ip, c1, c0, 0           @ ctrl register
  59         mov     pc, r0
  60 ENDPROC(cpu_arm740_reset)
  61         .popsection
  62
  63         __CPUINIT
  64
  65         .type   __arm740_setup, #function
  66 __arm740_setup:
  67         mov     r0, #0
  68         mcr     p15, 0, r0, c7, c0, 0           @ invalidate caches
  69
  70         mcr     p15, 0, r0, c6, c3              @ disable area 3~7
  71         mcr     p15, 0, r0, c6, c4
  72         mcr     p15, 0, r0, c6, c5
  73         mcr     p15, 0, r0, c6, c6
  74         mcr     p15, 0, r0, c6, c7
  75
  76         mov     r0, #0x0000003F                 @ base = 0, size = 4GB
  77         mcr     p15, 0, r0, c6, c0              @ set area 0, default
  78
  79         ldr     r0, =(CONFIG_DRAM_BASE & 0xFFFFF000) @ base[31:12] of RAM
  80         ldr     r1, =(CONFIG_DRAM_SIZE >> 12)   @ size of RAM (must be >= 4KB)
  81         mov     r2, #10                         @ 11 is the minimum (4KB)
  82 1:      add     r2, r2, #1                      @ area size *= 2
  83         mov     r1, r1, lsr #1
  84         bne     1b                              @ count not zero r-shift
  85         orr     r0, r0, r2, lsl #1              @ the area register value
  86         orr     r0, r0, #1                      @ set enable bit
  87         mcr     p15, 0, r0, c6, c1              @ set area 1, RAM
  88
  89         ldr     r0, =(CONFIG_FLASH_MEM_BASE & 0xFFFFF000) @ base[31:12] of FLASH
  90         ldr     r1, =(CONFIG_FLASH_SIZE >> 12)  @ size of FLASH (must be >= 4KB)
  91         mov     r2, #10                         @ 11 is the minimum (4KB)
  92 1:      add     r2, r2, #1                      @ area size *= 2
  93         mov     r1, r1, lsr #1
  94         bne     1b                              @ count not zero r-shift
  95         orr     r0, r0, r2, lsl #1              @ the area register value
  96         orr     r0, r0, #1                      @ set enable bit
  97         mcr     p15, 0, r0, c6, c2              @ set area 2, ROM/FLASH
  98
  99         mov     r0, #0x06
 100         mcr     p15, 0, r0, c2, c0              @ Region 1&2 cacheable
 101 #ifdef CONFIG_CPU_DCACHE_WRITETHROUGH
 102         mov     r0, #0x00                       @ disable whole write buffer
 103 #else
 104         mov     r0, #0x02                       @ Region 1 write bufferred
 105 #endif
 106         mcr     p15, 0, r0, c3, c0
 107
 108         mov     r0, #0x10000
 109         sub     r0, r0, #1                      @ r0 = 0xffff
 110         mcr     p15, 0, r0, c5, c0              @ all read/write access
 111
 112         mrc     p15, 0, r0, c1, c0              @ get control register
 113         bic     r0, r0, #0x3F000000             @ set to standard caching mode
 114                                                 @ need some benchmark
 115         orr     r0, r0, #0x0000000d             @ MPU/Cache/WB
 116
 117         mov     pc, lr
 118
 119         .size   __arm740_setup, . - __arm740_setup
 120
 121         __INITDATA
 122
 123         @ define struct processor (see <asm/proc-fns.h> and proc-macros.S)
 124         define_processor_functions arm740, dabort=v4t_late_abort, pabort=legacy_pabort, nommu=1
 125
 126         .section ".rodata"
 127
 128         string  cpu_arch_name, "armv4"
 129         string  cpu_elf_name, "v4"
 130         string  cpu_arm740_name, "ARM740T"
 131
 132         .align
 133
 134         .section ".proc.info.init", #alloc, #execinstr
 135         .type   __arm740_proc_info,#object
 136 __arm740_proc_info:
 137         .long   0x41807400
 138         .long   0xfffffff0
 139         .long   0
 140         b       __arm740_setup
 141         .long   cpu_arch_name
 142         .long   cpu_elf_name
 143         .long   HWCAP_SWP | HWCAP_HALF | HWCAP_26BIT
 144         .long   cpu_arm740_name
 145         .long   arm740_processor_functions
 146         .long   0
 147         .long   0
 148         .long   v3_cache_fns                    @ cache model
 149         .size   __arm740_proc_info, . - __arm740_proc_info