jackcartersmith/blackmagic
1
0
Fork 0
Code Issues Pull Requests Releases Activity

adding adiv5 support

Browse Source
This commit is contained in:
Jason Kotzin 2022-08-01 17:45:49 -07:00
parent f99fe59ce8
commit 9c95dfb712
1 changed files with 17 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

17
src/target/adiv5.c
View File

@ -246,6 +246,23 @@ static uint32_t adiv5_mem_read32(ADIv5_AP_t *ap, uint32_t addr)
return ret; return ret;
} }
static uint32_t adiv5_ap_read_id(ADIv5_AP_t *ap, uint32_t addr)
{
uint32_t res = 0;
for (int i = 0; i < 4; i++) {
uint32_t x = adiv5_mem_read32(ap, addr + 4 * i);
res |= (x & 0xff) << (i * 8);
}
return res;
}
uint64_t adiv5_ap_read_pidr(ADIv5_AP_t *ap, uint32_t addr)
{
uint64_t pidr = adiv5_ap_read_id(ap, addr + PIDR4_OFFSET);
pidr = pidr << 32 | adiv5_ap_read_id(ap, addr + PIDR0_OFFSET);
return pidr;
}
static void adiv5_component_probe(ADIv5_AP_t *ap, uint32_t addr) static void adiv5_component_probe(ADIv5_AP_t *ap, uint32_t addr)
{ {
addr &= ~3; addr &= ~3;