newlib/libgloss/sparc_leon/busscan.S

149 lines
3.6 KiB
ArmAsm
Raw Normal View History

2011-12-15 Konrad Eisele <konrad@gaisler.com> * configure.in: Add SPARC LEON support. * configure: Regenerated. * sparc_leon/asm-leon/amba.h, sparc_leon/asm-leon/asmmacro.h, sparc_leon/asm-leon/clock.h, sparc_leon/asm-leon/contextswitch.h, sparc_leon/asm-leon/elfmacro.h, sparc_leon/asm-leon/head.h, sparc_leon/asm-leon/irq.h, sparc_leon/asm-leon/jiffies.h, sparc_leon/asm-leon/lambapp.h, sparc_leon/asm-leon/lambapp_devs.h, sparc_leon/asm-leon/leon.h, sparc_leon/asm-leon/leon3.h, sparc_leon/asm-leon/leonbare_debug.h, sparc_leon/asm-leon/leonbare_kernel.h, sparc_leon/asm-leon/leonbare_kernel_queue.h, sparc_leon/asm-leon/leoncompat.h, sparc_leon/asm-leon/leondbg.h, sparc_leon/asm-leon/leonstack.h, sparc_leon/asm-leon/liblocks.h, sparc_leon/asm-leon/linkage.h, sparc_leon/asm-leon/param.h, sparc_leon/asm-leon/queue.h, sparc_leon/asm-leon/spinlock.h, sparc_leon/asm-leon/stack.h, sparc_leon/asm-leon/time.h, sparc_leon/asm-leon/timer.h, sparc_leon/asm-leon/types.h, sparc_leon/asm-leon/winmacros.h: New file. * sparc_leon/Makefile.in, sparc_leon/_exit.c, sparc_leon/amba.c, sparc_leon/amba_dbg.c, sparc_leon/amba_driver.c, sparc_leon/amba_scan.c, sparc_leon/asm-leon, sparc_leon/bdinit.S, sparc_leon/busscan.S, sparc_leon/cacheA.S, sparc_leon/catch_interrupt.c, sparc_leon/catch_interrupt_mvt.c, sparc_leon/catch_interrupt_pending.c, sparc_leon/catch_interrupt_svt.c, sparc_leon/configure.in, sparc_leon/console.c, sparc_leon/console_dbg.c, sparc_leon/console_init.c, sparc_leon/contextswitch.c, sparc_leon/contextswitch_asm.S, sparc_leon/crt0.S, sparc_leon/crti.S, sparc_leon/crtn.S, sparc_leon/etrap.S, sparc_leon/etrap_fast.S, sparc_leon/fpu.S, sparc_leon/gettimeofday.c, sparc_leon/initcalls.c, sparc_leon/io.c, sparc_leon/irqinstall.S, sparc_leon/irqtrap.S, sparc_leon/irqtrap_fast.S, sparc_leon/jiffies.c, sparc_leon/kernel.c, sparc_leon/kernel_context.S, sparc_leon/kernel_debug.c, sparc_leon/kernel_debug_var.c, sparc_leon/kernel_mm.c, sparc_leon/kernel_mutex.c, sparc_leon/kernel_queue.c, sparc_leon/kernel_sched.c, sparc_leon/kernel_thread.c, sparc_leon/lcpuinit.S, sparc_leon/locore.S, sparc_leon/locore_atexit.c, sparc_leon/locore_clean.S, sparc_leon/locore_mvt.S, sparc_leon/locore_mvt_reset.S, sparc_leon/locore_svt.S, sparc_leon/locore_svt_reset.S, sparc_leon/locore_svtdisp.S, sparc_leon/locore_var.S, sparc_leon/locore_var_svt.S, sparc_leon/mmu_asm.S, sparc_leon/mutex.c, sparc_leon/nocache.S, sparc_leon/pnpinit.c, sparc_leon/pnpinit_malloc.c, sparc_leon/pnpinit_simple.c, sparc_leon/regwin.S, sparc_leon/regwin_patch.c, sparc_leon/regwin_slow.S, sparc_leon/regwinflush.S, sparc_leon/rtc.c, sparc_leon/rtrap.S, sparc_leon/rtrap_fast.S, sparc_leon/stop.S, sparc_leon/timer.c, sparc_leon/times.c: New file * sparc_leon/configure: Regenerate
2011-12-15 23:58:40 +01:00
/*
* 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.
*/
!unsigned int ahbslv_scan(register unsigned int vendor,register unsigned int driver) {
! register unsigned int conf, mbar,i, *confp;
! register unsigned int cfg_area = (unsigned int ) (LEON3_IO_AREA | LEON3_CONF_AREA | LEON3_AHB_SLAVE_CONF_AREA);
! for (i = 0; i < LEON3_AHB_SLAVES; i++)
! {
! confp = (unsigned int*)(cfg_area + (i * LEON3_AHB_CONF_WORDS * 4));
! conf = *confp;
! //mbar = *(unsigned int*)(i * LEON3_AHB_CONF_WORDS+ (4 * 4));
! if ((amba_vendor(conf) == vendor) && (amba_device(conf) == driver)) {
! return (unsigned int)confp;
! }
! }
! return 0;
!}
.section ".text"
.global ahbslv_scan
.align 4
ahbslv_scan:
mov %o0, %g1
mov -2048, %o5
mov 0, %o3
sll %o3, 5, %o0
.LL11:
add %o5, %o0, %o4
ld [%o5+%o0], %o2
srl %o2, 24, %o0
cmp %o0, %g1
bne,a .LL10
add %o3, 1, %o3
srl %o2, 12, %o0
and %o0, 4095, %o0
cmp %o0, %o1
be .LL1
mov %o4, %o2
add %o3, 1, %o3
.LL10:
cmp %o3, 7
bleu,a .LL11
sll %o3, 5, %o0
mov 0, %o2
.LL1:
retl
mov %o2, %o0
!unsigned int apbslv_scan(register unsigned int base,register unsigned int vendor, register unsigned int driver) {
! register unsigned int conf, mbar,i, *confp;
! for (i = 0; i < LEON3_APB_SLAVES; i++)
! {
! confp = (unsigned int*)(base + (i * LEON3_APB_CONF_WORDS * 4));
! conf = *confp;
! //mbar = *(unsigned int*)(i * LEON3_AHB_CONF_WORDS+ (4 * 4));
! if ((amba_vendor(conf) == vendor) && (amba_device(conf) == driver)) {
! return (unsigned int)confp;
! }
! }
! return 0;
!}
.section ".text"
.align 4
.global apbslv_scan
apbslv_scan:
mov %o0, %g1
mov 0, %o4
sll %o4, 3, %o0
.LL22:
add %g1, %o0, %o5
ld [%g1+%o0], %o3
srl %o3, 24, %o0
cmp %o0, %o1
bne,a .LL21
add %o4, 1, %o4
srl %o3, 12, %o0
and %o0, 4095, %o0
cmp %o0, %o2
be .LL12
mov %o5, %o3
add %o4, 1, %o4
.LL21:
cmp %o4, 15
bleu,a .LL22
sll %o4, 3, %o0
mov 0, %o3
.LL12:
retl
mov %o3, %o0
!unsigned int getbase(register unsigned int *mbar,register unsigned int iobase) {
! register unsigned int conf = mbar[1];
! return ((iobase & 0xfff00000) |
! ((conf & 0xfff00000)>> 12)) & (((conf & 0x0000fff0) <<4) | 0xfff00000);
!
!}
.section ".text"
.align 4
.global iobar_getbase
iobar_getbase:
ld [%o0+4], %o2
sethi %hi(-1048576), %o3
and %o1, %o3, %o1
and %o2, %o3, %o0
srl %o0, 12, %o0
or %o1, %o0, %o1
sethi %hi(64512), %o0
or %o0, 1008, %o0
and %o2, %o0, %o2
sll %o2, 4, %o2
or %o2, %o3, %o2
and %o1, %o2, %o1
retl
mov %o1, %o0