~pmdj/ubuntu/trusty/qemu/2.9+applesmc+fadtv3

« back to all changes in this revision

Viewing changes to roms/SLOF/lib/libvirtio/virtio.code

  • Committer: Phil Dennis-Jordan
  • Date: 2017-07-21 08:03:43 UTC
  • mfrom: (1.1.1)
  • Revision ID: phil@philjordan.eu-20170721080343-2yr2vdj7713czahv
New upstream release 2.9.0.

Show diffs side-by-side

added added

removed removed

Lines of Context:
 
1
/******************************************************************************
 
2
 * Copyright (c) 2004, 2011 IBM Corporation
 
3
 * All rights reserved.
 
4
 * This program and the accompanying materials
 
5
 * are made available under the terms of the BSD License
 
6
 * which accompanies this distribution, and is available at
 
7
 * http://www.opensource.org/licenses/bsd-license.php
 
8
 *
 
9
 * Contributors:
 
10
 *     IBM Corporation - initial implementation
 
11
 *****************************************************************************/
 
12
 
 
13
#include <virtio.h>
 
14
#include <virtio-blk.h>
 
15
#include <virtio-9p.h>
 
16
#include <virtio-scsi.h>
 
17
#include <virtio-net.h>
 
18
#include <virtio-serial.h>
 
19
 
 
20
/******** core virtio ********/
 
21
 
 
22
// : virtio-setup-vd  ( -- dev )
 
23
PRIM(virtio_X2d_setup_X2d_vd)
 
24
        PUSH; TOS.a = virtio_setup_vd();
 
25
MIRP
 
26
 
 
27
// : virtio-vring-size  ( queuesize -- ringsize )
 
28
PRIM(virtio_X2d_vring_X2d_size)
 
29
        TOS.u = virtio_vring_size(TOS.u);
 
30
MIRP
 
31
 
 
32
// : virtio-get-qsize  ( dev queue -- queuesize )
 
33
PRIM(virtio_X2d_get_X2d_qsize)
 
34
        int queue = TOS.u; POP;
 
35
        TOS.u = virtio_get_qsize(TOS.a, queue);
 
36
MIRP
 
37
 
 
38
// : virtio-get-config  ( dev offset size -- val )
 
39
PRIM(virtio_X2d_get_X2d_config)
 
40
        int size = TOS.u; POP;
 
41
        int offset = TOS.u; POP;
 
42
        TOS.u = virtio_get_config(TOS.a, offset, size);
 
43
MIRP
 
44
 
 
45
// : virtio-set-qaddr  ( dev queue qaddr --  )
 
46
PRIM(virtio_X2d_set_X2d_qaddr)
 
47
        unsigned int qaddr = TOS.u; POP;
 
48
        int queue = TOS.u; POP;
 
49
        void *dev = TOS.a; POP;
 
50
        virtio_set_qaddr(dev, queue, qaddr);
 
51
MIRP
 
52
 
 
53
/******** virtio-blk ********/
 
54
 
 
55
// : virtio-blk-init ( dev -- blk-size)
 
56
PRIM(virtio_X2d_blk_X2d_init)
 
57
        void *dev = TOS.a;
 
58
        TOS.u = virtioblk_init(dev);
 
59
MIRP
 
60
 
 
61
// : virtio-blk-shutdown ( dev -- )
 
62
PRIM(virtio_X2d_blk_X2d_shutdown)
 
63
        void *dev = TOS.a; POP;
 
64
        virtioblk_shutdown(dev);
 
65
MIRP
 
66
 
 
67
// : virtio-blk-read ( buf blkno cnt dev -- #read )
 
68
PRIM(virtio_X2d_blk_X2d_read)
 
69
        void *dev = TOS.a; POP;
 
70
        long cnt = TOS.n; POP;
 
71
        long blkno = TOS.n; POP;
 
72
        void *buf = TOS.a;
 
73
        TOS.n = virtioblk_transfer(dev, buf, blkno, cnt, VIRTIO_BLK_T_IN);
 
74
MIRP
 
75
 
 
76
// : virtio-blk-write ( buf blkno cnt dev -- #written )
 
77
PRIM(virtio_X2d_blk_X2d_write)
 
78
        void *dev = TOS.a; POP;
 
79
        long cnt = TOS.n; POP;
 
80
        long blkno = TOS.n; POP;
 
81
        void *buf = TOS.a;
 
82
        TOS.n = virtioblk_transfer(dev, buf, blkno, cnt, VIRTIO_BLK_T_OUT);
 
83
MIRP
 
84
 
 
85
/******** virtio-fs ********/
 
86
 
 
87
// : virtio-fs-init ( dev tx rx size -- success )
 
88
PRIM(virtio_X2d_fs_X2d_init)
 
89
        int size = TOS.n; POP;
 
90
        void *rx = TOS.a; POP;
 
91
        void *tx = TOS.a; POP;
 
92
        void *dev = TOS.a;
 
93
 
 
94
        TOS.n = virtio_9p_init(dev, tx, rx, size) == 0 ? -1 : 0;
 
