/* 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 reportahbdevice()
{
unsigned int pahb, ahb;
unsigned int vendor, device;
unsigned int membase = 0;
int i = 0;
int j = 0;
unsigned int tmp = 0;
int ahb_addr = ( int )(LEON3_IO_AREA | LEON3_CONF_AREA | LEON3_AHB_SLAVE_CONF_AREA );
for (i = 0; i < LEON3_AHB_SLAVES ; i++ )
{
pahb = (ahb_addr + (i * LEON3_AHB_CONF_WORDS * 4));
ahb = ramread(pahb);
vendor = amba_vendor(ahb);
device = amba_device(ahb);
if (vendor != 0 && device !=0 )
{
printf("%02x.%02x:%03x ", i, vendor, device);
printdevice(device, vendor);
printf("(ver %d)", amba_ver(ahb));
printf("\n");
if (amba_irq(ahb) != 0)
{
printf("%16s %d \n", "irq", amba_irq(ahb));
}
for (j = 0; j < 4; j++)
{
tmp = ramread(pahb + 0x10 + j * 4);
if (tmp != 0x00000000)
{
membase = getmembase(tmp);
printf(" %16s %8.8x - %8.8x \n", "ahb:", membase, membase + (0xffffffff - ((tmp & 0xfff0) << 16) + 1));
}
}
if ((vendor == 0x41) && (device == 0x021))
{
tmp = ramread(0x08000000);
printf("%12s %d-bit prom @ 0x%8.8x \n", "", ((((tmp >> 8) & 0x3) == 1)? 16 : 8), 0x00000000);
tmp = ramread(0x08000000 + 4);
printf("%12s %d-bit sram @ 0x%8.8x \n", "", ((((tmp >> 4) & 0x3) == 1)? 32 : 16), 0x04000000);
}
if ((vendor == 0x01) && (device == 0x004))
{
printf("%12s AHB trace 128 lines \n", "");
printf("%12s CPU#0 win 8, whbp 4, itrace 128, V8 mul/div, lddel 1, GRFPU-lite \n", "");
ramwrite(0x90400024, 2);
tmp =ramread(0x90700000 + 0x8);
printf("%12s icache 1 * %d kbyte, %d byte/line\n", "", (((tmp >> 20)&0xf)==2)?4:2, (((tmp >> 16)&0x7)==3)?32:16);
tmp =ramread(0x90700000 + 0xc);
printf("%12s dcache 1 * %d kbyte, %d byte/line\n", "", (((tmp >> 20)&0xf)==2)?4:2, (((tmp >> 16)&0x7)==3)?32:16);
}
/* Parse APB PnP Information */
void ambapp_apb_parse(struct ambapp_find_apb_info *info, ambapp_apbdev *dev)
{
struct ambapp_pnp_apb *apb = info->pnp;
unsigned int apbbase = (unsigned int)apb & 0xfff00000;
dev->vendor = amba_vendor(apb->id);
dev->device = amba_device(apb->id);
dev->irq = amba_irq(apb->id);
dev->ver = amba_ver(apb->id);
dev->address = (apbbase | (((apb->iobar & 0xfff00000) >> 12))) &
(((apb->iobar & 0x0000fff0) << 4) | 0xfff00000);
dev->mask = amba_apb_mask(apb->iobar);
dev->ahb_bus_index = info->ahb_bus_index - 1;
}
// amba scan operation
void reportahbmasterdevice()
{
unsigned int pahb, ahb;
unsigned int vendor, device;
int i = 0;
int ahb_addr = ( int )(LEON3_IO_AREA | LEON3_CONF_AREA );
for (i = 0; i < LEON3_AHB_MASTERS ; i++ )
{
pahb = (ahb_addr + (i * LEON3_AHB_CONF_WORDS * 4));
ahb = ramread(pahb);
vendor = amba_vendor(ahb);
device = amba_device(ahb);
if (vendor != 0 && device !=0 )
{
printf("%02x.%02x:%03x ", i, vendor, device);
printdevice(device, vendor);
printf("(ver %d)", amba_ver(ahb));
printf("\n");
printf("%23s %d \n", "ahb master", i);
}
}
return ;
}
static int ambapp_apb_scan(unsigned int vendor, /* Plug&Play Vendor ID */
unsigned int driver, /* Plug&Play Device ID */
ambapp_apbdev * dev, /* Result(s) is placed here */
int index, /* Index of device to start copying Plug&Play
* info into dev
*/
int max_cnt /* Maximal count that dev can hold, if dev
* is NULL function will stop scanning after
* max_cnt devices are found.
*/
)
{
int i, cnt = 0;
unsigned int apbmst_base;
ambapp_ahbdev apbmst;
apbctrl_pp_dev *apb;
if (max_cnt == 0)
return 0;
/* Get AMBA APB Master */
if (ambapp_ahbslv_first(VENDOR_GAISLER, GAISLER_APBMST, &apbmst) != 1) {
return 0;
}
/* Get APB CTRL Plug&Play info area */
apbmst_base = apbmst.address[0] & LEON3_IO_AREA;
apb = (apbctrl_pp_dev *) (apbmst_base | LEON3_CONF_AREA);
for (i = 0; i < LEON3_APB_SLAVES; i++) {
#if defined(CONFIG_CMD_AMBAPP)
if (ambapp_apb_print && amba_vendor(apb->conf)
&& amba_device(apb->conf)) {
ambapp_print_apb(apb, &apbmst, i);
}
#endif
if ((amba_vendor(apb->conf) == vendor) &&
(amba_device(apb->conf) == driver) && ((index < 0)
|| (index-- == 0))) {
/* Convert Plug&Play info into a more readable format */
cnt++;
if (dev) {
dev->irq = amba_irq(apb->conf);
dev->ver = amba_ver(apb->conf);
dev->address =
(apbmst_base |
(((apb->
bar & 0xfff00000) >> 12))) & (((apb->
bar &
0x0000fff0)
<< 4) |
0xfff00000);
dev++;
}
/* found max devices? */
if (cnt >= max_cnt)
return cnt;
}
/* Get next Plug&Play entry */
apb++;
}
