fix fast exception handling for pi_st
[soc.git] / src / soc / config / test / test_pi2ls.py
1 from nmigen import Signal, Module, Record
2 from nmigen.back.pysim import Simulator, Delay
3 from nmigen.compat.sim import run_simulation, Settle
4 from nmutil.formaltest import FHDLTestCase
5 from nmigen.cli import rtlil
6 import unittest
7 from soc.config.test.test_loadstore import TestMemPspec
8 from soc.config.loadstore import ConfigMemoryPortInterface
9
10
11 def wait_busy(port, no=False, debug=None):
12 cnt = 0
13 while True:
14 busy = yield port.busy_o
15 print("busy", no, busy, cnt, debug)
16 if bool(busy) == no:
17 break
18 yield
19 cnt += 1
20
21
22 def wait_addr(port,debug=None):
23 cnt = 0
24 while True:
25 addr_ok = yield port.addr_ok_o
26 print("addrok", addr_ok,cnt,debug)
27 if addr_ok:
28 break
29 yield
30 cnt += 1
31
32
33 def wait_ldok(port):
34 cnt = 0
35 while True:
36 ldok = yield port.ld.ok
37 exc_happened = yield port.exc_o.happened
38 print("ldok", ldok, "exception", exc_happened, "count", cnt)
39 cnt += 1
40 if ldok or exc_happened:
41 break
42 yield
43
44
45 def pi_st(port1, addr, data, datalen, msr_pr=0, is_dcbz=0):
46
47 # have to wait until not busy
48 yield from wait_busy(port1,debug="pi_st_A") # wait while busy
49
50 # set up a ST on the port. address first:
51 yield port1.is_dcbz_i.eq(is_dcbz) # reset dcbz too
52 yield port1.is_st_i.eq(1) # indicate ST
53 yield port1.data_len.eq(datalen) # ST length (1/2/4/8)
54 yield port1.msr_pr.eq(msr_pr) # MSR PR bit (1==>virt, 0==>real)
55
56 yield port1.addr.data.eq(addr) # set address
57 yield port1.addr.ok.eq(1) # set ok
58 yield Settle()
59 yield from wait_addr(port1) # wait until addr ok
60 yield from wait_addr(port1) # wait until addr ok
61
62 # yield # not needed, just for checking
63 # yield # not needed, just for checking
64 # assert "ST" for one cycle (required by the API)
65 yield port1.st.data.eq(data)
66 yield port1.st.ok.eq(1)
67 yield
68 yield port1.st.ok.eq(0)
69 exc_happened = yield port1.exc_o.happened
70 if exc_happened:
71 print("print fast exception happened")
72 yield port1.is_st_i.eq(0) # end
73 yield port1.addr.ok.eq(0) # set !ok
74 yield port1.is_dcbz_i.eq(0) # reset dcbz too
75 return "fast"
76 yield from wait_busy(port1,debug="pi_st_E") # wait while busy
77
78 # can go straight to reset.
79 yield port1.is_st_i.eq(0) # end
80 yield port1.addr.ok.eq(0) # set !ok
81 yield port1.is_dcbz_i.eq(0) # reset dcbz too
82
83 return None
84
85
86 # copy of pi_st removed
87
88 def pi_ld(port1, addr, datalen, msr_pr=0):
89
90 # have to wait until not busy
91 yield from wait_busy(port1,debug="pi_ld_A") # wait while busy
92
93 # set up a LD on the port. address first:
94 yield port1.is_ld_i.eq(1) # indicate LD
95 yield port1.data_len.eq(datalen) # LD length (1/2/4/8)
96 yield port1.msr_pr.eq(msr_pr) # MSR PR bit (1==>virt, 0==>real)
97
98 yield port1.addr.data.eq(addr) # set address
99 yield port1.addr.ok.eq(1) # set ok
100 yield Settle()
101 yield from wait_addr(port1) # wait until addr ok
102 exc_happened = yield port1.exc_o.happened
103 if exc_happened:
104 print("print fast exception happened")
105 yield port1.is_ld_i.eq(0) # end
106 yield port1.addr.ok.eq(0) # set !ok
107 return 0, "fast"
108
109 yield
110 yield from wait_ldok(port1) # wait until ld ok
111 data = yield port1.ld.data
112 exc_happened = yield port1.exc_o.happened
113
114 # cleanup
115 yield port1.is_ld_i.eq(0) # end
116 yield port1.addr.ok.eq(0) # set !ok
117 if exc_happened:
118 return 0, "slow"
119
120 yield from wait_busy(port1,debug="pi_ld_E") # wait while busy
121
122 return data, None
123
124
125 def pi_ldst(arg, dut, msr_pr=0):
126
127 # do two half-word stores at consecutive addresses, then two loads
128 addr1 = 0x04
129 addr2 = addr1 + 0x2
130 data = 0xbeef
131 data2 = 0xf00f
132 #data = 0x4
133 assert(yield from pi_st(dut, addr1, data, 2, msr_pr) is None)
134 assert(yield from pi_st(dut, addr2, data2, 2, msr_pr) is None)
135 result, exc = yield from pi_ld(dut, addr1, 2, msr_pr)
136 result2, exc2 = yield from pi_ld(dut, addr2, 2, msr_pr)
137 assert(exc is None)
138 assert(exc2 is None)
139 arg.assertEqual(data, result, "data %x != %x" % (result, data))
140 arg.assertEqual(data2, result2, "data2 %x != %x" % (result2, data2))
141
142 # now load both in a 32-bit load to make sure they're really consecutive
143 data3 = data | (data2 << 16)
144 result3, exc3 = yield from pi_ld(dut, addr1, 4, msr_pr)
145 assert(exc3 is None)
146 arg.assertEqual(data3, result3, "data3 %x != %x" % (result3, data3))
147
148
149 def tst_config_pi(testcls, ifacetype):
150 """set up a configureable memory test of type ifacetype
151 """
152 dut = Module()
153 pspec = TestMemPspec(ldst_ifacetype=ifacetype,
154 imem_ifacetype='',
155 addr_wid=48,
156 mask_wid=8,
157 reg_wid=64)
158 cmpi = ConfigMemoryPortInterface(pspec)
159 dut.submodules.pi = cmpi.pi
160 if hasattr(cmpi, 'lsmem'): # hmmm not happy about this
161 dut.submodules.lsmem = cmpi.lsmem.lsi
162 vl = rtlil.convert(dut, ports=[]) # dut.ports())
163 with open("test_pi_%s.il" % ifacetype, "w") as f:
164 f.write(vl)
165
166 run_simulation(dut, {"sync": pi_ldst(testcls, cmpi.pi.pi)},
167 vcd_name='test_pi_%s.vcd' % ifacetype)
168
169
170 class TestPIMem(unittest.TestCase):
171
172 def test_pi_mem(self):
173 tst_config_pi(self, 'testpi')
174
175 def test_pi2ls(self):
176 tst_config_pi(self, 'testmem')
177
178 def test_pi2ls_bare_wb(self):
179 tst_config_pi(self, 'test_bare_wb')
180
181
182 if __name__ == '__main__':
183 unittest.main()