mem.cpp 6.77 KB
Newer Older
Antoine Kaufmann's avatar
Antoine Kaufmann committed
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
/*
 * Copyright 2021 Max Planck Institute for Software Systems, and
 * National University of Singapore
 *
 * Permission is hereby granted, free of charge, to any person obtaining
 * a copy of this software and associated documentation files (the
 * "Software"), to deal in the Software without restriction, including
 * without limitation the rights to use, copy, modify, merge, publish,
 * distribute, sublicense, and/or sell copies of the Software, and to
 * permit persons to whom the Software is furnished to do so, subject to
 * the following conditions:
 *
 * The above copyright notice and this permission notice shall be
 * included in all copies or substantial portions of the Software.
 *
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
 * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.
 * IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY
 * CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT,
 * TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE
 * SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
 */

Antoine Kaufmann's avatar
Antoine Kaufmann committed
25
26
#include <iostream>

Antoine Kaufmann's avatar
Antoine Kaufmann committed
27
#include "debug.h"
Antoine Kaufmann's avatar
Antoine Kaufmann committed
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
#include "mem.h"
#include "dma.h"

/*
 * 1024 bits total data width
 * = 128 bytes total
 *
 * 1024 / 8 = 128 bit per segment
 * = 16 bytes / segment
 */

#define DATA_WIDTH (512 * 2)
#define SEG_COUNT 8
#define SEG_WIDTH (DATA_WIDTH / SEG_COUNT)

void MemWriter::step()
{
45
46
47
48
49
50
    if (cur && p.mem_ready &&
            ((p.mem_ready & p.mem_valid) == p.mem_valid))
    {
#ifdef MEM_DEBUG
        std::cerr << "completed write to: " << cur->ram_addr << std::endl;
#endif
Antoine Kaufmann's avatar
Antoine Kaufmann committed
51
52
53
        p.mem_valid = 0;
        p.mem_be[0] = p.mem_be[1] = p.mem_be[2] = p.mem_be[3] = 0;

54
55
56
57
58
59
60
61
        if (cur_off == cur->len) {
            /* operation is done */
            pending.pop_front();
            cur->engine->mem_op_complete(cur);
            cur_off = 0;
        } else {
            /* operation is not done yet, we'll pick it back up */
        }
Antoine Kaufmann's avatar
Antoine Kaufmann committed
62
        cur = 0;
63
    } else if (!cur && !pending.empty()) {
Antoine Kaufmann's avatar
Antoine Kaufmann committed
64
65
        cur = pending.front();

66
67
68
#ifdef MEM_DEBUG
        std::cerr << "issuing write to " << cur->ram_addr << std::endl;
#endif
Antoine Kaufmann's avatar
Antoine Kaufmann committed
69
70

        size_t data_byte_width = DATA_WIDTH / 8;
71
        size_t data_offset = (cur->ram_addr + cur_off) % data_byte_width;
Antoine Kaufmann's avatar
Antoine Kaufmann committed
72

Antoine Kaufmann's avatar
Antoine Kaufmann committed
73
74
75
76
77
        /* first reset everything */
        p.mem_sel = 0;
        p.mem_addr[0] = p.mem_addr[1] = p.mem_addr[2] = 0;
        p.mem_be[0] = p.mem_be[1] = p.mem_be[2] = p.mem_be[3] = 0;
        p.mem_valid = 0;
Antoine Kaufmann's avatar
Antoine Kaufmann committed
78
79
        for (size_t i = 0; i < data_byte_width / 4; i++)
            p.mem_data[i] = 0;
Antoine Kaufmann's avatar
Antoine Kaufmann committed
80
81
82
83


        /* put data bytes in the right places */
        size_t off = data_offset;
84
85
86
        size_t cur_len = (cur->len - cur_off > data_byte_width - data_offset ?
                data_byte_width - data_offset : cur->len - cur_off);
        for (size_t i = 0; i < cur_len; i++, off++) {
Antoine Kaufmann's avatar
Antoine Kaufmann committed
87
            size_t byte_off = off % 4;
88
            p.mem_data[off / 4] |= (((uint32_t) cur->data[cur_off + i]) << (byte_off * 8));
Antoine Kaufmann's avatar
Antoine Kaufmann committed
89
90
91
92
            p.mem_be[off / 32] |= (1 << (off % 32));
            p.mem_valid |= (1 << (off / (SEG_WIDTH / 8)));
        }

93
        uint64_t seg_addr = (cur->ram_addr + cur_off) / data_byte_width;
Antoine Kaufmann's avatar
Antoine Kaufmann committed
94
95
96
97
98
99
100
101
102
103
104
        size_t seg_addr_bits = 12;

        // iterate over the address bit by bit
        for (size_t i = 0; i < seg_addr_bits; i++) {
            uint32_t bit = ((seg_addr >> i) & 0x1);
            // iterate over the segments
            for (size_t j = 0; j < SEG_COUNT; j++) {
                size_t dst_bit = j * seg_addr_bits + i;
                p.mem_addr[dst_bit / 32] |= (bit << (dst_bit % 32));
            }
        }
105
106

        cur_off += cur_len;
Antoine Kaufmann's avatar
Antoine Kaufmann committed
107
108
109
110
111
    }
}

void MemWriter::op_issue(DMAOp *op)
{
112
113
114
#ifdef MEM_DEBUG
    std::cerr << "enqueued write to " << op->ram_addr << std::endl;
#endif
Antoine Kaufmann's avatar
Antoine Kaufmann committed
115
116
    pending.push_back(op);
}
Antoine Kaufmann's avatar
Antoine Kaufmann committed
117
118
119
120
121
122
123
124




