qualcomm/qbox
Loading...
Searching...
No Matches
mpm_control.h
1/*
2 * Copyright (c) 2022 Qualcomm Innovation Center, Inc. All Rights Reserved.
3 *
4 * SPDX-License-Identifier: BSD-3-Clause
5 */
6
7#pragma once
8
9#include <ports/initiator-signal-socket.h>
10#include <module_factory_container.h>
11#include <systemc>
12#include <tlm>
13#include <tlm_utils/simple_target_socket.h>
14
15#include <scp/report.h>
16#include <tlm_sockets_buswidth.h>
17
18#define REGION_SIZE 0x1000
19#define REGION_MASK REGION_SIZE - 1
20
21enum {
22 MPM_CONTROL_CNTCR = 0x0,
23 MPM_CONTROL_CNTSR = 0x4,
24 MPM_CONTROL_CNTCV_L = 0x8,
25 MPM_CONTROL_CNTCV_HI = 0xC,
26 MPM_CONTROL_CNTFID0 = 0x20,
27 MPM_CONTROL_ID = 0xFD0,
28};
29
30class mpm_control : public sc_core::sc_module
31{
32private:
33 sc_core::sc_event update_ev;
34
35public:
36 tlm_utils::simple_target_socket<mpm_control, DEFAULT_TLM_BUSWIDTH> socket;
37
38private:
39 // Called after dev_write.
40 void dev_update() {}
41
42 // Explicit designated initializers are not needed but can insure
43 // more reliable initial state.
44 uint32_t register_range[REGION_SIZE / 4];
45
46 void dev_write(uint64_t offset, uint32_t val, unsigned size)
47 {
48 SCP_DEBUG(SCMOD) << std::hex << "write offset " << offset;
49 uint32_t reg_index = offset / 4;
50 switch (offset) {
51 case MPM_CONTROL_CNTCR:
52 register_range[reg_index] = val;
53 break;
54 case MPM_CONTROL_CNTSR:
55 SCP_WARN(SCMOD) << "Read Only Register MPM_CONTROL_CNTSR";
56 break;
57 case MPM_CONTROL_CNTCV_L:
58 register_range[reg_index] = val;
59 break;
60 case MPM_CONTROL_CNTCV_HI:
61 register_range[reg_index] = val;
62 break;
63 case MPM_CONTROL_CNTFID0:
64 register_range[reg_index] = val;
65 break;
66 case MPM_CONTROL_ID:
67 SCP_WARN(SCMOD) << "Read Only Register MPM_CONTROL_ID";
68 break;
69 default:
70 SCP_WARN(SCMOD) << "Unimplemented write";
71 break;
72 }
73
74 update_ev.notify();
75 }
76
77 uint32_t dev_read(uint64_t offset, unsigned size)
78 {
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;
83 switch (offset) {
84 case MPM_CONTROL_CNTCR:
85 return *(register_range + reg_index);
86 break;
87 case MPM_CONTROL_CNTSR:
88 return *(register_range + reg_index);
89 break;
90 case MPM_CONTROL_CNTCV_L:
91 register_range[reg_index] = (uint32_t)clocks;
92 return register_range[reg_index];
93 break;
94 case MPM_CONTROL_CNTCV_HI:
95 register_range[reg_index] = (uint32_t)(clocks >> 32);
96 return register_range[reg_index];
97 break;
98 case MPM_CONTROL_CNTFID0:
99 return *(register_range + reg_index);
100 break;
101 case MPM_CONTROL_ID:
102 return *(register_range + reg_index);
103 break;
104 default:
105 SCP_WARN(SCMOD) << "Unimplemented read";
106 return 0x0;
107 }
108 return 0;
109 }
110
111 void dev_reset()
112 {
113 memset(register_range, 0, sizeof(register_range));
114 register_range[MPM_CONTROL_CNTFID0 / 4] = 0x124F800;
115 register_range[MPM_CONTROL_ID / 4] = 0x10000000;
116 dev_update();
117 }
118
119 void b_transport(tlm::tlm_generic_payload& txn, sc_core::sc_time& delay)
120 {
121 unsigned int len = txn.get_data_length();
122 unsigned char* ptr = txn.get_data_ptr();
123 sc_dt::uint64 addr = txn.get_address();
124 assert(len == 4);
125
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;
131 break;
132 }
133 case tlm::TLM_WRITE_COMMAND: {
134 uint32_t data;
135 memcpy(&data, ptr, len);
136 SCP_INFO(SCMOD) << "b_transport write " << std::hex << addr << " " << data;
137 dev_write(addr & REGION_MASK, data, len);
138 break;
139 }
140 default:
141 SCP_ERR(SCMOD) << "TLM command not supported";
142 break;
143 }
144
145 txn.set_response_status(tlm::TLM_OK_RESPONSE);
146 }
147
148public:
149 mpm_control(sc_core::sc_module_name name): socket("socket")
150 {
151 socket.register_b_transport(this, &mpm_control::b_transport);
152 SC_THREAD(dev_reset);
153
154 SC_METHOD(dev_update);
155 sensitive << update_ev;
156 }
157};
158
159extern "C" void module_register();