root / hw / spapr_llan.c @ 156dfade
History | View | Annotate | Download (15.8 kB)
1 | 8d90ad90 | David Gibson | /*
|
---|---|---|---|
2 | 8d90ad90 | David Gibson | * QEMU PowerPC pSeries Logical Partition (aka sPAPR) hardware System Emulator
|
3 | 8d90ad90 | David Gibson | *
|
4 | 8d90ad90 | David Gibson | * PAPR Inter-VM Logical Lan, aka ibmveth
|
5 | 8d90ad90 | David Gibson | *
|
6 | 8d90ad90 | David Gibson | * Copyright (c) 2010,2011 David Gibson, IBM Corporation.
|
7 | 8d90ad90 | David Gibson | *
|
8 | 8d90ad90 | David Gibson | * Permission is hereby granted, free of charge, to any person obtaining a copy
|
9 | 8d90ad90 | David Gibson | * of this software and associated documentation files (the "Software"), to deal
|
10 | 8d90ad90 | David Gibson | * in the Software without restriction, including without limitation the rights
|
11 | 8d90ad90 | David Gibson | * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
|
12 | 8d90ad90 | David Gibson | * copies of the Software, and to permit persons to whom the Software is
|
13 | 8d90ad90 | David Gibson | * furnished to do so, subject to the following conditions:
|
14 | 8d90ad90 | David Gibson | *
|
15 | 8d90ad90 | David Gibson | * The above copyright notice and this permission notice shall be included in
|
16 | 8d90ad90 | David Gibson | * all copies or substantial portions of the Software.
|
17 | 8d90ad90 | David Gibson | *
|
18 | 8d90ad90 | David Gibson | * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
|
19 | 8d90ad90 | David Gibson | * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
|
20 | 8d90ad90 | David Gibson | * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
|
21 | 8d90ad90 | David Gibson | * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
|
22 | 8d90ad90 | David Gibson | * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
|
23 | 8d90ad90 | David Gibson | * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
|
24 | 8d90ad90 | David Gibson | * THE SOFTWARE.
|
25 | 8d90ad90 | David Gibson | *
|
26 | 8d90ad90 | David Gibson | */
|
27 | 8d90ad90 | David Gibson | #include "hw.h" |
28 | 1422e32d | Paolo Bonzini | #include "net/net.h" |
29 | 8d90ad90 | David Gibson | #include "hw/qdev.h" |
30 | 8d90ad90 | David Gibson | #include "hw/spapr.h" |
31 | 8d90ad90 | David Gibson | #include "hw/spapr_vio.h" |
32 | 8d90ad90 | David Gibson | |
33 | 8d90ad90 | David Gibson | #include <libfdt.h> |
34 | 8d90ad90 | David Gibson | |
35 | 8d90ad90 | David Gibson | #define ETH_ALEN 6 |
36 | 8d90ad90 | David Gibson | #define MAX_PACKET_SIZE 65536 |
37 | 8d90ad90 | David Gibson | |
38 | 8d90ad90 | David Gibson | /*#define DEBUG*/
|
39 | 8d90ad90 | David Gibson | |
40 | 8d90ad90 | David Gibson | #ifdef DEBUG
|
41 | 8d90ad90 | David Gibson | #define dprintf(fmt...) do { fprintf(stderr, fmt); } while (0) |
42 | 8d90ad90 | David Gibson | #else
|
43 | 8d90ad90 | David Gibson | #define dprintf(fmt...)
|
44 | 8d90ad90 | David Gibson | #endif
|
45 | 8d90ad90 | David Gibson | |
46 | 8d90ad90 | David Gibson | /*
|
47 | 8d90ad90 | David Gibson | * Virtual LAN device
|
48 | 8d90ad90 | David Gibson | */
|
49 | 8d90ad90 | David Gibson | |
50 | 8d90ad90 | David Gibson | typedef uint64_t vlan_bd_t;
|
51 | 8d90ad90 | David Gibson | |
52 | 8d90ad90 | David Gibson | #define VLAN_BD_VALID 0x8000000000000000ULL |
53 | 8d90ad90 | David Gibson | #define VLAN_BD_TOGGLE 0x4000000000000000ULL |
54 | 8d90ad90 | David Gibson | #define VLAN_BD_NO_CSUM 0x0200000000000000ULL |
55 | 8d90ad90 | David Gibson | #define VLAN_BD_CSUM_GOOD 0x0100000000000000ULL |
56 | 8d90ad90 | David Gibson | #define VLAN_BD_LEN_MASK 0x00ffffff00000000ULL |
57 | 8d90ad90 | David Gibson | #define VLAN_BD_LEN(bd) (((bd) & VLAN_BD_LEN_MASK) >> 32) |
58 | 8d90ad90 | David Gibson | #define VLAN_BD_ADDR_MASK 0x00000000ffffffffULL |
59 | 8d90ad90 | David Gibson | #define VLAN_BD_ADDR(bd) ((bd) & VLAN_BD_ADDR_MASK)
|
60 | 8d90ad90 | David Gibson | |
61 | 8d90ad90 | David Gibson | #define VLAN_VALID_BD(addr, len) (VLAN_BD_VALID | \
|
62 | 8d90ad90 | David Gibson | (((len) << 32) & VLAN_BD_LEN_MASK) | \
|
63 | 8d90ad90 | David Gibson | (addr & VLAN_BD_ADDR_MASK)) |
64 | 8d90ad90 | David Gibson | |
65 | 8d90ad90 | David Gibson | #define VLAN_RXQC_TOGGLE 0x80 |
66 | 8d90ad90 | David Gibson | #define VLAN_RXQC_VALID 0x40 |
67 | 8d90ad90 | David Gibson | #define VLAN_RXQC_NO_CSUM 0x02 |
68 | 8d90ad90 | David Gibson | #define VLAN_RXQC_CSUM_GOOD 0x01 |
69 | 8d90ad90 | David Gibson | |
70 | 8d90ad90 | David Gibson | #define VLAN_RQ_ALIGNMENT 16 |
71 | 8d90ad90 | David Gibson | #define VLAN_RXQ_BD_OFF 0 |
72 | 8d90ad90 | David Gibson | #define VLAN_FILTER_BD_OFF 8 |
73 | 8d90ad90 | David Gibson | #define VLAN_RX_BDS_OFF 16 |
74 | ad0ebb91 | David Gibson | #define VLAN_MAX_BUFS ((SPAPR_TCE_PAGE_SIZE - VLAN_RX_BDS_OFF) / 8) |
75 | 8d90ad90 | David Gibson | |
76 | 8d90ad90 | David Gibson | typedef struct VIOsPAPRVLANDevice { |
77 | 8d90ad90 | David Gibson | VIOsPAPRDevice sdev; |
78 | 8d90ad90 | David Gibson | NICConf nicconf; |
79 | 8d90ad90 | David Gibson | NICState *nic; |
80 | 8d90ad90 | David Gibson | int isopen;
|
81 | 8d90ad90 | David Gibson | target_ulong buf_list; |
82 | 8d90ad90 | David Gibson | int add_buf_ptr, use_buf_ptr, rx_bufs;
|
83 | 8d90ad90 | David Gibson | target_ulong rxq_ptr; |
84 | 8d90ad90 | David Gibson | } VIOsPAPRVLANDevice; |
85 | 8d90ad90 | David Gibson | |
86 | 4e68f7a0 | Stefan Hajnoczi | static int spapr_vlan_can_receive(NetClientState *nc) |
87 | 8d90ad90 | David Gibson | { |
88 | cc1f0f45 | Jason Wang | VIOsPAPRVLANDevice *dev = qemu_get_nic_opaque(nc); |
89 | 8d90ad90 | David Gibson | |
90 | 8d90ad90 | David Gibson | return (dev->isopen && dev->rx_bufs > 0); |
91 | 8d90ad90 | David Gibson | } |
92 | 8d90ad90 | David Gibson | |
93 | 4e68f7a0 | Stefan Hajnoczi | static ssize_t spapr_vlan_receive(NetClientState *nc, const uint8_t *buf, |
94 | 8d90ad90 | David Gibson | size_t size) |
95 | 8d90ad90 | David Gibson | { |
96 | cc1f0f45 | Jason Wang | VIOsPAPRDevice *sdev = qemu_get_nic_opaque(nc); |
97 | 8d90ad90 | David Gibson | VIOsPAPRVLANDevice *dev = (VIOsPAPRVLANDevice *)sdev; |
98 | ad0ebb91 | David Gibson | vlan_bd_t rxq_bd = vio_ldq(sdev, dev->buf_list + VLAN_RXQ_BD_OFF); |
99 | 8d90ad90 | David Gibson | vlan_bd_t bd; |
100 | 8d90ad90 | David Gibson | int buf_ptr = dev->use_buf_ptr;
|
101 | 8d90ad90 | David Gibson | uint64_t handle; |
102 | 8d90ad90 | David Gibson | uint8_t control; |
103 | 8d90ad90 | David Gibson | |
104 | 8d90ad90 | David Gibson | dprintf("spapr_vlan_receive() [%s] rx_bufs=%d\n", sdev->qdev.id,
|
105 | 8d90ad90 | David Gibson | dev->rx_bufs); |
106 | 8d90ad90 | David Gibson | |
107 | 8d90ad90 | David Gibson | if (!dev->isopen) {
|
108 | 8d90ad90 | David Gibson | return -1; |
109 | 8d90ad90 | David Gibson | } |
110 | 8d90ad90 | David Gibson | |
111 | 8d90ad90 | David Gibson | if (!dev->rx_bufs) {
|
112 | 8d90ad90 | David Gibson | return -1; |
113 | 8d90ad90 | David Gibson | } |
114 | 8d90ad90 | David Gibson | |
115 | 8d90ad90 | David Gibson | do {
|
116 | 8d90ad90 | David Gibson | buf_ptr += 8;
|
117 | ad0ebb91 | David Gibson | if (buf_ptr >= SPAPR_TCE_PAGE_SIZE) {
|
118 | 8d90ad90 | David Gibson | buf_ptr = VLAN_RX_BDS_OFF; |
119 | 8d90ad90 | David Gibson | } |
120 | 8d90ad90 | David Gibson | |
121 | ad0ebb91 | David Gibson | bd = vio_ldq(sdev, dev->buf_list + buf_ptr); |
122 | 8d90ad90 | David Gibson | dprintf("use_buf_ptr=%d bd=0x%016llx\n",
|
123 | 8d90ad90 | David Gibson | buf_ptr, (unsigned long long)bd); |
124 | 8d90ad90 | David Gibson | } while ((!(bd & VLAN_BD_VALID) || (VLAN_BD_LEN(bd) < (size + 8))) |
125 | 8d90ad90 | David Gibson | && (buf_ptr != dev->use_buf_ptr)); |
126 | 8d90ad90 | David Gibson | |
127 | 8d90ad90 | David Gibson | if (!(bd & VLAN_BD_VALID) || (VLAN_BD_LEN(bd) < (size + 8))) { |
128 | 8d90ad90 | David Gibson | /* Failed to find a suitable buffer */
|
129 | 8d90ad90 | David Gibson | return -1; |
130 | 8d90ad90 | David Gibson | } |
131 | 8d90ad90 | David Gibson | |
132 | 8d90ad90 | David Gibson | /* Remove the buffer from the pool */
|
133 | 8d90ad90 | David Gibson | dev->rx_bufs--; |
134 | 8d90ad90 | David Gibson | dev->use_buf_ptr = buf_ptr; |
135 | ad0ebb91 | David Gibson | vio_stq(sdev, dev->buf_list + dev->use_buf_ptr, 0);
|
136 | 8d90ad90 | David Gibson | |
137 | 8d90ad90 | David Gibson | dprintf("Found buffer: ptr=%d num=%d\n", dev->use_buf_ptr, dev->rx_bufs);
|
138 | 8d90ad90 | David Gibson | |
139 | 8d90ad90 | David Gibson | /* Transfer the packet data */
|
140 | ad0ebb91 | David Gibson | if (spapr_vio_dma_write(sdev, VLAN_BD_ADDR(bd) + 8, buf, size) < 0) { |
141 | 8d90ad90 | David Gibson | return -1; |
142 | 8d90ad90 | David Gibson | } |
143 | 8d90ad90 | David Gibson | |
144 | 8d90ad90 | David Gibson | dprintf("spapr_vlan_receive: DMA write completed\n");
|
145 | 8d90ad90 | David Gibson | |
146 | 8d90ad90 | David Gibson | /* Update the receive queue */
|
147 | 8d90ad90 | David Gibson | control = VLAN_RXQC_TOGGLE | VLAN_RXQC_VALID; |
148 | 8d90ad90 | David Gibson | if (rxq_bd & VLAN_BD_TOGGLE) {
|
149 | 8d90ad90 | David Gibson | control ^= VLAN_RXQC_TOGGLE; |
150 | 8d90ad90 | David Gibson | } |
151 | 8d90ad90 | David Gibson | |
152 | ad0ebb91 | David Gibson | handle = vio_ldq(sdev, VLAN_BD_ADDR(bd)); |
153 | ad0ebb91 | David Gibson | vio_stq(sdev, VLAN_BD_ADDR(rxq_bd) + dev->rxq_ptr + 8, handle);
|
154 | ad0ebb91 | David Gibson | vio_stl(sdev, VLAN_BD_ADDR(rxq_bd) + dev->rxq_ptr + 4, size);
|
155 | ad0ebb91 | David Gibson | vio_sth(sdev, VLAN_BD_ADDR(rxq_bd) + dev->rxq_ptr + 2, 8); |
156 | ad0ebb91 | David Gibson | vio_stb(sdev, VLAN_BD_ADDR(rxq_bd) + dev->rxq_ptr, control); |
157 | 8d90ad90 | David Gibson | |
158 | 8d90ad90 | David Gibson | dprintf("wrote rxq entry (ptr=0x%llx): 0x%016llx 0x%016llx\n",
|
159 | 8d90ad90 | David Gibson | (unsigned long long)dev->rxq_ptr, |
160 | ad0ebb91 | David Gibson | (unsigned long long)vio_ldq(sdev, VLAN_BD_ADDR(rxq_bd) + |
161 | 8d90ad90 | David Gibson | dev->rxq_ptr), |
162 | ad0ebb91 | David Gibson | (unsigned long long)vio_ldq(sdev, VLAN_BD_ADDR(rxq_bd) + |
163 | 8d90ad90 | David Gibson | dev->rxq_ptr + 8));
|
164 | 8d90ad90 | David Gibson | |
165 | 8d90ad90 | David Gibson | dev->rxq_ptr += 16;
|
166 | 8d90ad90 | David Gibson | if (dev->rxq_ptr >= VLAN_BD_LEN(rxq_bd)) {
|
167 | 8d90ad90 | David Gibson | dev->rxq_ptr = 0;
|
168 | ad0ebb91 | David Gibson | vio_stq(sdev, dev->buf_list + VLAN_RXQ_BD_OFF, rxq_bd ^ VLAN_BD_TOGGLE); |
169 | 8d90ad90 | David Gibson | } |
170 | 8d90ad90 | David Gibson | |
171 | 8d90ad90 | David Gibson | if (sdev->signal_state & 1) { |
172 | a307d594 | Alexey Kardashevskiy | qemu_irq_pulse(spapr_vio_qirq(sdev)); |
173 | 8d90ad90 | David Gibson | } |
174 | 8d90ad90 | David Gibson | |
175 | 8d90ad90 | David Gibson | return size;
|
176 | 8d90ad90 | David Gibson | } |
177 | 8d90ad90 | David Gibson | |
178 | 156dfade | David Gibson | static void spapr_vlan_cleanup(NetClientState *nc) |
179 | 156dfade | David Gibson | { |
180 | 156dfade | David Gibson | VIOsPAPRVLANDevice *dev = qemu_get_nic_opaque(nc); |
181 | 156dfade | David Gibson | |
182 | 156dfade | David Gibson | dev->nic = NULL;
|
183 | 156dfade | David Gibson | } |
184 | 156dfade | David Gibson | |
185 | 8d90ad90 | David Gibson | static NetClientInfo net_spapr_vlan_info = {
|
186 | 2be64a68 | Laszlo Ersek | .type = NET_CLIENT_OPTIONS_KIND_NIC, |
187 | 8d90ad90 | David Gibson | .size = sizeof(NICState),
|
188 | 8d90ad90 | David Gibson | .can_receive = spapr_vlan_can_receive, |
189 | 8d90ad90 | David Gibson | .receive = spapr_vlan_receive, |
190 | 156dfade | David Gibson | .cleanup = spapr_vlan_cleanup, |
191 | 8d90ad90 | David Gibson | }; |
192 | 8d90ad90 | David Gibson | |
193 | c17491b6 | David Gibson | static void spapr_vlan_reset(VIOsPAPRDevice *sdev) |
194 | c17491b6 | David Gibson | { |
195 | c17491b6 | David Gibson | VIOsPAPRVLANDevice *dev = DO_UPCAST(VIOsPAPRVLANDevice, sdev, sdev); |
196 | c17491b6 | David Gibson | |
197 | c17491b6 | David Gibson | dev->buf_list = 0;
|
198 | c17491b6 | David Gibson | dev->rx_bufs = 0;
|
199 | c17491b6 | David Gibson | dev->isopen = 0;
|
200 | c17491b6 | David Gibson | } |
201 | c17491b6 | David Gibson | |
202 | 8d90ad90 | David Gibson | static int spapr_vlan_init(VIOsPAPRDevice *sdev) |
203 | 8d90ad90 | David Gibson | { |
204 | 8d90ad90 | David Gibson | VIOsPAPRVLANDevice *dev = (VIOsPAPRVLANDevice *)sdev; |
205 | 8d90ad90 | David Gibson | |
206 | 8d90ad90 | David Gibson | qemu_macaddr_default_if_unset(&dev->nicconf.macaddr); |
207 | 8d90ad90 | David Gibson | |
208 | 8d90ad90 | David Gibson | dev->nic = qemu_new_nic(&net_spapr_vlan_info, &dev->nicconf, |
209 | f79f2bfc | Anthony Liguori | object_get_typename(OBJECT(sdev)), sdev->qdev.id, dev); |
210 | b356f76d | Jason Wang | qemu_format_nic_info_str(qemu_get_queue(dev->nic), dev->nicconf.macaddr.a); |
211 | 8d90ad90 | David Gibson | |
212 | 8d90ad90 | David Gibson | return 0; |
213 | 8d90ad90 | David Gibson | } |
214 | 8d90ad90 | David Gibson | |
215 | d601fac4 | David Gibson | void spapr_vlan_create(VIOsPAPRBus *bus, NICInfo *nd)
|
216 | 8d90ad90 | David Gibson | { |
217 | 8d90ad90 | David Gibson | DeviceState *dev; |
218 | 8d90ad90 | David Gibson | |
219 | 8d90ad90 | David Gibson | dev = qdev_create(&bus->bus, "spapr-vlan");
|
220 | 8d90ad90 | David Gibson | |
221 | 8d90ad90 | David Gibson | qdev_set_nic_properties(dev, nd); |
222 | 8d90ad90 | David Gibson | |
223 | 8d90ad90 | David Gibson | qdev_init_nofail(dev); |
224 | 8d90ad90 | David Gibson | } |
225 | 8d90ad90 | David Gibson | |
226 | 8d90ad90 | David Gibson | static int spapr_vlan_devnode(VIOsPAPRDevice *dev, void *fdt, int node_off) |
227 | 8d90ad90 | David Gibson | { |
228 | 8d90ad90 | David Gibson | VIOsPAPRVLANDevice *vdev = (VIOsPAPRVLANDevice *)dev; |
229 | 8d90ad90 | David Gibson | uint8_t padded_mac[8] = {0, 0}; |
230 | 8d90ad90 | David Gibson | int ret;
|
231 | 8d90ad90 | David Gibson | |
232 | 8d90ad90 | David Gibson | /* Some old phyp versions give the mac address in an 8-byte
|
233 | 8d90ad90 | David Gibson | * property. The kernel driver has an insane workaround for this;
|
234 | 8d90ad90 | David Gibson | * rather than doing the obvious thing and checking the property
|
235 | 8d90ad90 | David Gibson | * length, it checks whether the first byte has 0b10 in the low
|
236 | 8d90ad90 | David Gibson | * bits. If a correct 6-byte property has a different first byte
|
237 | 8d90ad90 | David Gibson | * the kernel will get the wrong mac address, overrunning its
|
238 | 8d90ad90 | David Gibson | * buffer in the process (read only, thank goodness).
|
239 | 8d90ad90 | David Gibson | *
|
240 | 8d90ad90 | David Gibson | * Here we workaround the kernel workaround by always supplying an
|
241 | 8d90ad90 | David Gibson | * 8-byte property, with the mac address in the last six bytes */
|
242 | 8d90ad90 | David Gibson | memcpy(&padded_mac[2], &vdev->nicconf.macaddr, ETH_ALEN);
|
243 | 8d90ad90 | David Gibson | ret = fdt_setprop(fdt, node_off, "local-mac-address",
|
244 | 8d90ad90 | David Gibson | padded_mac, sizeof(padded_mac));
|
245 | 8d90ad90 | David Gibson | if (ret < 0) { |
246 | 8d90ad90 | David Gibson | return ret;
|
247 | 8d90ad90 | David Gibson | } |
248 | 8d90ad90 | David Gibson | |
249 | 8d90ad90 | David Gibson | ret = fdt_setprop_cell(fdt, node_off, "ibm,mac-address-filters", 0); |
250 | 8d90ad90 | David Gibson | if (ret < 0) { |
251 | 8d90ad90 | David Gibson | return ret;
|
252 | 8d90ad90 | David Gibson | } |
253 | 8d90ad90 | David Gibson | |
254 | 8d90ad90 | David Gibson | return 0; |
255 | 8d90ad90 | David Gibson | } |
256 | 8d90ad90 | David Gibson | |
257 | 8d90ad90 | David Gibson | static int check_bd(VIOsPAPRVLANDevice *dev, vlan_bd_t bd, |
258 | 8d90ad90 | David Gibson | target_ulong alignment) |
259 | 8d90ad90 | David Gibson | { |
260 | 8d90ad90 | David Gibson | if ((VLAN_BD_ADDR(bd) % alignment)
|
261 | 8d90ad90 | David Gibson | || (VLAN_BD_LEN(bd) % alignment)) { |
262 | 8d90ad90 | David Gibson | return -1; |
263 | 8d90ad90 | David Gibson | } |
264 | 8d90ad90 | David Gibson | |
265 | ad0ebb91 | David Gibson | if (!spapr_vio_dma_valid(&dev->sdev, VLAN_BD_ADDR(bd),
|
266 | ad0ebb91 | David Gibson | VLAN_BD_LEN(bd), DMA_DIRECTION_FROM_DEVICE) |
267 | ad0ebb91 | David Gibson | || !spapr_vio_dma_valid(&dev->sdev, VLAN_BD_ADDR(bd), |
268 | ad0ebb91 | David Gibson | VLAN_BD_LEN(bd), DMA_DIRECTION_TO_DEVICE)) { |
269 | 8d90ad90 | David Gibson | return -1; |
270 | 8d90ad90 | David Gibson | } |
271 | 8d90ad90 | David Gibson | |
272 | 8d90ad90 | David Gibson | return 0; |
273 | 8d90ad90 | David Gibson | } |
274 | 8d90ad90 | David Gibson | |
275 | b13ce26d | Andreas Färber | static target_ulong h_register_logical_lan(PowerPCCPU *cpu,
|
276 | 8d90ad90 | David Gibson | sPAPREnvironment *spapr, |
277 | 8d90ad90 | David Gibson | target_ulong opcode, |
278 | 8d90ad90 | David Gibson | target_ulong *args) |
279 | 8d90ad90 | David Gibson | { |
280 | 8d90ad90 | David Gibson | target_ulong reg = args[0];
|
281 | 8d90ad90 | David Gibson | target_ulong buf_list = args[1];
|
282 | 8d90ad90 | David Gibson | target_ulong rec_queue = args[2];
|
283 | 8d90ad90 | David Gibson | target_ulong filter_list = args[3];
|
284 | 8d90ad90 | David Gibson | VIOsPAPRDevice *sdev = spapr_vio_find_by_reg(spapr->vio_bus, reg); |
285 | 8d90ad90 | David Gibson | VIOsPAPRVLANDevice *dev = (VIOsPAPRVLANDevice *)sdev; |
286 | 8d90ad90 | David Gibson | vlan_bd_t filter_list_bd; |
287 | 8d90ad90 | David Gibson | |
288 | 8d90ad90 | David Gibson | if (!dev) {
|
289 | 8d90ad90 | David Gibson | return H_PARAMETER;
|
290 | 8d90ad90 | David Gibson | } |
291 | 8d90ad90 | David Gibson | |
292 | 8d90ad90 | David Gibson | if (dev->isopen) {
|
293 | 8d90ad90 | David Gibson | hcall_dprintf("H_REGISTER_LOGICAL_LAN called twice without "
|
294 | 8d90ad90 | David Gibson | "H_FREE_LOGICAL_LAN\n");
|
295 | 8d90ad90 | David Gibson | return H_RESOURCE;
|
296 | 8d90ad90 | David Gibson | } |
297 | 8d90ad90 | David Gibson | |
298 | ad0ebb91 | David Gibson | if (check_bd(dev, VLAN_VALID_BD(buf_list, SPAPR_TCE_PAGE_SIZE),
|
299 | ad0ebb91 | David Gibson | SPAPR_TCE_PAGE_SIZE) < 0) {
|
300 | d9599c92 | David Gibson | hcall_dprintf("Bad buf_list 0x" TARGET_FMT_lx "\n", buf_list); |
301 | 8d90ad90 | David Gibson | return H_PARAMETER;
|
302 | 8d90ad90 | David Gibson | } |
303 | 8d90ad90 | David Gibson | |
304 | ad0ebb91 | David Gibson | filter_list_bd = VLAN_VALID_BD(filter_list, SPAPR_TCE_PAGE_SIZE); |
305 | ad0ebb91 | David Gibson | if (check_bd(dev, filter_list_bd, SPAPR_TCE_PAGE_SIZE) < 0) { |
306 | d9599c92 | David Gibson | hcall_dprintf("Bad filter_list 0x" TARGET_FMT_lx "\n", filter_list); |
307 | 8d90ad90 | David Gibson | return H_PARAMETER;
|
308 | 8d90ad90 | David Gibson | } |
309 | 8d90ad90 | David Gibson | |
310 | 8d90ad90 | David Gibson | if (!(rec_queue & VLAN_BD_VALID)
|
311 | 8d90ad90 | David Gibson | || (check_bd(dev, rec_queue, VLAN_RQ_ALIGNMENT) < 0)) {
|
312 | d9599c92 | David Gibson | hcall_dprintf("Bad receive queue\n");
|
313 | 8d90ad90 | David Gibson | return H_PARAMETER;
|
314 | 8d90ad90 | David Gibson | } |
315 | 8d90ad90 | David Gibson | |
316 | 8d90ad90 | David Gibson | dev->buf_list = buf_list; |
317 | 8d90ad90 | David Gibson | sdev->signal_state = 0;
|
318 | 8d90ad90 | David Gibson | |
319 | 8d90ad90 | David Gibson | rec_queue &= ~VLAN_BD_TOGGLE; |
320 | 8d90ad90 | David Gibson | |
321 | 8d90ad90 | David Gibson | /* Initialize the buffer list */
|
322 | ad0ebb91 | David Gibson | vio_stq(sdev, buf_list, rec_queue); |
323 | ad0ebb91 | David Gibson | vio_stq(sdev, buf_list + 8, filter_list_bd);
|
324 | ad0ebb91 | David Gibson | spapr_vio_dma_set(sdev, buf_list + VLAN_RX_BDS_OFF, 0,
|
325 | ad0ebb91 | David Gibson | SPAPR_TCE_PAGE_SIZE - VLAN_RX_BDS_OFF); |
326 | 8d90ad90 | David Gibson | dev->add_buf_ptr = VLAN_RX_BDS_OFF - 8;
|
327 | 8d90ad90 | David Gibson | dev->use_buf_ptr = VLAN_RX_BDS_OFF - 8;
|
328 | 8d90ad90 | David Gibson | dev->rx_bufs = 0;
|
329 | 8d90ad90 | David Gibson | dev->rxq_ptr = 0;
|
330 | 8d90ad90 | David Gibson | |
331 | 8d90ad90 | David Gibson | /* Initialize the receive queue */
|
332 | ad0ebb91 | David Gibson | spapr_vio_dma_set(sdev, VLAN_BD_ADDR(rec_queue), 0, VLAN_BD_LEN(rec_queue));
|
333 | 8d90ad90 | David Gibson | |
334 | 8d90ad90 | David Gibson | dev->isopen = 1;
|
335 | 8d90ad90 | David Gibson | return H_SUCCESS;
|
336 | 8d90ad90 | David Gibson | } |
337 | 8d90ad90 | David Gibson | |
338 | 8d90ad90 | David Gibson | |
339 | b13ce26d | Andreas Färber | static target_ulong h_free_logical_lan(PowerPCCPU *cpu, sPAPREnvironment *spapr,
|
340 | 8d90ad90 | David Gibson | target_ulong opcode, target_ulong *args) |
341 | 8d90ad90 | David Gibson | { |
342 | 8d90ad90 | David Gibson | target_ulong reg = args[0];
|
343 | 8d90ad90 | David Gibson | VIOsPAPRDevice *sdev = spapr_vio_find_by_reg(spapr->vio_bus, reg); |
344 | 8d90ad90 | David Gibson | VIOsPAPRVLANDevice *dev = (VIOsPAPRVLANDevice *)sdev; |
345 | 8d90ad90 | David Gibson | |
346 | 8d90ad90 | David Gibson | if (!dev) {
|
347 | 8d90ad90 | David Gibson | return H_PARAMETER;
|
348 | 8d90ad90 | David Gibson | } |
349 | 8d90ad90 | David Gibson | |
350 | 8d90ad90 | David Gibson | if (!dev->isopen) {
|
351 | 8d90ad90 | David Gibson | hcall_dprintf("H_FREE_LOGICAL_LAN called without "
|
352 | 8d90ad90 | David Gibson | "H_REGISTER_LOGICAL_LAN\n");
|
353 | 8d90ad90 | David Gibson | return H_RESOURCE;
|
354 | 8d90ad90 | David Gibson | } |
355 | 8d90ad90 | David Gibson | |
356 | c17491b6 | David Gibson | spapr_vlan_reset(sdev); |
357 | 8d90ad90 | David Gibson | return H_SUCCESS;
|
358 | 8d90ad90 | David Gibson | } |
359 | 8d90ad90 | David Gibson | |
360 | b13ce26d | Andreas Färber | static target_ulong h_add_logical_lan_buffer(PowerPCCPU *cpu,
|
361 | 8d90ad90 | David Gibson | sPAPREnvironment *spapr, |
362 | 8d90ad90 | David Gibson | target_ulong opcode, |
363 | 8d90ad90 | David Gibson | target_ulong *args) |
364 | 8d90ad90 | David Gibson | { |
365 | 8d90ad90 | David Gibson | target_ulong reg = args[0];
|
366 | 8d90ad90 | David Gibson | target_ulong buf = args[1];
|
367 | 8d90ad90 | David Gibson | VIOsPAPRDevice *sdev = spapr_vio_find_by_reg(spapr->vio_bus, reg); |
368 | 8d90ad90 | David Gibson | VIOsPAPRVLANDevice *dev = (VIOsPAPRVLANDevice *)sdev; |
369 | 8d90ad90 | David Gibson | vlan_bd_t bd; |
370 | 8d90ad90 | David Gibson | |
371 | 8d90ad90 | David Gibson | dprintf("H_ADD_LOGICAL_LAN_BUFFER(0x" TARGET_FMT_lx
|
372 | 8d90ad90 | David Gibson | ", 0x" TARGET_FMT_lx ")\n", reg, buf); |
373 | 8d90ad90 | David Gibson | |
374 | 8d90ad90 | David Gibson | if (!sdev) {
|
375 | d9599c92 | David Gibson | hcall_dprintf("Bad device\n");
|
376 | 8d90ad90 | David Gibson | return H_PARAMETER;
|
377 | 8d90ad90 | David Gibson | } |
378 | 8d90ad90 | David Gibson | |
379 | 8d90ad90 | David Gibson | if ((check_bd(dev, buf, 4) < 0) |
380 | 8d90ad90 | David Gibson | || (VLAN_BD_LEN(buf) < 16)) {
|
381 | d9599c92 | David Gibson | hcall_dprintf("Bad buffer enqueued\n");
|
382 | 8d90ad90 | David Gibson | return H_PARAMETER;
|
383 | 8d90ad90 | David Gibson | } |
384 | 8d90ad90 | David Gibson | |
385 | 8d90ad90 | David Gibson | if (!dev->isopen || dev->rx_bufs >= VLAN_MAX_BUFS) {
|
386 | 8d90ad90 | David Gibson | return H_RESOURCE;
|
387 | 8d90ad90 | David Gibson | } |
388 | 8d90ad90 | David Gibson | |
389 | 8d90ad90 | David Gibson | do {
|
390 | 8d90ad90 | David Gibson | dev->add_buf_ptr += 8;
|
391 | ad0ebb91 | David Gibson | if (dev->add_buf_ptr >= SPAPR_TCE_PAGE_SIZE) {
|
392 | 8d90ad90 | David Gibson | dev->add_buf_ptr = VLAN_RX_BDS_OFF; |
393 | 8d90ad90 | David Gibson | } |
394 | 8d90ad90 | David Gibson | |
395 | ad0ebb91 | David Gibson | bd = vio_ldq(sdev, dev->buf_list + dev->add_buf_ptr); |
396 | 8d90ad90 | David Gibson | } while (bd & VLAN_BD_VALID);
|
397 | 8d90ad90 | David Gibson | |
398 | ad0ebb91 | David Gibson | vio_stq(sdev, dev->buf_list + dev->add_buf_ptr, buf); |
399 | 8d90ad90 | David Gibson | |
400 | 8d90ad90 | David Gibson | dev->rx_bufs++; |
401 | 8d90ad90 | David Gibson | |
402 | 8d90ad90 | David Gibson | dprintf("h_add_logical_lan_buffer(): Added buf ptr=%d rx_bufs=%d"
|
403 | 8d90ad90 | David Gibson | " bd=0x%016llx\n", dev->add_buf_ptr, dev->rx_bufs,
|
404 | 8d90ad90 | David Gibson | (unsigned long long)buf); |
405 | 8d90ad90 | David Gibson | |
406 | 8d90ad90 | David Gibson | return H_SUCCESS;
|
407 | 8d90ad90 | David Gibson | } |
408 | 8d90ad90 | David Gibson | |
409 | b13ce26d | Andreas Färber | static target_ulong h_send_logical_lan(PowerPCCPU *cpu, sPAPREnvironment *spapr,
|
410 | 8d90ad90 | David Gibson | target_ulong opcode, target_ulong *args) |
411 | 8d90ad90 | David Gibson | { |
412 | 8d90ad90 | David Gibson | target_ulong reg = args[0];
|
413 | 8d90ad90 | David Gibson | target_ulong *bufs = args + 1;
|
414 | 8d90ad90 | David Gibson | target_ulong continue_token = args[7];
|
415 | 8d90ad90 | David Gibson | VIOsPAPRDevice *sdev = spapr_vio_find_by_reg(spapr->vio_bus, reg); |
416 | 8d90ad90 | David Gibson | VIOsPAPRVLANDevice *dev = (VIOsPAPRVLANDevice *)sdev; |
417 | 8d90ad90 | David Gibson | unsigned total_len;
|
418 | 8d90ad90 | David Gibson | uint8_t *lbuf, *p; |
419 | 8d90ad90 | David Gibson | int i, nbufs;
|
420 | 8d90ad90 | David Gibson | int ret;
|
421 | 8d90ad90 | David Gibson | |
422 | 8d90ad90 | David Gibson | dprintf("H_SEND_LOGICAL_LAN(0x" TARGET_FMT_lx ", <bufs>, 0x" |
423 | 8d90ad90 | David Gibson | TARGET_FMT_lx ")\n", reg, continue_token);
|
424 | 8d90ad90 | David Gibson | |
425 | 8d90ad90 | David Gibson | if (!sdev) {
|
426 | 8d90ad90 | David Gibson | return H_PARAMETER;
|
427 | 8d90ad90 | David Gibson | } |
428 | 8d90ad90 | David Gibson | |
429 | 8d90ad90 | David Gibson | dprintf("rxbufs = %d\n", dev->rx_bufs);
|
430 | 8d90ad90 | David Gibson | |
431 | 8d90ad90 | David Gibson | if (!dev->isopen) {
|
432 | 8d90ad90 | David Gibson | return H_DROPPED;
|
433 | 8d90ad90 | David Gibson | } |
434 | 8d90ad90 | David Gibson | |
435 | 8d90ad90 | David Gibson | if (continue_token) {
|
436 | 8d90ad90 | David Gibson | return H_HARDWARE; /* FIXME actually handle this */ |
437 | 8d90ad90 | David Gibson | } |
438 | 8d90ad90 | David Gibson | |
439 | 8d90ad90 | David Gibson | total_len = 0;
|
440 | 8d90ad90 | David Gibson | for (i = 0; i < 6; i++) { |
441 | 8d90ad90 | David Gibson | dprintf(" buf desc: 0x" TARGET_FMT_lx "\n", bufs[i]); |
442 | 8d90ad90 | David Gibson | if (!(bufs[i] & VLAN_BD_VALID)) {
|
443 | 8d90ad90 | David Gibson | break;
|
444 | 8d90ad90 | David Gibson | } |
445 | 8d90ad90 | David Gibson | total_len += VLAN_BD_LEN(bufs[i]); |
446 | 8d90ad90 | David Gibson | } |
447 | 8d90ad90 | David Gibson | |
448 | 8d90ad90 | David Gibson | nbufs = i; |
449 | 8d90ad90 | David Gibson | dprintf("h_send_logical_lan() %d buffers, total length 0x%x\n",
|
450 | 8d90ad90 | David Gibson | nbufs, total_len); |
451 | 8d90ad90 | David Gibson | |
452 | 8d90ad90 | David Gibson | if (total_len == 0) { |
453 | 8d90ad90 | David Gibson | return H_SUCCESS;
|
454 | 8d90ad90 | David Gibson | } |
455 | 8d90ad90 | David Gibson | |
456 | 8d90ad90 | David Gibson | if (total_len > MAX_PACKET_SIZE) {
|
457 | 8d90ad90 | David Gibson | /* Don't let the guest force too large an allocation */
|
458 | 8d90ad90 | David Gibson | return H_RESOURCE;
|
459 | 8d90ad90 | David Gibson | } |
460 | 8d90ad90 | David Gibson | |
461 | 8d90ad90 | David Gibson | lbuf = alloca(total_len); |
462 | 8d90ad90 | David Gibson | p = lbuf; |
463 | 8d90ad90 | David Gibson | for (i = 0; i < nbufs; i++) { |
464 | ad0ebb91 | David Gibson | ret = spapr_vio_dma_read(sdev, VLAN_BD_ADDR(bufs[i]), |
465 | 8d90ad90 | David Gibson | p, VLAN_BD_LEN(bufs[i])); |
466 | 8d90ad90 | David Gibson | if (ret < 0) { |
467 | 8d90ad90 | David Gibson | return ret;
|
468 | 8d90ad90 | David Gibson | } |
469 | 8d90ad90 | David Gibson | |
470 | 8d90ad90 | David Gibson | p += VLAN_BD_LEN(bufs[i]); |
471 | 8d90ad90 | David Gibson | } |
472 | 8d90ad90 | David Gibson | |
473 | b356f76d | Jason Wang | qemu_send_packet(qemu_get_queue(dev->nic), lbuf, total_len); |
474 | 8d90ad90 | David Gibson | |
475 | 8d90ad90 | David Gibson | return H_SUCCESS;
|
476 | 8d90ad90 | David Gibson | } |
477 | 8d90ad90 | David Gibson | |
478 | b13ce26d | Andreas Färber | static target_ulong h_multicast_ctrl(PowerPCCPU *cpu, sPAPREnvironment *spapr,
|
479 | 8d90ad90 | David Gibson | target_ulong opcode, target_ulong *args) |
480 | 8d90ad90 | David Gibson | { |
481 | 8d90ad90 | David Gibson | target_ulong reg = args[0];
|
482 | 8d90ad90 | David Gibson | VIOsPAPRDevice *dev = spapr_vio_find_by_reg(spapr->vio_bus, reg); |
483 | 8d90ad90 | David Gibson | |
484 | 8d90ad90 | David Gibson | if (!dev) {
|
485 | 8d90ad90 | David Gibson | return H_PARAMETER;
|
486 | 8d90ad90 | David Gibson | } |
487 | 8d90ad90 | David Gibson | |
488 | 8d90ad90 | David Gibson | return H_SUCCESS;
|
489 | 8d90ad90 | David Gibson | } |
490 | 8d90ad90 | David Gibson | |
491 | 3954d33a | Anthony Liguori | static Property spapr_vlan_properties[] = {
|
492 | ad0ebb91 | David Gibson | DEFINE_SPAPR_PROPERTIES(VIOsPAPRVLANDevice, sdev), |
493 | 3954d33a | Anthony Liguori | DEFINE_NIC_PROPERTIES(VIOsPAPRVLANDevice, nicconf), |
494 | 3954d33a | Anthony Liguori | DEFINE_PROP_END_OF_LIST(), |
495 | 3954d33a | Anthony Liguori | }; |
496 | 3954d33a | Anthony Liguori | |
497 | 3954d33a | Anthony Liguori | static void spapr_vlan_class_init(ObjectClass *klass, void *data) |
498 | 3954d33a | Anthony Liguori | { |
499 | 39bffca2 | Anthony Liguori | DeviceClass *dc = DEVICE_CLASS(klass); |
500 | 3954d33a | Anthony Liguori | VIOsPAPRDeviceClass *k = VIO_SPAPR_DEVICE_CLASS(klass); |
501 | 3954d33a | Anthony Liguori | |
502 | 3954d33a | Anthony Liguori | k->init = spapr_vlan_init; |
503 | c17491b6 | David Gibson | k->reset = spapr_vlan_reset; |
504 | 3954d33a | Anthony Liguori | k->devnode = spapr_vlan_devnode; |
505 | 3954d33a | Anthony Liguori | k->dt_name = "l-lan";
|
506 | 3954d33a | Anthony Liguori | k->dt_type = "network";
|
507 | 3954d33a | Anthony Liguori | k->dt_compatible = "IBM,l-lan";
|
508 | 3954d33a | Anthony Liguori | k->signal_mask = 0x1;
|
509 | 39bffca2 | Anthony Liguori | dc->props = spapr_vlan_properties; |
510 | ad0ebb91 | David Gibson | k->rtce_window_size = 0x10000000;
|
511 | 3954d33a | Anthony Liguori | } |
512 | 3954d33a | Anthony Liguori | |
513 | 8c43a6f0 | Andreas Färber | static const TypeInfo spapr_vlan_info = { |
514 | 39bffca2 | Anthony Liguori | .name = "spapr-vlan",
|
515 | 39bffca2 | Anthony Liguori | .parent = TYPE_VIO_SPAPR_DEVICE, |
516 | 39bffca2 | Anthony Liguori | .instance_size = sizeof(VIOsPAPRVLANDevice),
|
517 | 39bffca2 | Anthony Liguori | .class_init = spapr_vlan_class_init, |
518 | 8d90ad90 | David Gibson | }; |
519 | 8d90ad90 | David Gibson | |
520 | 83f7d43a | Andreas Färber | static void spapr_vlan_register_types(void) |
521 | 8d90ad90 | David Gibson | { |
522 | 1fc02533 | David Gibson | spapr_register_hypercall(H_REGISTER_LOGICAL_LAN, h_register_logical_lan); |
523 | 1fc02533 | David Gibson | spapr_register_hypercall(H_FREE_LOGICAL_LAN, h_free_logical_lan); |
524 | 1fc02533 | David Gibson | spapr_register_hypercall(H_SEND_LOGICAL_LAN, h_send_logical_lan); |
525 | 1fc02533 | David Gibson | spapr_register_hypercall(H_ADD_LOGICAL_LAN_BUFFER, |
526 | 1fc02533 | David Gibson | h_add_logical_lan_buffer); |
527 | 1fc02533 | David Gibson | spapr_register_hypercall(H_MULTICAST_CTRL, h_multicast_ctrl); |
528 | 39bffca2 | Anthony Liguori | type_register_static(&spapr_vlan_info); |
529 | 8d90ad90 | David Gibson | } |
530 | 83f7d43a | Andreas Färber | |
531 | 83f7d43a | Andreas Färber | type_init(spapr_vlan_register_types) |