183d290c5STom Rini // SPDX-License-Identifier: GPL-2.0
2a346ca79SJoe Hershberger /*
3a346ca79SJoe Hershberger * Copyright (c) 2015 National Instruments
4a346ca79SJoe Hershberger *
5a346ca79SJoe Hershberger * (C) Copyright 2015
6a346ca79SJoe Hershberger * Joe Hershberger <joe.hershberger@ni.com>
7a346ca79SJoe Hershberger */
8a346ca79SJoe Hershberger
9a346ca79SJoe Hershberger #include <asm/eth-raw-os.h>
10a346ca79SJoe Hershberger #include <common.h>
11a346ca79SJoe Hershberger #include <dm.h>
12a346ca79SJoe Hershberger #include <malloc.h>
13a346ca79SJoe Hershberger #include <net.h>
14a346ca79SJoe Hershberger
15a346ca79SJoe Hershberger DECLARE_GLOBAL_DATA_PTR;
16a346ca79SJoe Hershberger
1722f68524SJoe Hershberger static int reply_arp;
18049a95a7SJoe Hershberger static struct in_addr arp_ip;
19a346ca79SJoe Hershberger
sb_eth_raw_start(struct udevice * dev)20a346ca79SJoe Hershberger static int sb_eth_raw_start(struct udevice *dev)
21a346ca79SJoe Hershberger {
22a346ca79SJoe Hershberger struct eth_sandbox_raw_priv *priv = dev_get_priv(dev);
23a346ca79SJoe Hershberger struct eth_pdata *pdata = dev_get_platdata(dev);
248c7988b6SJoe Hershberger int ret;
25a346ca79SJoe Hershberger
26a346ca79SJoe Hershberger debug("eth_sandbox_raw: Start\n");
27a346ca79SJoe Hershberger
288c7988b6SJoe Hershberger ret = sandbox_eth_raw_os_start(priv, pdata->enetaddr);
298c7988b6SJoe Hershberger if (priv->local) {
30382bee57SSimon Glass env_set("ipaddr", "127.0.0.1");
31382bee57SSimon Glass env_set("serverip", "127.0.0.1");
32ac13270bSJoe Hershberger net_ip = string_to_ip("127.0.0.1");
33ac13270bSJoe Hershberger net_server_ip = net_ip;
3422f68524SJoe Hershberger }
358c7988b6SJoe Hershberger return ret;
36a346ca79SJoe Hershberger }
37a346ca79SJoe Hershberger
sb_eth_raw_send(struct udevice * dev,void * packet,int length)38a346ca79SJoe Hershberger static int sb_eth_raw_send(struct udevice *dev, void *packet, int length)
39a346ca79SJoe Hershberger {
40a346ca79SJoe Hershberger struct eth_sandbox_raw_priv *priv = dev_get_priv(dev);
41a346ca79SJoe Hershberger
42a346ca79SJoe Hershberger debug("eth_sandbox_raw: Send packet %d\n", length);
43a346ca79SJoe Hershberger
4422f68524SJoe Hershberger if (priv->local) {
4522f68524SJoe Hershberger struct ethernet_hdr *eth = packet;
4622f68524SJoe Hershberger
4722f68524SJoe Hershberger if (ntohs(eth->et_protlen) == PROT_ARP) {
4822f68524SJoe Hershberger struct arp_hdr *arp = packet + ETHER_HDR_SIZE;
4922f68524SJoe Hershberger
5022f68524SJoe Hershberger /**
5122f68524SJoe Hershberger * localhost works on a higher-level API in Linux than
5222f68524SJoe Hershberger * ARP packets, so fake it
5322f68524SJoe Hershberger */
54049a95a7SJoe Hershberger arp_ip = net_read_ip(&arp->ar_tpa);
5522f68524SJoe Hershberger reply_arp = 1;
5622f68524SJoe Hershberger return 0;
5722f68524SJoe Hershberger }
5822f68524SJoe Hershberger packet += ETHER_HDR_SIZE;
5922f68524SJoe Hershberger length -= ETHER_HDR_SIZE;
6022f68524SJoe Hershberger }
61a346ca79SJoe Hershberger return sandbox_eth_raw_os_send(packet, length, priv);
62a346ca79SJoe Hershberger }
63a346ca79SJoe Hershberger
sb_eth_raw_recv(struct udevice * dev,int flags,uchar ** packetp)64a1ca92eaSSimon Glass static int sb_eth_raw_recv(struct udevice *dev, int flags, uchar **packetp)
65a346ca79SJoe Hershberger {
6622f68524SJoe Hershberger struct eth_pdata *pdata = dev_get_platdata(dev);
67a346ca79SJoe Hershberger struct eth_sandbox_raw_priv *priv = dev_get_priv(dev);
6822f68524SJoe Hershberger int retval = 0;
69a346ca79SJoe Hershberger int length;
70a346ca79SJoe Hershberger
7122f68524SJoe Hershberger if (reply_arp) {
7222f68524SJoe Hershberger struct arp_hdr *arp = (void *)net_rx_packets[0] +
7322f68524SJoe Hershberger ETHER_HDR_SIZE;
7422f68524SJoe Hershberger
7522f68524SJoe Hershberger /*
7622f68524SJoe Hershberger * Fake an ARP response. The u-boot network stack is sending an
7722f68524SJoe Hershberger * ARP request (to find the MAC address to address the actual
7822f68524SJoe Hershberger * packet to) and requires an ARP response to continue. Since
7922f68524SJoe Hershberger * this is the localhost interface, there is no Etherent level
8022f68524SJoe Hershberger * traffic at all, so there is no way to send an ARP request or
8122f68524SJoe Hershberger * to get a response. For this reason we fake the response to
8222f68524SJoe Hershberger * make the u-boot network stack happy.
8322f68524SJoe Hershberger */
8422f68524SJoe Hershberger arp->ar_hrd = htons(ARP_ETHER);
8522f68524SJoe Hershberger arp->ar_pro = htons(PROT_IP);
8622f68524SJoe Hershberger arp->ar_hln = ARP_HLEN;
8722f68524SJoe Hershberger arp->ar_pln = ARP_PLEN;
8822f68524SJoe Hershberger arp->ar_op = htons(ARPOP_REPLY);
8922f68524SJoe Hershberger /* Any non-zero MAC address will work */
9022f68524SJoe Hershberger memset(&arp->ar_sha, 0x01, ARP_HLEN);
9122f68524SJoe Hershberger /* Use whatever IP we were looking for (always 127.0.0.1?) */
92049a95a7SJoe Hershberger net_write_ip(&arp->ar_spa, arp_ip);
9322f68524SJoe Hershberger memcpy(&arp->ar_tha, pdata->enetaddr, ARP_HLEN);
94049a95a7SJoe Hershberger net_write_ip(&arp->ar_tpa, net_ip);
9522f68524SJoe Hershberger length = ARP_HDR_SIZE;
9622f68524SJoe Hershberger } else {
9722f68524SJoe Hershberger /* If local, the Ethernet header won't be included; skip it */
9822f68524SJoe Hershberger uchar *pktptr = priv->local ?
9922f68524SJoe Hershberger net_rx_packets[0] + ETHER_HDR_SIZE : net_rx_packets[0];
10022f68524SJoe Hershberger
10122f68524SJoe Hershberger retval = sandbox_eth_raw_os_recv(pktptr, &length, priv);
10222f68524SJoe Hershberger }
103a346ca79SJoe Hershberger
104a346ca79SJoe Hershberger if (!retval && length) {
10522f68524SJoe Hershberger if (priv->local) {
10622f68524SJoe Hershberger struct ethernet_hdr *eth = (void *)net_rx_packets[0];
10722f68524SJoe Hershberger
10822f68524SJoe Hershberger /* Fill in enough of the missing Ethernet header */
10922f68524SJoe Hershberger memcpy(eth->et_dest, pdata->enetaddr, ARP_HLEN);
11022f68524SJoe Hershberger memset(eth->et_src, 0x01, ARP_HLEN);
11122f68524SJoe Hershberger eth->et_protlen = htons(reply_arp ? PROT_ARP : PROT_IP);
11222f68524SJoe Hershberger reply_arp = 0;
11322f68524SJoe Hershberger length += ETHER_HDR_SIZE;
11422f68524SJoe Hershberger }
11522f68524SJoe Hershberger
116a346ca79SJoe Hershberger debug("eth_sandbox_raw: received packet %d\n",
117a346ca79SJoe Hershberger length);
118a346ca79SJoe Hershberger *packetp = net_rx_packets[0];
119a346ca79SJoe Hershberger return length;
120a346ca79SJoe Hershberger }
121a346ca79SJoe Hershberger return retval;
122a346ca79SJoe Hershberger }
123a346ca79SJoe Hershberger
sb_eth_raw_stop(struct udevice * dev)124a346ca79SJoe Hershberger static void sb_eth_raw_stop(struct udevice *dev)
125a346ca79SJoe Hershberger {
126a346ca79SJoe Hershberger struct eth_sandbox_raw_priv *priv = dev_get_priv(dev);
127a346ca79SJoe Hershberger
128a346ca79SJoe Hershberger debug("eth_sandbox_raw: Stop\n");
129a346ca79SJoe Hershberger
130a346ca79SJoe Hershberger sandbox_eth_raw_os_stop(priv);
131a346ca79SJoe Hershberger }
132a346ca79SJoe Hershberger
sb_eth_raw_read_rom_hwaddr(struct udevice * dev)133b96ced9cSJoe Hershberger static int sb_eth_raw_read_rom_hwaddr(struct udevice *dev)
134b96ced9cSJoe Hershberger {
135b96ced9cSJoe Hershberger struct eth_pdata *pdata = dev_get_platdata(dev);
136b96ced9cSJoe Hershberger
137b96ced9cSJoe Hershberger net_random_ethaddr(pdata->enetaddr);
138b96ced9cSJoe Hershberger
139b96ced9cSJoe Hershberger return 0;
140b96ced9cSJoe Hershberger }
141b96ced9cSJoe Hershberger
142a346ca79SJoe Hershberger static const struct eth_ops sb_eth_raw_ops = {
143a346ca79SJoe Hershberger .start = sb_eth_raw_start,
144a346ca79SJoe Hershberger .send = sb_eth_raw_send,
145a346ca79SJoe Hershberger .recv = sb_eth_raw_recv,
146a346ca79SJoe Hershberger .stop = sb_eth_raw_stop,
147b96ced9cSJoe Hershberger .read_rom_hwaddr = sb_eth_raw_read_rom_hwaddr,
148a346ca79SJoe Hershberger };
149a346ca79SJoe Hershberger
sb_eth_raw_ofdata_to_platdata(struct udevice * dev)150a346ca79SJoe Hershberger static int sb_eth_raw_ofdata_to_platdata(struct udevice *dev)
151a346ca79SJoe Hershberger {
152a346ca79SJoe Hershberger struct eth_pdata *pdata = dev_get_platdata(dev);
1538c7988b6SJoe Hershberger struct eth_sandbox_raw_priv *priv = dev_get_priv(dev);
1548c7988b6SJoe Hershberger const char *ifname;
155c9e2caffSJoe Hershberger int ret;
156a346ca79SJoe Hershberger
1578c7988b6SJoe Hershberger pdata->iobase = dev_read_addr(dev);
1588c7988b6SJoe Hershberger
1598c7988b6SJoe Hershberger ifname = dev_read_string(dev, "host-raw-interface");
1608c7988b6SJoe Hershberger if (ifname) {
1618c7988b6SJoe Hershberger strncpy(priv->host_ifname, ifname, IFNAMSIZ);
1628c7988b6SJoe Hershberger printf(": Using %s from DT\n", priv->host_ifname);
1638c7988b6SJoe Hershberger }
164c9e2caffSJoe Hershberger if (dev_read_u32(dev, "host-raw-interface-idx",
165c9e2caffSJoe Hershberger &priv->host_ifindex) < 0) {
166c9e2caffSJoe Hershberger priv->host_ifindex = 0;
167c9e2caffSJoe Hershberger } else {
168c9e2caffSJoe Hershberger ret = sandbox_eth_raw_os_idx_to_name(priv);
169c9e2caffSJoe Hershberger if (ret < 0)
170c9e2caffSJoe Hershberger return ret;
171c9e2caffSJoe Hershberger printf(": Using interface index %d from DT (%s)\n",
172c9e2caffSJoe Hershberger priv->host_ifindex, priv->host_ifname);
173c9e2caffSJoe Hershberger }
1748c7988b6SJoe Hershberger
175*8405452eSSimon Glass ret = sandbox_eth_raw_os_is_local(priv->host_ifname);
176*8405452eSSimon Glass if (ret < 0)
177*8405452eSSimon Glass return ret;
178*8405452eSSimon Glass priv->local = ret;
179ac13270bSJoe Hershberger
180a346ca79SJoe Hershberger return 0;
181a346ca79SJoe Hershberger }
182a346ca79SJoe Hershberger
183a346ca79SJoe Hershberger static const struct udevice_id sb_eth_raw_ids[] = {
184a346ca79SJoe Hershberger { .compatible = "sandbox,eth-raw" },
185a346ca79SJoe Hershberger { }
186a346ca79SJoe Hershberger };
187a346ca79SJoe Hershberger
188a346ca79SJoe Hershberger U_BOOT_DRIVER(eth_sandbox_raw) = {
189a346ca79SJoe Hershberger .name = "eth_sandbox_raw",
190a346ca79SJoe Hershberger .id = UCLASS_ETH,
191a346ca79SJoe Hershberger .of_match = sb_eth_raw_ids,
192a346ca79SJoe Hershberger .ofdata_to_platdata = sb_eth_raw_ofdata_to_platdata,
193a346ca79SJoe Hershberger .ops = &sb_eth_raw_ops,
194a346ca79SJoe Hershberger .priv_auto_alloc_size = sizeof(struct eth_sandbox_raw_priv),
195a346ca79SJoe Hershberger .platdata_auto_alloc_size = sizeof(struct eth_pdata),
196a346ca79SJoe Hershberger };
197