178 lines
5.0 KiB
C++
178 lines
5.0 KiB
C++
|
#include "Memory.h"
|
||
|
|
||
|
SC_HAS_PROCESS(Memory);
|
||
|
Memory::Memory(sc_module_name name, string filename): sc_module(name)
|
||
|
,socket("socket")
|
||
|
,LATENCY(SC_ZERO_TIME) {
|
||
|
// Register callbacks for incoming interface method calls
|
||
|
socket.register_b_transport( this, &Memory::b_transport);
|
||
|
socket.register_get_direct_mem_ptr(this, &Memory::get_direct_mem_ptr);
|
||
|
socket.register_transport_dbg( this, &Memory::transport_dbg);
|
||
|
|
||
|
memset(mem, 0, SIZE*sizeof(int));
|
||
|
// readCustomHexFile("memory.hex");
|
||
|
readHexFile(filename);
|
||
|
|
||
|
SC_THREAD(invalidation_process);
|
||
|
}
|
||
|
|
||
|
|
||
|
void Memory::b_transport( tlm::tlm_generic_payload& trans, sc_time& delay )
|
||
|
{
|
||
|
tlm::tlm_command cmd = trans.get_command();
|
||
|
sc_dt::uint64 adr = trans.get_address() / 4;
|
||
|
unsigned char* ptr = trans.get_data_ptr();
|
||
|
unsigned int len = trans.get_data_length();
|
||
|
unsigned char* byt = trans.get_byte_enable_ptr();
|
||
|
unsigned int wid = trans.get_streaming_width();
|
||
|
|
||
|
// Obliged to check address range and check for unsupported features,
|
||
|
// i.e. byte enables, streaming, and bursts
|
||
|
// Can ignore extensions
|
||
|
|
||
|
// *********************************************
|
||
|
// Generate the appropriate error response
|
||
|
// *********************************************
|
||
|
|
||
|
if (adr >= sc_dt::uint64(SIZE)) {
|
||
|
trans.set_response_status( tlm::TLM_ADDRESS_ERROR_RESPONSE );
|
||
|
return;
|
||
|
}
|
||
|
if (byt != 0) {
|
||
|
trans.set_response_status( tlm::TLM_BYTE_ENABLE_ERROR_RESPONSE );
|
||
|
return;
|
||
|
}
|
||
|
if (len > 4 || wid < len) {
|
||
|
trans.set_response_status( tlm::TLM_BURST_ERROR_RESPONSE );
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
// cout << "MEM: addr=" << adr << endl;
|
||
|
// cout << "MEM: data=" << mem[adr] << endl;
|
||
|
|
||
|
// Obliged to implement read and write commands
|
||
|
if ( cmd == tlm::TLM_READ_COMMAND )
|
||
|
memcpy(ptr, &mem[adr], len);
|
||
|
else if ( cmd == tlm::TLM_WRITE_COMMAND )
|
||
|
memcpy(&mem[adr], ptr, len);
|
||
|
|
||
|
// Illustrates that b_transport may block
|
||
|
wait(delay);
|
||
|
|
||
|
// Reset timing annotation after waiting
|
||
|
delay = SC_ZERO_TIME;
|
||
|
|
||
|
// *********************************************
|
||
|
// Set DMI hint to indicated that DMI is supported
|
||
|
// *********************************************
|
||
|
|
||
|
trans.set_dmi_allowed(true);
|
||
|
|
||
|
// Obliged to set response status to indicate successful completion
|
||
|
trans.set_response_status( tlm::TLM_OK_RESPONSE );
|
||
|
}
|
||
|
|
||
|
bool Memory::get_direct_mem_ptr(tlm::tlm_generic_payload& trans,
|
||
|
tlm::tlm_dmi& dmi_data)
|
||
|
{
|
||
|
// Permit read and write access
|
||
|
dmi_data.allow_read_write();
|
||
|
|
||
|
// Set other details of DMI region
|
||
|
dmi_data.set_dmi_ptr( reinterpret_cast<unsigned char*>( &mem[0] ) );
|
||
|
dmi_data.set_start_address( 0 );
|
||
|
dmi_data.set_end_address( SIZE*4-1 );
|
||
|
dmi_data.set_read_latency( LATENCY );
|
||
|
dmi_data.set_write_latency( LATENCY );
|
||
|
|
||
|
return true;
|
||
|
}
|
||
|
|
||
|
|
||
|
void Memory::invalidation_process()
|
||
|
{
|
||
|
// Invalidate DMI pointers periodically
|
||
|
for (int i = 0; i < 4; i++)
|
||
|
{
|
||
|
wait(LATENCY*8);
|
||
|
socket->invalidate_direct_mem_ptr(0, SIZE-1);
|
||
|
}
|
||
|
}
|
||
|
|
||
|
|
||
|
unsigned int Memory::transport_dbg(tlm::tlm_generic_payload& trans)
|
||
|
{
|
||
|
tlm::tlm_command cmd = trans.get_command();
|
||
|
sc_dt::uint64 adr = trans.get_address() / 4;
|
||
|
unsigned char* ptr = trans.get_data_ptr();
|
||
|
unsigned int len = trans.get_data_length();
|
||
|
|
||
|
// Calculate the number of bytes to be actually copied
|
||
|
unsigned int num_bytes = (len < (SIZE - adr) * 4) ? len : (SIZE - adr) * 4;
|
||
|
|
||
|
if ( cmd == tlm::TLM_READ_COMMAND )
|
||
|
memcpy(ptr, &mem[adr], num_bytes);
|
||
|
else if ( cmd == tlm::TLM_WRITE_COMMAND )
|
||
|
memcpy(&mem[adr], ptr, num_bytes);
|
||
|
|
||
|
return num_bytes;
|
||
|
}
|
||
|
|
||
|
|
||
|
void Memory::readCustomHexFile(string filename) {
|
||
|
ifstream hexfile;
|
||
|
string line;
|
||
|
int i = 0;
|
||
|
|
||
|
hexfile.open(filename);
|
||
|
if (hexfile.is_open()) {
|
||
|
while(getline(hexfile, line) ) {
|
||
|
/* # is a comentary in the file */
|
||
|
if (line[0] != '#') {
|
||
|
cout << "i: " << i << endl;
|
||
|
mem[i] = stol(line.substr(0,8), nullptr, 16);
|
||
|
i++;
|
||
|
}
|
||
|
}
|
||
|
hexfile.close();
|
||
|
} else {
|
||
|
SC_REPORT_ERROR("Memory", "Open file error");
|
||
|
}
|
||
|
}
|
||
|
|
||
|
|
||
|
void Memory::readHexFile(string filename) {
|
||
|
ifstream hexfile;
|
||
|
string line;
|
||
|
int byte_count;
|
||
|
int address;
|
||
|
int i = 0;
|
||
|
|
||
|
hexfile.open(filename);
|
||
|
|
||
|
if (hexfile.is_open()) {
|
||
|
while(getline(hexfile, line) ) {
|
||
|
/* # is a comentary in the file */
|
||
|
if (line[0] == ':') {
|
||
|
|
||
|
if (line.substr(7,2) == "00")
|
||
|
{
|
||
|
/* Data */
|
||
|
byte_count = stol(line.substr(1,2), nullptr, 16);
|
||
|
address = stol(line.substr(3,4), nullptr, 16) / 4;
|
||
|
|
||
|
for (i=0; i < byte_count/4; i++) {
|
||
|
mem[address+i] = stol(line.substr(9+(i*8), 2), nullptr, 16);
|
||
|
mem[address+i] |= stol(line.substr(11+(i*8),2), nullptr, 16) << 8;
|
||
|
mem[address+i] |= stol(line.substr(13+(i*8),2), nullptr, 16) << 16;
|
||
|
mem[address+i] |= stol(line.substr(15+(i*8),2), nullptr, 16) << 24;
|
||
|
}
|
||
|
}
|
||
|
}
|
||
|
}
|
||
|
hexfile.close();
|
||
|
} else {
|
||
|
SC_REPORT_ERROR("Memory", "Open file error");
|
||
|
}
|
||
|
}
|