void MemReader::step()
{
    size_t data_byte_width = DATA_WIDTH / 8;

125
126
    if (cur && p.mem_resvalid &&
            ((p.mem_resvalid & p.mem_valid) == p.mem_valid)) {
Antoine Kaufmann's avatar
Antoine Kaufmann committed
127
#ifdef MEM_DEBUG
128
        std::cerr << "completed read from: " << std::hex << cur->ram_addr << std::endl;
129
        std::cerr << "  reval = " << (unsigned) p.mem_resvalid << std::endl;
Antoine Kaufmann's avatar
Antoine Kaufmann committed
130
#endif
Antoine Kaufmann's avatar
Antoine Kaufmann committed
131
        p.mem_valid = 0;
132
133
134
135
#ifdef MEM_DEBUG
        for (size_t i = 0; i < 32; i++)
            std::cerr << "    val = " << p.mem_data[i] << std::endl;
#endif
136
137
138
139
140

        size_t off = (cur->ram_addr + cur_off) % data_byte_width;
        size_t cur_len = (cur->len - cur_off > data_byte_width - off ?
                data_byte_width - off : cur->len - cur_off);
        for (size_t i = 0; i < cur_len; i++, off++) {
141
            size_t byte_off = (off % 4);
142
            cur->data[cur_off + i] = (p.mem_data[off / 4] >> (byte_off * 8)) & 0xff;
Antoine Kaufmann's avatar
Antoine Kaufmann committed
143
        }
144
        cur_off += cur_len;
Antoine Kaufmann's avatar
Antoine Kaufmann committed
145

146
147
148
149
150
151
152
153
154
        if (cur_off == cur->len) {
            /* operation is done */
            pending.pop_front();
            cur->engine->mem_op_complete(cur);
            cur_off = 0;
        } else {
            /* operation is not done yet, we'll pick it back up */
        }

Antoine Kaufmann's avatar
Antoine Kaufmann committed
155
        cur = 0;
156
    } else if (!cur && !pending.empty()) {
Antoine Kaufmann's avatar
Antoine Kaufmann committed
157
        cur = pending.front();
Antoine Kaufmann's avatar
Antoine Kaufmann committed
158
        size_t data_offset = (cur->ram_addr + cur_off) % data_byte_width;
Antoine Kaufmann's avatar
Antoine Kaufmann committed
159

Antoine Kaufmann's avatar
Antoine Kaufmann committed
160
#ifdef MEM_DEBUG
161
        std::cerr << "issuing op=" << cur << " read from " << std::hex << cur->ram_addr << std::endl;
162
        std::cerr << "    off=" << data_offset << std::endl;
Antoine Kaufmann's avatar
Antoine Kaufmann committed
163
#endif
Antoine Kaufmann's avatar
Antoine Kaufmann committed
164
165
166
167
168
169
170
171
172

        /* first reset everything */
        p.mem_sel = 0;
        p.mem_addr[0] = p.mem_addr[1] = p.mem_addr[2] = 0;
        p.mem_valid = 0x0;


        /* put data bytes in the right places */
        size_t off = data_offset;
173
174
175
        size_t cur_len = (cur->len - cur_off > data_byte_width - data_offset ?
                data_byte_width - data_offset : cur->len - cur_off);
        for (size_t i = 0; i < cur_len; i++, off++) {
Antoine Kaufmann's avatar
Antoine Kaufmann committed
176
177
            p.mem_valid |= (1 << (off / (SEG_WIDTH / 8)));
        }
178
179
        //p.mem_resready = p.mem_valid;
        p.mem_resready = 0xff;
Antoine Kaufmann's avatar
Antoine Kaufmann committed
180

181
        uint64_t seg_addr = (cur->ram_addr + cur_off) / data_byte_width;
Antoine Kaufmann's avatar
Antoine Kaufmann committed
182
183
184
185
186
187
188
189
190
191
192
193
        size_t seg_addr_bits = 12;

        // iterate over the address bit by bit
        for (size_t i = 0; i < seg_addr_bits; i++) {
            uint32_t bit = ((seg_addr >> i) & 0x1);
            // iterate over the segments
            for (size_t j = 0; j < SEG_COUNT; j++) {
                size_t dst_bit = j * seg_addr_bits + i;
                p.mem_addr[dst_bit / 32] |= (bit << (dst_bit % 32));
            }
        }

194
195
#ifdef MEM_DEBUG
        for (size_t i = 0; i < 3; i++)
196
            std::cerr << "    addr = " << p.mem_addr[i] << std::endl;
197
198
        std::cerr << "    mem_valid = " << (unsigned) p.mem_valid << std::endl;
#endif
199

Antoine Kaufmann's avatar
Antoine Kaufmann committed
200
201
202
203
204
    }
}

void MemReader::op_issue(DMAOp *op)
{
Antoine Kaufmann's avatar
Antoine Kaufmann committed
205
#ifdef MEM_DEBUG
Antoine Kaufmann's avatar
Antoine Kaufmann committed
206
    std::cerr << "enqueued read from " << op->ram_addr << std::endl;
Antoine Kaufmann's avatar
Antoine Kaufmann committed
207
#endif
Antoine Kaufmann's avatar
Antoine Kaufmann committed
208
209
    pending.push_back(op);
}