30class mpm_control :
public sc_core::sc_module
33 sc_core::sc_event update_ev;
36 tlm_utils::simple_target_socket<mpm_control, DEFAULT_TLM_BUSWIDTH> socket;
44 uint32_t register_range[REGION_SIZE / 4];
46 void dev_write(uint64_t offset, uint32_t val,
unsigned size)
48 SCP_DEBUG(SCMOD) << std::hex <<
"write offset " << offset;
49 uint32_t reg_index = offset / 4;
51 case MPM_CONTROL_CNTCR:
52 register_range[reg_index] = val;
54 case MPM_CONTROL_CNTSR:
55 SCP_WARN(SCMOD) <<
"Read Only Register MPM_CONTROL_CNTSR";
57 case MPM_CONTROL_CNTCV_L:
58 register_range[reg_index] = val;
60 case MPM_CONTROL_CNTCV_HI:
61 register_range[reg_index] = val;
63 case MPM_CONTROL_CNTFID0:
64 register_range[reg_index] = val;
67 SCP_WARN(SCMOD) <<
"Read Only Register MPM_CONTROL_ID";
70 SCP_WARN(SCMOD) <<
"Unimplemented write";
77 uint32_t dev_read(uint64_t offset,
unsigned size)
79 SCP_DEBUG(SCMOD) << std::hex <<
"read offset " << offset;
80 double time = sc_core::sc_time_stamp().to_seconds();
81 uint64_t clocks = time * register_range[MPM_CONTROL_CNTFID0 / 4];
82 uint32_t reg_index = offset / 4;
84 case MPM_CONTROL_CNTCR:
85 return *(register_range + reg_index);
87 case MPM_CONTROL_CNTSR:
88 return *(register_range + reg_index);
90 case MPM_CONTROL_CNTCV_L:
91 register_range[reg_index] = (uint32_t)clocks;
92 return register_range[reg_index];
94 case MPM_CONTROL_CNTCV_HI:
95 register_range[reg_index] = (uint32_t)(clocks >> 32);
96 return register_range[reg_index];
98 case MPM_CONTROL_CNTFID0:
99 return *(register_range + reg_index);
102 return *(register_range + reg_index);
105 SCP_WARN(SCMOD) <<
"Unimplemented read";
113 memset(register_range, 0,
sizeof(register_range));
114 register_range[MPM_CONTROL_CNTFID0 / 4] = 0x124F800;
115 register_range[MPM_CONTROL_ID / 4] = 0x10000000;
119 void b_transport(tlm::tlm_generic_payload& txn, sc_core::sc_time& delay)
121 unsigned int len = txn.get_data_length();
122 unsigned char* ptr = txn.get_data_ptr();
123 sc_dt::uint64 addr = txn.get_address();
126 switch (txn.get_command()) {
127 case tlm::TLM_READ_COMMAND: {
128 uint32_t data = dev_read(addr & REGION_MASK, len);
129 memcpy(ptr, &data, len);
130 SCP_INFO(SCMOD) <<
"b_transport read " << std::hex << addr <<
" " << data;
133 case tlm::TLM_WRITE_COMMAND: {
135 memcpy(&data, ptr, len);
136 SCP_INFO(SCMOD) <<
"b_transport write " << std::hex << addr <<
" " << data;
137 dev_write(addr & REGION_MASK, data, len);
141 SCP_ERR(SCMOD) <<
"TLM command not supported";
145 txn.set_response_status(tlm::TLM_OK_RESPONSE);
149 mpm_control(sc_core::sc_module_name name): socket(
"socket")
151 socket.register_b_transport(
this, &mpm_control::b_transport);
152 SC_THREAD(dev_reset);
154 SC_METHOD(dev_update);
155 sensitive << update_ev;