dummy_nic.c 3.82 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
25
/*
 * Copyright 2020 Max Planck Institute for Software Systems
 *
 * 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.
 */

#include <stdlib.h>
#include <stdio.h>
26
#include <string.h>
Antoine Kaufmann's avatar
Antoine Kaufmann committed
27
28
29
#include <sys/socket.h>
#include <unistd.h>

30
#include <nicsim.h>
Antoine Kaufmann's avatar
Antoine Kaufmann committed
31

32
33
34
35
36
37
38
39
40
static volatile union cosim_pcie_proto_d2h *d2h_alloc(void)
{
    volatile union cosim_pcie_proto_d2h *msg = nicsim_d2h_alloc();
    if (msg == NULL) {
        fprintf(stderr, "d2h_alloc: no entry available\n");
        abort();
    }
    return msg;
}
Antoine Kaufmann's avatar
Antoine Kaufmann committed
41

42
43
44
45
46
static void h2d_read(volatile struct cosim_pcie_proto_h2d_read *read)
{
    volatile union cosim_pcie_proto_d2h *msg;
    volatile struct cosim_pcie_proto_d2h_readcomp *rc;
    uint64_t val;
Antoine Kaufmann's avatar
Antoine Kaufmann committed
47

48
49
    msg = d2h_alloc();
    rc = &msg->readcomp;
Antoine Kaufmann's avatar
Antoine Kaufmann committed
50

51
52
53
54
55
56
57
58
59
60
61
62
63
    val = read->offset + 42;
    printf("read(bar=%u, off=%lu, len=%u) = %lu\n", read->bar, read->offset,
            read->len, val);

    memcpy((void *) rc->data, &val, read->len);
    rc->req_id = read->req_id;

    //WMB();
    rc->own_type = COSIM_PCIE_PROTO_D2H_MSG_READCOMP |
        COSIM_PCIE_PROTO_D2H_OWN_HOST;
}

static void h2d_write(volatile struct cosim_pcie_proto_h2d_write *write)
Antoine Kaufmann's avatar
Antoine Kaufmann committed
64
{
65
66
67
    volatile union cosim_pcie_proto_d2h *msg;
    volatile struct cosim_pcie_proto_d2h_writecomp *wc;
    uint64_t val;
Antoine Kaufmann's avatar
Antoine Kaufmann committed
68

69
70
    msg = d2h_alloc();
    wc = &msg->writecomp;
Antoine Kaufmann's avatar
Antoine Kaufmann committed
71

72
73
    val = 0;
    memcpy(&val, (void *) write->data, write->len);
Antoine Kaufmann's avatar
Antoine Kaufmann committed
74

75
76
    printf("write(bar=%u, off=%lu, len=%u, val=%lu)\n", write->bar,
            write->offset, write->len, val);
Antoine Kaufmann's avatar
Antoine Kaufmann committed
77

78
    wc->req_id = write->req_id;
Antoine Kaufmann's avatar
Antoine Kaufmann committed
79

80
81
82
83
    //WMB();
    wc->own_type = COSIM_PCIE_PROTO_D2H_MSG_WRITECOMP |
        COSIM_PCIE_PROTO_D2H_OWN_HOST;
}
84

85
86
87
88
void poll_h2d(void)
{
    volatile union cosim_pcie_proto_h2d *msg = nicif_h2d_poll();
    uint8_t type;
89

90
91
92
93
94
95
96
97
98
99
100
101
    if (msg == NULL)
        return;

    type = msg->dummy.own_type & COSIM_PCIE_PROTO_H2D_MSG_MASK;
    switch (type) {
        case COSIM_PCIE_PROTO_H2D_MSG_READ:
            h2d_read(&msg->read);
            break;

        case COSIM_PCIE_PROTO_H2D_MSG_WRITE:
            h2d_write(&msg->write);
            break;
Antoine Kaufmann's avatar
Antoine Kaufmann committed
102

103
104
105
106
107
108
109
        default:
            fprintf(stderr, "poll_h2d: unsupported type=%u\n", type);
    }

    nicif_h2d_done(msg);
    nicif_h2d_next();
}
Antoine Kaufmann's avatar
Antoine Kaufmann committed
110

111
112
int main(int argc, char *argv[])
{
113
    int sync = 0;
114
115
    struct cosim_pcie_proto_dev_intro di;
    memset(&di, 0, sizeof(di));
Antoine Kaufmann's avatar
Antoine Kaufmann committed
116
117
118
119
120
121
122

    di.bars[0].len = 0x1000;
    di.bars[0].flags = COSIM_PCIE_PROTO_BAR_64;

    di.bars[2].len = 128;
    di.bars[2].flags = COSIM_PCIE_PROTO_BAR_IO;

123
124
125
126
127
    di.pci_vendor_id = 0x4321;
    di.pci_device_id = 0x1234;
    di.pci_class = 0x02;
    di.pci_subclass = 0x00;
    di.pci_revision = 0x00;
128
    di.pci_msi_nvecs = 0x00;
129

130
131
132
    if (nicsim_init(&di, "/tmp/cosim-pci", &sync, NULL, NULL,
                "/dev/shm/dummy_nic_shm"))
    {
Antoine Kaufmann's avatar
Antoine Kaufmann committed
133
134
135
136
        return EXIT_FAILURE;
    }

    while (1) {
137
        poll_h2d();
Antoine Kaufmann's avatar
Antoine Kaufmann committed
138
139
    }

140
    nicsim_cleanup();
Antoine Kaufmann's avatar
Antoine Kaufmann committed
141
142
    return 0;
}