/* Parse AHB PnP information */ void ambapp_ahb_parse(struct ambapp_find_ahb_info *info, ambapp_ahbdev *dev) { struct ambapp_pnp_ahb *ahb = info->pnp; unsigned int ahbbase = (unsigned int)ahb & 0xfff00000; int i, type; unsigned int addr, mask, mbar; dev->vendor = amba_vendor(ahb->id); dev->device = amba_device(ahb->id); dev->irq = amba_irq(ahb->id); dev->ver = amba_ver(ahb->id); dev->userdef[0] = ahb->custom[0]; dev->userdef[1] = ahb->custom[1]; dev->userdef[2] = ahb->custom[2]; dev->ahb_bus_index = info->ahb_bus_index - 1; for (i = 0; i < 4; i++) { mbar = ahb->mbar[i]; addr = amba_membar_start(mbar); type = amba_membar_type(mbar); if (type == AMBA_TYPE_AHBIO) { addr = amba_ahbio_adr(addr, ahbbase); mask = (((unsigned int) (amba_membar_mask((~mbar))<<8)|0xff))+1; } else { /* AHB memory area, absolute address */ mask = (~((unsigned int) (amba_membar_mask(mbar)<<20)))+1; } dev->address[i] = addr; dev->mask[i] = mask; dev->type[i] = type; } }
/* Get first nr AHB Slave devices, put them into dev (which is an array of nr length) */ int amba_find_ahbmsts (amba_confarea_type * amba_conf, int vendor, int device, amba_ahb_device * devs, int maxno) { unsigned int conf, mbar, addr; int i, j, cnt; for (cnt = i = 0; (i < amba_conf->ahbmst.devnr) && (maxno < cnt); i++) { conf = amba_get_confword (amba_conf->ahbslv, i, 0); if ((amba_vendor (conf) == vendor) && (amba_device (conf) == device)) { for (j = 0; j < 4; j++) { mbar = amba_ahb_get_membar (amba_conf->ahbmst, i, j); addr = amba_membar_start (mbar); if (amba_membar_type (mbar) == AMBA_TYPE_AHBIO) { addr = AMBA_TYPE_AHBIO_ADDR (addr, amba_conf->ioarea); } else { /* convert address if needed */ if ((addr = addr_from (amba_conf->mmaps, addr)) == 1) { addr = 0; /* no available memory translation available, will not be able to access * Plug&Play information for this AHB address. Skip it. */ } } devs[cnt].start[j] = addr; } devs[cnt].irq = amba_irq (conf); devs[cnt].ver = amba_ver (conf); cnt++; } } return cnt; }
void amba_scan (amba_confarea_type * amba_conf, unsigned int ioarea, struct amba_mmap *mmaps) { unsigned int *cfg_area; /* address to configuration area */ unsigned int mbar, conf, custom; int i, j; unsigned int apbmst; int maxloops = amba_conf->notroot ? 16 : 64; /* scan first bus for 64 devices, rest for 16 devices */ amba_conf->ahbmst.devnr = 0; amba_conf->ahbslv.devnr = 0; amba_conf->apbslv.devnr = 0; cfg_area = (unsigned int *) (ioarea | AMBA_CONF_AREA); amba_conf->ioarea = ioarea; amba_conf->mmaps = mmaps; for (i = 0; i < maxloops; i++) { amba_insert_device (&amba_conf->ahbmst, cfg_area); cfg_area += AMBA_AHB_CONF_WORDS; } cfg_area = (unsigned int *) (ioarea | AMBA_CONF_AREA | AMBA_AHB_SLAVE_CONF_AREA); for (i = 0; i < maxloops; i++) { amba_insert_device (&amba_conf->ahbslv, cfg_area); cfg_area += AMBA_AHB_CONF_WORDS; } for (i = 0; i < amba_conf->ahbslv.devnr; i++){ conf = amba_get_confword(amba_conf->ahbslv, i, 0); mbar = amba_ahb_get_membar(amba_conf->ahbslv, i, 0); if ( (amba_vendor(conf) == VENDOR_GAISLER) && (amba_device(conf) == GAISLER_AHB2AHB) ){ /* Found AHB->AHB bus bridge, scan it if more free amba_confarea_type:s available * Custom config 1 contain ioarea. */ custom = amba_ahb_get_custom(amba_conf->ahbslv,i,1); if ( amba_ver(conf) && amba_conf->next ){ amba_conf->next->notroot = 1; amba_scan(amba_conf->next,custom,mmaps); } }else if ((amba_vendor(conf) == VENDOR_GAISLER) && (amba_device(conf) == GAISLER_APBMST)) { apbmst = amba_membar_start(mbar); if ( (apbmst=addr_from(mmaps,apbmst)) == 1 ) continue; /* no available memory translation available, will not be able to access * Plug&Play information for this AHB/APB bridge. Skip it. */ cfg_area = (unsigned int *)( apbmst | AMBA_CONF_AREA); for (j=0; (amba_conf->apbslv.devnr<AMBA_APB_SLAVES) && (j<AMBA_APB_SLAVES); j++){ amba_insert_apb_device(&amba_conf->apbslv, cfg_area, apbmst); cfg_area += AMBA_APB_CONF_WORDS; } } } }
void amba_prinf_config(void) { char devbuf[128]; char vendorbuf[128]; unsigned int conf; int i = 0; int j = 0; unsigned int addr; unsigned int m; printf(" Vendors Slaves\n"); printf("Ahb masters:\n"); i = 0; while (i < amba_conf.ahbmst.devnr) { conf = amba_get_confword(amba_conf.ahbmst, i, 0); vendor_dev_string(conf, vendorbuf, devbuf); printf("%2i(%2x:%3x|%2i): %16s %16s \n", i, amba_vendor(conf), amba_device(conf), amba_irq(conf), vendorbuf, devbuf); for (j = 0; j < 4; j++) { m = amba_ahb_get_membar(amba_conf.ahbmst, i, j); if (m) { addr = amba_membar_start(m); printf(" +%i: 0x%x \n", j, addr); } } i++; } printf("Ahb slaves:\n"); i = 0; while (i < amba_conf.ahbslv.devnr) { conf = amba_get_confword(amba_conf.ahbslv, i, 0); vendor_dev_string(conf, vendorbuf, devbuf); printf("%2i(%2x:%3x|%2i): %16s %16s \n", i, amba_vendor(conf), amba_device(conf), amba_irq(conf), vendorbuf, devbuf); for (j = 0; j < 4; j++) { m = amba_ahb_get_membar(amba_conf.ahbslv, i, j); if (m) { addr = amba_membar_start(m); if (amba_membar_type(m) == AMBA_TYPE_AHBIO) { addr = AMBA_TYPE_AHBIO_ADDR(addr); } else if (amba_membar_type(m) == AMBA_TYPE_APBIO) { printf("Warning: apbio membar\n"); } printf(" +%i: 0x%x (raw:0x%x)\n", j, addr, m); } } i++; } printf("Apb slaves:\n"); i = 0; while (i < amba_conf.apbslv.devnr) { conf = amba_get_confword(amba_conf.apbslv, i, 0); vendor_dev_string(conf, vendorbuf, devbuf); printf("%2i(%2x:%3x|%2i): %16s %16s \n", i, amba_vendor(conf), amba_device(conf), amba_irq(conf), vendorbuf, devbuf); m = amba_apb_get_membar(amba_conf.apbslv, i); addr = amba_iobar_start(amba_conf.apbslv.apbmst[i], m); printf(" +%2i: 0x%x (raw:0x%x) \n", 0, addr, m); i++; } }