newlib/libgloss/sparc_leon/lcpuinit.S

144 lines
3.4 KiB
ArmAsm

/*
* Copyright (c) 2011 Aeroflex Gaisler
*
* BSD license:
*
* Permission is hereby granted, free of charge, to any person obtaining a copy
* of this software and associated documentation files (the "Software"), to deal
* in the Software without restriction, including without limitation the rights
* to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
* copies of the Software, and to permit persons to whom the Software is
* furnished to do so, subject to the following conditions:
*
* The above copyright notice and this permission notice shall be included in
* all copies or substantial portions of the Software.
*
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
* THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
* OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
* THE SOFTWARE.
*/
#define LEON3_IO_AREA 0xfff00000
#define LEON3_CONF_AREA 0xff000
#define VENDOR_GAISLER 0x01
#define GAISLER_APBMST 0x006
#define GAISLER_APBUART 0x00C
#define GAISLER_GPTIMER 0x011
.text
/* ------- */
.weak cpuinit
.set cpuinit,_cpuinit
/* ------- */
!.global cpuinit
_cpuinit:
mov %o7,%g6
mov %psr, %l3
srl %l3, 24, %g5
and %g5, 0xf, %g5
subcc %g5, 3, %0
be 1f
/* other versions */
ba 2f
! ####### leon3 #########
1: set 0x01, %o0 !VENDOR_GAISLER
set 0x006, %o1 !GAISLER_APBMST
call ahbslv_scan
nop
cmp %g0,%o0
be 2f
nop
ld [%o0+16],%g1
set 0xfff00000,%o0 !LEON3_IO_AREA
and %g1,%o0,%g1 !g1: apb base
set 0xff000,%o0 !LEON3_CONF_AREA
or %g1,%o0,%g2 !g2: apb conf base
! ####### uart #########
mov %g2,%o0
set 0x01 , %o1 ! VENDOR_GAISLER
set 0x00C,%o2 ! GAISLER_APBUART
call apbslv_scan
nop
cmp %g0,%o0
be 2f
nop
call iobar_getbase
mov %g1,%o1
set console, %g5
st %o1,[%g5] !uart base address
! ####### timer #########
mov %g2,%o0
set 0x01 , %o1 !VENDOR_GAISLER
set 0x011,%o2 !GAISLER_GPTIMER
call apbslv_scan
nop
cmp %g0,%o0
be 2f
nop
call iobar_getbase
mov %g1,%o1
add %o1,0x10,%o1
set rtc, %g5
st %o1,[%g5]
! ################
mov %g2,%o0
set 0x01 , %o1 !VENDOR_GAISLER
set 0x00D,%o2 !GAISLER_IRQMP
call apbslv_scan
nop
cmp %g0,%o0
be 2f
nop
call iobar_getbase
mov %g1,%o1
set irqmp, %g5
st %o1,[%g5]
ld [%o1+0x10], %o2
srl %o2, 16, %o2
and %o2, 15, %o2
st %o2,[%g5+4]
! ################
2: mov %g6,%o7
retl
nop
! force link of jiffies_64
.global jiffies_64
3: set jiffies_64,%g1
.data
.global irqmp
irqmp: .word 0 ! IRQMP base address
.word 0 ! extended irq number
.text