95
MIRP
 
96
 
 
97
// : virtio-fs-shutdown ( dev -- )
 
98
PRIM(virtio_X2d_fs_X2d_shutdown)
 
99
        void *dev = TOS.a; POP;
 
100
 
 
101
        virtio_9p_shutdown(dev);
 
102
MIRP
 
103
 
 
104
// : virtio-fs-load ( dev buf str -- #read )
 
105
PRIM(virtio_X2d_fs_X2d_load)
 
106
        char *str = TOS.a; POP;
 
107
        void *buf = TOS.a; POP;
 
108
        void *dev = TOS.a;
 
109
 
 
110
        TOS.n = virtio_9p_load(dev, str, buf);
 
111
MIRP
 
112
 
 
113
/******** virtio-scsi ********/
 
114
 
 
115
// : virtio-scsi-init ( dev -- success )
 
116
PRIM(virtio_X2d_scsi_X2d_init)
 
117
        void *dev = TOS.a;
 
118
        TOS.u = virtioscsi_init(dev);
 
119
MIRP
 
120
 
 
121
// : virtio-scsi-shutdown ( dev -- )
 
122
PRIM(virtio_X2d_scsi_X2d_shutdown)
 
123
        void *dev = TOS.a; POP;
 
124
        virtioscsi_shutdown(dev);
 
125
MIRP
 
126
 
 
127
// : virtio-scsi-send ( buf_addr buf_len is_read req_ptr rsp_ptr dev -- success)
 
128
PRIM(virtio_X2d_scsi_X2d_send)
 
129
        void *dev       = TOS.a; POP;
 
130
        void *resp      = TOS.a; POP;
 
131
        void *req       = TOS.a; POP;
 
132
        int is_read     = !!TOS.n; POP;
 
133
        uint64_t blen   = TOS.n; POP;
 
134
        void *buf       = TOS.a;
 
135
        TOS.n = virtioscsi_send(dev, req, resp, is_read, buf, blen);
 
136
MIRP
 
137
 
 
138
/******** virtio-net ********/
 
139
 
 
140
// : virtio-net-open ( dev -- false | [ driver true ] )
 
141
PRIM(virtio_X2d_net_X2d_open)
 
142
{
 
143
        void *dev = TOS.a;
 
144
 
 
145
        net_driver_t *net_driver = virtionet_open(dev);
 
146
 
 
147
        if (net_driver) {
 
148
                TOS.u = (unsigned long)net_driver; PUSH;
 
149
                TOS.n = -1;
 
150
        } else
 
151
                TOS.n = 0;
 
152
}
 
153
MIRP
 
154
 
 
155
// : virtio-net-close ( driver -- )
 
156
PRIM(virtio_X2d_net_X2d_close)
 
157
{
 
158
        net_driver_t *driver = TOS.a; POP;
 
159
        virtionet_close(driver);
 
160
}
 
161
MIRP
 
162
 
 
163
// : virtio-net-read ( addr len -- actual )
 
164
PRIM(virtio_X2d_net_X2d_read)
 
165
{
 
166
        int len = TOS.u; POP;
 
167
        TOS.n = virtionet_read(TOS.a, len);
 
168
}
 
169
MIRP
 
170
 
 
171
// : virtio-net-write ( addr len -- actual )
 
172
PRIM(virtio_X2d_net_X2d_write)
 
173
{
 
174
        int len = TOS.u; POP;
 
175
        TOS.n = virtionet_write(TOS.a, len);
 
176
}
 
177
MIRP
 
178
 
 
179
/*********** virtio-serial ***********/
 
180
// : virtio-serial-init ( dev -- false | true)
 
181
PRIM(virtio_X2d_serial_X2d_init)
 
182
        void *dev = TOS.a;
 
183
        TOS.u = virtio_serial_init(dev);
 
184
MIRP
 
185
 
 
186
// : virtio-serial-shutdown ( dev -- )
 
187
PRIM(virtio_X2d_serial_X2d_shutdown)
 
188
        void *dev = TOS.a; POP;
 
189
        virtio_serial_shutdown(dev);
 
190
MIRP
 
191
 
 
192
// : virtio-serial-putchar ( dev char -- )
 
193
PRIM(virtio_X2d_serial_X2d_putchar)
 
194
        unsigned long c = TOS.n; POP;
 
195
        void *dev = TOS.a; POP;
 
196
        virtio_serial_putchar(dev, c);
 
197
MIRP
 
198
 
 
199
// : virtio-serial-getchar ( dev -- char)
 
200
PRIM(virtio_X2d_serial_X2d_getchar)
 
201
        void *dev = TOS.a;
 
202
        TOS.n = virtio_serial_getchar(dev);
 
203
MIRP
 
204
 
 
205
// : virtio-serial-haschar ( dev -- true | false)
 
206
PRIM(virtio_X2d_serial_X2d_haschar)
 
207
        void *dev = TOS.a;
 
208
        TOS.n = virtio_serial_haschar(dev);
 
209
MIRP