diff options
Diffstat (limited to 'libgloss/sparc_leon/busscan.S')
-rw-r--r-- | libgloss/sparc_leon/busscan.S | 148 |
1 files changed, 148 insertions, 0 deletions
diff --git a/libgloss/sparc_leon/busscan.S b/libgloss/sparc_leon/busscan.S new file mode 100644 index 000000000..e7f139635 --- /dev/null +++ b/libgloss/sparc_leon/busscan.S @@ -0,0 +1,148 @@ +/* + * 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 + |