export memory read and write functions
This commit is contained in:
parent
a91adb3a7d
commit
a478ef7639
1 changed files with 42 additions and 3 deletions
|
@ -85,20 +85,59 @@ class _RegistersVPI : public _RegistersBase<T, nr> {
|
||||||
};
|
};
|
||||||
|
|
||||||
typedef _RegistersVPI<uint32_t, 32> Registers;
|
typedef _RegistersVPI<uint32_t, 32> Registers;
|
||||||
|
|
||||||
template <typename T, std::size_t n>
|
template <typename T, std::size_t n>
|
||||||
class Memory {
|
class Memory {
|
||||||
std::array<T, n> mem;
|
std::array<T, n> mem;
|
||||||
size_t addr_to_index(size_t addr) {
|
size_t addr_to_index(size_t addr) {
|
||||||
// Linear mapping
|
// Linear mapping
|
||||||
return addr - 0x80000000;
|
return (addr >> 2) - 0x20000000;
|
||||||
|
}
|
||||||
|
uint32_t expand_bits(uint8_t bits) {
|
||||||
|
uint32_t x = bits;
|
||||||
|
x = (x | (x << 7) | (x << 14) | (x << 21)) & 0x01010101;
|
||||||
|
x = x * 0xFF;
|
||||||
|
// printf("expand: %hhx->%x\n", bits, x);
|
||||||
|
return x;
|
||||||
}
|
}
|
||||||
public:
|
public:
|
||||||
const T& operator[](size_t addr) {
|
const T& operator[](size_t addr) {
|
||||||
return mem[addr_to_index(index)];
|
return this->read(addr);
|
||||||
|
}
|
||||||
|
/**
|
||||||
|
* Always reads and returns 4 bytes from the address raddr & ~0x3u.
|
||||||
|
*/
|
||||||
|
T read(int raddr) {
|
||||||
|
return mem[addr_to_index(raddr)];
|
||||||
|
}
|
||||||
|
/**
|
||||||
|
* Always writes to the 4 bytes at the address `waddr` & ~0x3u.
|
||||||
|
* Each bit in `wmask` represents a mask for one byte in wdata.
|
||||||
|
* For example, wmask = 0x3 means only the lowest 2 bytes are written,
|
||||||
|
* and the other bytes in memory remain unchanged.
|
||||||
|
*/
|
||||||
|
void write(int waddr, T wdata, char wmask) {
|
||||||
|
mem[addr_to_index((uint32_t)waddr)] = expand_bits(wmask) & wdata;
|
||||||
}
|
}
|
||||||
};
|
};
|
||||||
|
|
||||||
|
extern "C" {
|
||||||
|
void *pmem_get() {
|
||||||
|
static auto pmem = new Memory<int, 128 * 1024>;
|
||||||
|
return pmem;
|
||||||
|
}
|
||||||
|
int pmem_read(int raddr) {
|
||||||
|
void *pmem = pmem_get();
|
||||||
|
auto mem = static_cast<Memory<int, 128 * 1024>*>(pmem);
|
||||||
|
return mem->read(raddr);
|
||||||
|
}
|
||||||
|
|
||||||
|
void pmem_write(int waddr, int wdata, char wmask) {
|
||||||
|
void *pmem = pmem_get();
|
||||||
|
auto mem = static_cast<Memory<int, 128 * 1024>*>(pmem);
|
||||||
|
return mem->write((size_t)waddr, wdata, wmask);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
template <typename T>
|
template <typename T>
|
||||||
class VlModuleInterfaceCommon : public T {
|
class VlModuleInterfaceCommon : public T {
|
||||||
uint64_t sim_time = 0;
|
uint64_t sim_time = 0;
|
||||||
|
|
Loading…
Reference in a new issue