root / hw / spapr_llan.c @ 5c3234c6
History | View | Annotate | Download (15.6 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 | 8d90ad90 | David Gibson | #include "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 | 8d90ad90 | David Gibson | #define VLAN_MAX_BUFS ((SPAPR_VIO_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 | 8d90ad90 | David Gibson | static int spapr_vlan_can_receive(VLANClientState *nc) |
87 | 8d90ad90 | David Gibson | { |
88 | 8d90ad90 | David Gibson | VIOsPAPRVLANDevice *dev = DO_UPCAST(NICState, nc, nc)->opaque; |
89 | 8d90ad90 | David Gibson | |
90 | 8d90ad90 | David Gibson | return (dev->isopen && dev->rx_bufs > 0); |
91 | 8d90ad90 | David Gibson | } |
92 | 8d90ad90 | David Gibson | |
93 | 8d90ad90 | David Gibson | static ssize_t spapr_vlan_receive(VLANClientState *nc, const uint8_t *buf, |
94 | 8d90ad90 | David Gibson | size_t size) |
95 | 8d90ad90 | David Gibson | { |
96 | 8d90ad90 | David Gibson | VIOsPAPRDevice *sdev = DO_UPCAST(NICState, nc, nc)->opaque; |
97 | 8d90ad90 | David Gibson | VIOsPAPRVLANDevice *dev = (VIOsPAPRVLANDevice *)sdev; |
98 | 8d90ad90 | David Gibson | vlan_bd_t rxq_bd = ldq_tce(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 | 8d90ad90 | David Gibson | if (buf_ptr >= SPAPR_VIO_TCE_PAGE_SIZE) {
|
118 | 8d90ad90 | David Gibson | buf_ptr = VLAN_RX_BDS_OFF; |
119 | 8d90ad90 | David Gibson | } |
120 | 8d90ad90 | David Gibson | |
121 | 8d90ad90 | David Gibson | bd = ldq_tce(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 | 8d90ad90 | David Gibson | stq_tce(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 | 8d90ad90 | David Gibson | if (spapr_tce_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 | 8d90ad90 | David Gibson | handle = ldq_tce(sdev, VLAN_BD_ADDR(bd)); |
153 | 8d90ad90 | David Gibson | stq_tce(sdev, VLAN_BD_ADDR(rxq_bd) + dev->rxq_ptr + 8, handle);
|
154 | 8d90ad90 | David Gibson | stw_tce(sdev, VLAN_BD_ADDR(rxq_bd) + dev->rxq_ptr + 4, size);
|
155 | 8d90ad90 | David Gibson | sth_tce(sdev, VLAN_BD_ADDR(rxq_bd) + dev->rxq_ptr + 2, 8); |
156 | 8d90ad90 | David Gibson | stb_tce(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 | 8d90ad90 | David Gibson | (unsigned long long)ldq_tce(sdev, VLAN_BD_ADDR(rxq_bd) + |
161 | 8d90ad90 | David Gibson | dev->rxq_ptr), |
162 | 8d90ad90 | David Gibson | (unsigned long long)ldq_tce(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 | 8d90ad90 | David Gibson | stq_tce(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 | 8d90ad90 | David Gibson | qemu_irq_pulse(sdev->qirq); |
173 | 8d90ad90 | David Gibson | } |
174 | 8d90ad90 | David Gibson | |
175 | 8d90ad90 | David Gibson | return size;
|
176 | 8d90ad90 | David Gibson | } |
177 | 8d90ad90 | David Gibson | |
178 | 8d90ad90 | David Gibson | static NetClientInfo net_spapr_vlan_info = {
|
179 | 8d90ad90 | David Gibson | .type = NET_CLIENT_TYPE_NIC, |
180 | 8d90ad90 | David Gibson | .size = sizeof(NICState),
|
181 | 8d90ad90 | David Gibson | .can_receive = spapr_vlan_can_receive, |
182 | 8d90ad90 | David Gibson | .receive = spapr_vlan_receive, |
183 | 8d90ad90 | David Gibson | }; |
184 | 8d90ad90 | David Gibson | |
185 | 8d90ad90 | David Gibson | static int spapr_vlan_init(VIOsPAPRDevice *sdev) |
186 | 8d90ad90 | David Gibson | { |
187 | 8d90ad90 | David Gibson | VIOsPAPRVLANDevice *dev = (VIOsPAPRVLANDevice *)sdev; |
188 | 8d90ad90 | David Gibson | |
189 | 8d90ad90 | David Gibson | qemu_macaddr_default_if_unset(&dev->nicconf.macaddr); |
190 | 8d90ad90 | David Gibson | |
191 | 8d90ad90 | David Gibson | dev->nic = qemu_new_nic(&net_spapr_vlan_info, &dev->nicconf, |
192 | 8d90ad90 | David Gibson | sdev->qdev.info->name, sdev->qdev.id, dev); |
193 | 8d90ad90 | David Gibson | qemu_format_nic_info_str(&dev->nic->nc, dev->nicconf.macaddr.a); |
194 | 8d90ad90 | David Gibson | |
195 | 8d90ad90 | David Gibson | return 0; |
196 | 8d90ad90 | David Gibson | } |
197 | 8d90ad90 | David Gibson | |
198 | 8d90ad90 | David Gibson | void spapr_vlan_create(VIOsPAPRBus *bus, uint32_t reg, NICInfo *nd,
|
199 | 8d90ad90 | David Gibson | qemu_irq qirq, uint32_t vio_irq_num) |
200 | 8d90ad90 | David Gibson | { |
201 | 8d90ad90 | David Gibson | DeviceState *dev; |
202 | 8d90ad90 | David Gibson | VIOsPAPRDevice *sdev; |
203 | 8d90ad90 | David Gibson | |
204 | 8d90ad90 | David Gibson | dev = qdev_create(&bus->bus, "spapr-vlan");
|
205 | 8d90ad90 | David Gibson | qdev_prop_set_uint32(dev, "reg", reg);
|
206 | 8d90ad90 | David Gibson | |
207 | 8d90ad90 | David Gibson | qdev_set_nic_properties(dev, nd); |
208 | 8d90ad90 | David Gibson | |
209 | 8d90ad90 | David Gibson | qdev_init_nofail(dev); |
210 | 8d90ad90 | David Gibson | sdev = (VIOsPAPRDevice *)dev; |
211 | 8d90ad90 | David Gibson | sdev->qirq = qirq; |
212 | 8d90ad90 | David Gibson | sdev->vio_irq_num = vio_irq_num; |
213 | 8d90ad90 | David Gibson | } |
214 | 8d90ad90 | David Gibson | |
215 | 8d90ad90 | David Gibson | static int spapr_vlan_devnode(VIOsPAPRDevice *dev, void *fdt, int node_off) |
216 | 8d90ad90 | David Gibson | { |
217 | 8d90ad90 | David Gibson | VIOsPAPRVLANDevice *vdev = (VIOsPAPRVLANDevice *)dev; |
218 | 8d90ad90 | David Gibson | uint8_t padded_mac[8] = {0, 0}; |
219 | 8d90ad90 | David Gibson | int ret;
|
220 | 8d90ad90 | David Gibson | |
221 | 8d90ad90 | David Gibson | /* Some old phyp versions give the mac address in an 8-byte
|
222 | 8d90ad90 | David Gibson | * property. The kernel driver has an insane workaround for this;
|
223 | 8d90ad90 | David Gibson | * rather than doing the obvious thing and checking the property
|
224 | 8d90ad90 | David Gibson | * length, it checks whether the first byte has 0b10 in the low
|
225 | 8d90ad90 | David Gibson | * bits. If a correct 6-byte property has a different first byte
|
226 | 8d90ad90 | David Gibson | * the kernel will get the wrong mac address, overrunning its
|
227 | 8d90ad90 | David Gibson | * buffer in the process (read only, thank goodness).
|
228 | 8d90ad90 | David Gibson | *
|
229 | 8d90ad90 | David Gibson | * Here we workaround the kernel workaround by always supplying an
|
230 | 8d90ad90 | David Gibson | * 8-byte property, with the mac address in the last six bytes */
|
231 | 8d90ad90 | David Gibson | memcpy(&padded_mac[2], &vdev->nicconf.macaddr, ETH_ALEN);
|
232 | 8d90ad90 | David Gibson | ret = fdt_setprop(fdt, node_off, "local-mac-address",
|
233 | 8d90ad90 | David Gibson | padded_mac, sizeof(padded_mac));
|
234 | 8d90ad90 | David Gibson | if (ret < 0) { |
235 | 8d90ad90 | David Gibson | return ret;
|
236 | 8d90ad90 | David Gibson | } |
237 | 8d90ad90 | David Gibson | |
238 | 8d90ad90 | David Gibson | ret = fdt_setprop_cell(fdt, node_off, "ibm,mac-address-filters", 0); |
239 | 8d90ad90 | David Gibson | if (ret < 0) { |
240 | 8d90ad90 | David Gibson | return ret;
|
241 | 8d90ad90 | David Gibson | } |
242 | 8d90ad90 | David Gibson | |
243 | 8d90ad90 | David Gibson | return 0; |
244 | 8d90ad90 | David Gibson | } |
245 | 8d90ad90 | David Gibson | |
246 | 8d90ad90 | David Gibson | static int check_bd(VIOsPAPRVLANDevice *dev, vlan_bd_t bd, |
247 | 8d90ad90 | David Gibson | target_ulong alignment) |
248 | 8d90ad90 | David Gibson | { |
249 | 8d90ad90 | David Gibson | if ((VLAN_BD_ADDR(bd) % alignment)
|
250 | 8d90ad90 | David Gibson | || (VLAN_BD_LEN(bd) % alignment)) { |
251 | 8d90ad90 | David Gibson | return -1; |
252 | 8d90ad90 | David Gibson | } |
253 | 8d90ad90 | David Gibson | |
254 | 8d90ad90 | David Gibson | if (spapr_vio_check_tces(&dev->sdev, VLAN_BD_ADDR(bd),
|
255 | 8d90ad90 | David Gibson | VLAN_BD_LEN(bd), SPAPR_TCE_RW) != 0) {
|
256 | 8d90ad90 | David Gibson | return -1; |
257 | 8d90ad90 | David Gibson | } |
258 | 8d90ad90 | David Gibson | |
259 | 8d90ad90 | David Gibson | return 0; |
260 | 8d90ad90 | David Gibson | } |
261 | 8d90ad90 | David Gibson | |
262 | 8d90ad90 | David Gibson | static target_ulong h_register_logical_lan(CPUState *env,
|
263 | 8d90ad90 | David Gibson | sPAPREnvironment *spapr, |
264 | 8d90ad90 | David Gibson | target_ulong opcode, |
265 | 8d90ad90 | David Gibson | target_ulong *args) |
266 | 8d90ad90 | David Gibson | { |
267 | 8d90ad90 | David Gibson | target_ulong reg = args[0];
|
268 | 8d90ad90 | David Gibson | target_ulong buf_list = args[1];
|
269 | 8d90ad90 | David Gibson | target_ulong rec_queue = args[2];
|
270 | 8d90ad90 | David Gibson | target_ulong filter_list = args[3];
|
271 | 8d90ad90 | David Gibson | VIOsPAPRDevice *sdev = spapr_vio_find_by_reg(spapr->vio_bus, reg); |
272 | 8d90ad90 | David Gibson | VIOsPAPRVLANDevice *dev = (VIOsPAPRVLANDevice *)sdev; |
273 | 8d90ad90 | David Gibson | vlan_bd_t filter_list_bd; |
274 | 8d90ad90 | David Gibson | |
275 | 8d90ad90 | David Gibson | if (!dev) {
|
276 | 8d90ad90 | David Gibson | return H_PARAMETER;
|
277 | 8d90ad90 | David Gibson | } |
278 | 8d90ad90 | David Gibson | |
279 | 8d90ad90 | David Gibson | if (dev->isopen) {
|
280 | 8d90ad90 | David Gibson | hcall_dprintf("H_REGISTER_LOGICAL_LAN called twice without "
|
281 | 8d90ad90 | David Gibson | "H_FREE_LOGICAL_LAN\n");
|
282 | 8d90ad90 | David Gibson | return H_RESOURCE;
|
283 | 8d90ad90 | David Gibson | } |
284 | 8d90ad90 | David Gibson | |
285 | 8d90ad90 | David Gibson | if (check_bd(dev, VLAN_VALID_BD(buf_list, SPAPR_VIO_TCE_PAGE_SIZE),
|
286 | 8d90ad90 | David Gibson | SPAPR_VIO_TCE_PAGE_SIZE) < 0) {
|
287 | 8d90ad90 | David Gibson | hcall_dprintf("Bad buf_list 0x" TARGET_FMT_lx " for " |
288 | 8d90ad90 | David Gibson | "H_REGISTER_LOGICAL_LAN\n", buf_list);
|
289 | 8d90ad90 | David Gibson | return H_PARAMETER;
|
290 | 8d90ad90 | David Gibson | } |
291 | 8d90ad90 | David Gibson | |
292 | 8d90ad90 | David Gibson | filter_list_bd = VLAN_VALID_BD(filter_list, SPAPR_VIO_TCE_PAGE_SIZE); |
293 | 8d90ad90 | David Gibson | if (check_bd(dev, filter_list_bd, SPAPR_VIO_TCE_PAGE_SIZE) < 0) { |
294 | 8d90ad90 | David Gibson | hcall_dprintf("Bad filter_list 0x" TARGET_FMT_lx " for " |
295 | 8d90ad90 | David Gibson | "H_REGISTER_LOGICAL_LAN\n", filter_list);
|
296 | 8d90ad90 | David Gibson | return H_PARAMETER;
|
297 | 8d90ad90 | David Gibson | } |
298 | 8d90ad90 | David Gibson | |
299 | 8d90ad90 | David Gibson | if (!(rec_queue & VLAN_BD_VALID)
|
300 | 8d90ad90 | David Gibson | || (check_bd(dev, rec_queue, VLAN_RQ_ALIGNMENT) < 0)) {
|
301 | 8d90ad90 | David Gibson | hcall_dprintf("Bad receive queue for H_REGISTER_LOGICAL_LAN\n");
|
302 | 8d90ad90 | David Gibson | return H_PARAMETER;
|
303 | 8d90ad90 | David Gibson | } |
304 | 8d90ad90 | David Gibson | |
305 | 8d90ad90 | David Gibson | dev->buf_list = buf_list; |
306 | 8d90ad90 | David Gibson | sdev->signal_state = 0;
|
307 | 8d90ad90 | David Gibson | |
308 | 8d90ad90 | David Gibson | rec_queue &= ~VLAN_BD_TOGGLE; |
309 | 8d90ad90 | David Gibson | |
310 | 8d90ad90 | David Gibson | /* Initialize the buffer list */
|
311 | 8d90ad90 | David Gibson | stq_tce(sdev, buf_list, rec_queue); |
312 | 8d90ad90 | David Gibson | stq_tce(sdev, buf_list + 8, filter_list_bd);
|
313 | 8d90ad90 | David Gibson | spapr_tce_dma_zero(sdev, buf_list + VLAN_RX_BDS_OFF, |
314 | 8d90ad90 | David Gibson | SPAPR_VIO_TCE_PAGE_SIZE - VLAN_RX_BDS_OFF); |
315 | 8d90ad90 | David Gibson | dev->add_buf_ptr = VLAN_RX_BDS_OFF - 8;
|
316 | 8d90ad90 | David Gibson | dev->use_buf_ptr = VLAN_RX_BDS_OFF - 8;
|
317 | 8d90ad90 | David Gibson | dev->rx_bufs = 0;
|
318 | 8d90ad90 | David Gibson | dev->rxq_ptr = 0;
|
319 | 8d90ad90 | David Gibson | |
320 | 8d90ad90 | David Gibson | /* Initialize the receive queue */
|
321 | 8d90ad90 | David Gibson | spapr_tce_dma_zero(sdev, VLAN_BD_ADDR(rec_queue), VLAN_BD_LEN(rec_queue)); |
322 | 8d90ad90 | David Gibson | |
323 | 8d90ad90 | David Gibson | dev->isopen = 1;
|
324 | 8d90ad90 | David Gibson | return H_SUCCESS;
|
325 | 8d90ad90 | David Gibson | } |
326 | 8d90ad90 | David Gibson | |
327 | 8d90ad90 | David Gibson | |
328 | 8d90ad90 | David Gibson | static target_ulong h_free_logical_lan(CPUState *env, sPAPREnvironment *spapr,
|
329 | 8d90ad90 | David Gibson | target_ulong opcode, target_ulong *args) |
330 | 8d90ad90 | David Gibson | { |
331 | 8d90ad90 | David Gibson | target_ulong reg = args[0];
|
332 | 8d90ad90 | David Gibson | VIOsPAPRDevice *sdev = spapr_vio_find_by_reg(spapr->vio_bus, reg); |
333 | 8d90ad90 | David Gibson | VIOsPAPRVLANDevice *dev = (VIOsPAPRVLANDevice *)sdev; |
334 | 8d90ad90 | David Gibson | |
335 | 8d90ad90 | David Gibson | if (!dev) {
|
336 | 8d90ad90 | David Gibson | return H_PARAMETER;
|
337 | 8d90ad90 | David Gibson | } |
338 | 8d90ad90 | David Gibson | |
339 | 8d90ad90 | David Gibson | if (!dev->isopen) {
|
340 | 8d90ad90 | David Gibson | hcall_dprintf("H_FREE_LOGICAL_LAN called without "
|
341 | 8d90ad90 | David Gibson | "H_REGISTER_LOGICAL_LAN\n");
|
342 | 8d90ad90 | David Gibson | return H_RESOURCE;
|
343 | 8d90ad90 | David Gibson | } |
344 | 8d90ad90 | David Gibson | |
345 | 8d90ad90 | David Gibson | dev->buf_list = 0;
|
346 | 8d90ad90 | David Gibson | dev->rx_bufs = 0;
|
347 | 8d90ad90 | David Gibson | dev->isopen = 0;
|
348 | 8d90ad90 | David Gibson | return H_SUCCESS;
|
349 | 8d90ad90 | David Gibson | } |
350 | 8d90ad90 | David Gibson | |
351 | 8d90ad90 | David Gibson | static target_ulong h_add_logical_lan_buffer(CPUState *env,
|
352 | 8d90ad90 | David Gibson | sPAPREnvironment *spapr, |
353 | 8d90ad90 | David Gibson | target_ulong opcode, |
354 | 8d90ad90 | David Gibson | target_ulong *args) |
355 | 8d90ad90 | David Gibson | { |
356 | 8d90ad90 | David Gibson | target_ulong reg = args[0];
|
357 | 8d90ad90 | David Gibson | target_ulong buf = args[1];
|
358 | 8d90ad90 | David Gibson | VIOsPAPRDevice *sdev = spapr_vio_find_by_reg(spapr->vio_bus, reg); |
359 | 8d90ad90 | David Gibson | VIOsPAPRVLANDevice *dev = (VIOsPAPRVLANDevice *)sdev; |
360 | 8d90ad90 | David Gibson | vlan_bd_t bd; |
361 | 8d90ad90 | David Gibson | |
362 | 8d90ad90 | David Gibson | dprintf("H_ADD_LOGICAL_LAN_BUFFER(0x" TARGET_FMT_lx
|
363 | 8d90ad90 | David Gibson | ", 0x" TARGET_FMT_lx ")\n", reg, buf); |
364 | 8d90ad90 | David Gibson | |
365 | 8d90ad90 | David Gibson | if (!sdev) {
|
366 | 8d90ad90 | David Gibson | hcall_dprintf("Wrong device in h_add_logical_lan_buffer\n");
|
367 | 8d90ad90 | David Gibson | return H_PARAMETER;
|
368 | 8d90ad90 | David Gibson | } |
369 | 8d90ad90 | David Gibson | |
370 | 8d90ad90 | David Gibson | if ((check_bd(dev, buf, 4) < 0) |
371 | 8d90ad90 | David Gibson | || (VLAN_BD_LEN(buf) < 16)) {
|
372 | 8d90ad90 | David Gibson | hcall_dprintf("Bad buffer enqueued in h_add_logical_lan_buffer\n");
|
373 | 8d90ad90 | David Gibson | return H_PARAMETER;
|
374 | 8d90ad90 | David Gibson | } |
375 | 8d90ad90 | David Gibson | |
376 | 8d90ad90 | David Gibson | if (!dev->isopen || dev->rx_bufs >= VLAN_MAX_BUFS) {
|
377 | 8d90ad90 | David Gibson | return H_RESOURCE;
|
378 | 8d90ad90 | David Gibson | } |
379 | 8d90ad90 | David Gibson | |
380 | 8d90ad90 | David Gibson | do {
|
381 | 8d90ad90 | David Gibson | dev->add_buf_ptr += 8;
|
382 | 8d90ad90 | David Gibson | if (dev->add_buf_ptr >= SPAPR_VIO_TCE_PAGE_SIZE) {
|
383 | 8d90ad90 | David Gibson | dev->add_buf_ptr = VLAN_RX_BDS_OFF; |
384 | 8d90ad90 | David Gibson | } |
385 | 8d90ad90 | David Gibson | |
386 | 8d90ad90 | David Gibson | bd = ldq_tce(sdev, dev->buf_list + dev->add_buf_ptr); |
387 | 8d90ad90 | David Gibson | } while (bd & VLAN_BD_VALID);
|
388 | 8d90ad90 | David Gibson | |
389 | 8d90ad90 | David Gibson | stq_tce(sdev, dev->buf_list + dev->add_buf_ptr, buf); |
390 | 8d90ad90 | David Gibson | |
391 | 8d90ad90 | David Gibson | dev->rx_bufs++; |
392 | 8d90ad90 | David Gibson | |
393 | 8d90ad90 | David Gibson | dprintf("h_add_logical_lan_buffer(): Added buf ptr=%d rx_bufs=%d"
|
394 | 8d90ad90 | David Gibson | " bd=0x%016llx\n", dev->add_buf_ptr, dev->rx_bufs,
|
395 | 8d90ad90 | David Gibson | (unsigned long long)buf); |
396 | 8d90ad90 | David Gibson | |
397 | 8d90ad90 | David Gibson | return H_SUCCESS;
|
398 | 8d90ad90 | David Gibson | } |
399 | 8d90ad90 | David Gibson | |
400 | 8d90ad90 | David Gibson | static target_ulong h_send_logical_lan(CPUState *env, sPAPREnvironment *spapr,
|
401 | 8d90ad90 | David Gibson | target_ulong opcode, target_ulong *args) |
402 | 8d90ad90 | David Gibson | { |
403 | 8d90ad90 | David Gibson | target_ulong reg = args[0];
|
404 | 8d90ad90 | David Gibson | target_ulong *bufs = args + 1;
|
405 | 8d90ad90 | David Gibson | target_ulong continue_token = args[7];
|
406 | 8d90ad90 | David Gibson | VIOsPAPRDevice *sdev = spapr_vio_find_by_reg(spapr->vio_bus, reg); |
407 | 8d90ad90 | David Gibson | VIOsPAPRVLANDevice *dev = (VIOsPAPRVLANDevice *)sdev; |
408 | 8d90ad90 | David Gibson | unsigned total_len;
|
409 | 8d90ad90 | David Gibson | uint8_t *lbuf, *p; |
410 | 8d90ad90 | David Gibson | int i, nbufs;
|
411 | 8d90ad90 | David Gibson | int ret;
|
412 | 8d90ad90 | David Gibson | |
413 | 8d90ad90 | David Gibson | dprintf("H_SEND_LOGICAL_LAN(0x" TARGET_FMT_lx ", <bufs>, 0x" |
414 | 8d90ad90 | David Gibson | TARGET_FMT_lx ")\n", reg, continue_token);
|
415 | 8d90ad90 | David Gibson | |
416 | 8d90ad90 | David Gibson | if (!sdev) {
|
417 | 8d90ad90 | David Gibson | return H_PARAMETER;
|
418 | 8d90ad90 | David Gibson | } |
419 | 8d90ad90 | David Gibson | |
420 | 8d90ad90 | David Gibson | dprintf("rxbufs = %d\n", dev->rx_bufs);
|
421 | 8d90ad90 | David Gibson | |
422 | 8d90ad90 | David Gibson | if (!dev->isopen) {
|
423 | 8d90ad90 | David Gibson | return H_DROPPED;
|
424 | 8d90ad90 | David Gibson | } |
425 | 8d90ad90 | David Gibson | |
426 | 8d90ad90 | David Gibson | if (continue_token) {
|
427 | 8d90ad90 | David Gibson | return H_HARDWARE; /* FIXME actually handle this */ |
428 | 8d90ad90 | David Gibson | } |
429 | 8d90ad90 | David Gibson | |
430 | 8d90ad90 | David Gibson | total_len = 0;
|
431 | 8d90ad90 | David Gibson | for (i = 0; i < 6; i++) { |
432 | 8d90ad90 | David Gibson | dprintf(" buf desc: 0x" TARGET_FMT_lx "\n", bufs[i]); |
433 | 8d90ad90 | David Gibson | if (!(bufs[i] & VLAN_BD_VALID)) {
|
434 | 8d90ad90 | David Gibson | break;
|
435 | 8d90ad90 | David Gibson | } |
436 | 8d90ad90 | David Gibson | total_len += VLAN_BD_LEN(bufs[i]); |
437 | 8d90ad90 | David Gibson | } |
438 | 8d90ad90 | David Gibson | |
439 | 8d90ad90 | David Gibson | nbufs = i; |
440 | 8d90ad90 | David Gibson | dprintf("h_send_logical_lan() %d buffers, total length 0x%x\n",
|
441 | 8d90ad90 | David Gibson | nbufs, total_len); |
442 | 8d90ad90 | David Gibson | |
443 | 8d90ad90 | David Gibson | if (total_len == 0) { |
444 | 8d90ad90 | David Gibson | return H_SUCCESS;
|
445 | 8d90ad90 | David Gibson | } |
446 | 8d90ad90 | David Gibson | |
447 | 8d90ad90 | David Gibson | if (total_len > MAX_PACKET_SIZE) {
|
448 | 8d90ad90 | David Gibson | /* Don't let the guest force too large an allocation */
|
449 | 8d90ad90 | David Gibson | return H_RESOURCE;
|
450 | 8d90ad90 | David Gibson | } |
451 | 8d90ad90 | David Gibson | |
452 | 8d90ad90 | David Gibson | lbuf = alloca(total_len); |
453 | 8d90ad90 | David Gibson | p = lbuf; |
454 | 8d90ad90 | David Gibson | for (i = 0; i < nbufs; i++) { |
455 | 8d90ad90 | David Gibson | ret = spapr_tce_dma_read(sdev, VLAN_BD_ADDR(bufs[i]), |
456 | 8d90ad90 | David Gibson | p, VLAN_BD_LEN(bufs[i])); |
457 | 8d90ad90 | David Gibson | if (ret < 0) { |
458 | 8d90ad90 | David Gibson | return ret;
|
459 | 8d90ad90 | David Gibson | } |
460 | 8d90ad90 | David Gibson | |
461 | 8d90ad90 | David Gibson | p += VLAN_BD_LEN(bufs[i]); |
462 | 8d90ad90 | David Gibson | } |
463 | 8d90ad90 | David Gibson | |
464 | 8d90ad90 | David Gibson | qemu_send_packet(&dev->nic->nc, lbuf, total_len); |
465 | 8d90ad90 | David Gibson | |
466 | 8d90ad90 | David Gibson | return H_SUCCESS;
|
467 | 8d90ad90 | David Gibson | } |
468 | 8d90ad90 | David Gibson | |
469 | 8d90ad90 | David Gibson | static target_ulong h_multicast_ctrl(CPUState *env, sPAPREnvironment *spapr,
|
470 | 8d90ad90 | David Gibson | target_ulong opcode, target_ulong *args) |
471 | 8d90ad90 | David Gibson | { |
472 | 8d90ad90 | David Gibson | target_ulong reg = args[0];
|
473 | 8d90ad90 | David Gibson | VIOsPAPRDevice *dev = spapr_vio_find_by_reg(spapr->vio_bus, reg); |
474 | 8d90ad90 | David Gibson | |
475 | 8d90ad90 | David Gibson | if (!dev) {
|
476 | 8d90ad90 | David Gibson | return H_PARAMETER;
|
477 | 8d90ad90 | David Gibson | } |
478 | 8d90ad90 | David Gibson | |
479 | 8d90ad90 | David Gibson | return H_SUCCESS;
|
480 | 8d90ad90 | David Gibson | } |
481 | 8d90ad90 | David Gibson | |
482 | 8d90ad90 | David Gibson | static void vlan_hcalls(VIOsPAPRBus *bus) |
483 | 8d90ad90 | David Gibson | { |
484 | 8d90ad90 | David Gibson | spapr_register_hypercall(H_REGISTER_LOGICAL_LAN, h_register_logical_lan); |
485 | 8d90ad90 | David Gibson | spapr_register_hypercall(H_FREE_LOGICAL_LAN, h_free_logical_lan); |
486 | 8d90ad90 | David Gibson | spapr_register_hypercall(H_SEND_LOGICAL_LAN, h_send_logical_lan); |
487 | 8d90ad90 | David Gibson | spapr_register_hypercall(H_ADD_LOGICAL_LAN_BUFFER, |
488 | 8d90ad90 | David Gibson | h_add_logical_lan_buffer); |
489 | 8d90ad90 | David Gibson | spapr_register_hypercall(H_MULTICAST_CTRL, h_multicast_ctrl); |
490 | 8d90ad90 | David Gibson | } |
491 | 8d90ad90 | David Gibson | |
492 | 8d90ad90 | David Gibson | static VIOsPAPRDeviceInfo spapr_vlan = {
|
493 | 8d90ad90 | David Gibson | .init = spapr_vlan_init, |
494 | 8d90ad90 | David Gibson | .devnode = spapr_vlan_devnode, |
495 | 8d90ad90 | David Gibson | .dt_name = "l-lan",
|
496 | 8d90ad90 | David Gibson | .dt_type = "network",
|
497 | 8d90ad90 | David Gibson | .dt_compatible = "IBM,l-lan",
|
498 | 8d90ad90 | David Gibson | .signal_mask = 0x1,
|
499 | 8d90ad90 | David Gibson | .hcalls = vlan_hcalls, |
500 | 8d90ad90 | David Gibson | .qdev.name = "spapr-vlan",
|
501 | 8d90ad90 | David Gibson | .qdev.size = sizeof(VIOsPAPRVLANDevice),
|
502 | 8d90ad90 | David Gibson | .qdev.props = (Property[]) { |
503 | 8d90ad90 | David Gibson | DEFINE_PROP_UINT32("reg", VIOsPAPRDevice, reg, 0x1000), |
504 | 8d90ad90 | David Gibson | DEFINE_PROP_UINT32("dma-window", VIOsPAPRDevice, rtce_window_size,
|
505 | 8d90ad90 | David Gibson | 0x10000000),
|
506 | 8d90ad90 | David Gibson | DEFINE_NIC_PROPERTIES(VIOsPAPRVLANDevice, nicconf), |
507 | 8d90ad90 | David Gibson | DEFINE_PROP_END_OF_LIST(), |
508 | 8d90ad90 | David Gibson | }, |
509 | 8d90ad90 | David Gibson | }; |
510 | 8d90ad90 | David Gibson | |
511 | 8d90ad90 | David Gibson | static void spapr_vlan_register(void) |
512 | 8d90ad90 | David Gibson | { |
513 | 8d90ad90 | David Gibson | spapr_vio_bus_register_withprop(&spapr_vlan); |
514 | 8d90ad90 | David Gibson | } |
515 | 8d90ad90 | David Gibson | device_init(spapr_vlan_register); |