149 lines
3.6 KiB
ArmAsm
149 lines
3.6 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.
|
|
*/
|
|
|
|
|
|
!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
|
|
|