l4/pkg/drivers/generic/src/amba.cc

   1
   2 #include <l4/drivers/io_regblock.h>
   3 #include <l4/drivers/amba.h>
   4
   5
   6 void amba_read_id(l4_addr_t address, uint32_t *periphid, uint32_t *cellid)
   7 {
   8   L4::Io_register_block_mmio b(address);
   9
  10   *periphid =   ((b.read32( 0) & 0xff) << 0)
  11               | ((b.read32( 4) & 0xff) << 8)
  12               | ((b.read32( 8) & 0xff) << 16)
  13               | ((b.read32(12) & 0xff) << 24);
  14
  15   *cellid   =   ((b.read32(16) & 0xff) << 0)
  16               | ((b.read32(20) & 0xff) << 8)
  17               | ((b.read32(24) & 0xff) << 16)
  18               | ((b.read32(28) & 0xff) << 24);
  19 }