1 // SPDX-License-Identifier: GPL-2.0
3 * Copyright (c) 2015 National Instruments
6 * Joe Hershberger <joe.hershberger@ni.com>
9 #include <asm/eth-raw-os.h>
16 DECLARE_GLOBAL_DATA_PTR;
19 static struct in_addr arp_ip;
21 static int sb_eth_raw_start(struct udevice *dev)
23 struct eth_sandbox_raw_priv *priv = dev_get_priv(dev);
24 struct eth_pdata *pdata = dev_get_platdata(dev);
27 debug("eth_sandbox_raw: Start\n");
29 ret = sandbox_eth_raw_os_start(priv, pdata->enetaddr);
31 env_set("ipaddr", "127.0.0.1");
32 env_set("serverip", "127.0.0.1");
33 net_ip = string_to_ip("127.0.0.1");
34 net_server_ip = net_ip;
39 static int sb_eth_raw_send(struct udevice *dev, void *packet, int length)
41 struct eth_sandbox_raw_priv *priv = dev_get_priv(dev);
43 debug("eth_sandbox_raw: Send packet %d\n", length);
46 struct ethernet_hdr *eth = packet;
48 if (ntohs(eth->et_protlen) == PROT_ARP) {
49 struct arp_hdr *arp = packet + ETHER_HDR_SIZE;
52 * localhost works on a higher-level API in Linux than
53 * ARP packets, so fake it
55 arp_ip = net_read_ip(&arp->ar_tpa);
59 packet += ETHER_HDR_SIZE;
60 length -= ETHER_HDR_SIZE;
62 return sandbox_eth_raw_os_send(packet, length, priv);
65 static int sb_eth_raw_recv(struct udevice *dev, int flags, uchar **packetp)
67 struct eth_pdata *pdata = dev_get_platdata(dev);
68 struct eth_sandbox_raw_priv *priv = dev_get_priv(dev);
73 struct arp_hdr *arp = (void *)net_rx_packets[0] +
77 * Fake an ARP response. The u-boot network stack is sending an
78 * ARP request (to find the MAC address to address the actual
79 * packet to) and requires an ARP response to continue. Since
80 * this is the localhost interface, there is no Etherent level
81 * traffic at all, so there is no way to send an ARP request or
82 * to get a response. For this reason we fake the response to
83 * make the u-boot network stack happy.
85 arp->ar_hrd = htons(ARP_ETHER);
86 arp->ar_pro = htons(PROT_IP);
87 arp->ar_hln = ARP_HLEN;
88 arp->ar_pln = ARP_PLEN;
89 arp->ar_op = htons(ARPOP_REPLY);
90 /* Any non-zero MAC address will work */
91 memset(&arp->ar_sha, 0x01, ARP_HLEN);
92 /* Use whatever IP we were looking for (always 127.0.0.1?) */
93 net_write_ip(&arp->ar_spa, arp_ip);
94 memcpy(&arp->ar_tha, pdata->enetaddr, ARP_HLEN);
95 net_write_ip(&arp->ar_tpa, net_ip);
96 length = ARP_HDR_SIZE;
98 /* If local, the Ethernet header won't be included; skip it */
99 uchar *pktptr = priv->local ?
100 net_rx_packets[0] + ETHER_HDR_SIZE : net_rx_packets[0];
102 retval = sandbox_eth_raw_os_recv(pktptr, &length, priv);
105 if (!retval && length) {
107 struct ethernet_hdr *eth = (void *)net_rx_packets[0];
109 /* Fill in enough of the missing Ethernet header */
110 memcpy(eth->et_dest, pdata->enetaddr, ARP_HLEN);
111 memset(eth->et_src, 0x01, ARP_HLEN);
112 eth->et_protlen = htons(reply_arp ? PROT_ARP : PROT_IP);
114 length += ETHER_HDR_SIZE;
117 debug("eth_sandbox_raw: received packet %d\n",
119 *packetp = net_rx_packets[0];
125 static void sb_eth_raw_stop(struct udevice *dev)
127 struct eth_sandbox_raw_priv *priv = dev_get_priv(dev);
129 debug("eth_sandbox_raw: Stop\n");
131 sandbox_eth_raw_os_stop(priv);
134 static int sb_eth_raw_read_rom_hwaddr(struct udevice *dev)
136 struct eth_pdata *pdata = dev_get_platdata(dev);
138 net_random_ethaddr(pdata->enetaddr);
143 static const struct eth_ops sb_eth_raw_ops = {
144 .start = sb_eth_raw_start,
145 .send = sb_eth_raw_send,
146 .recv = sb_eth_raw_recv,
147 .stop = sb_eth_raw_stop,
148 .read_rom_hwaddr = sb_eth_raw_read_rom_hwaddr,
151 static int sb_eth_raw_ofdata_to_platdata(struct udevice *dev)
153 struct eth_pdata *pdata = dev_get_platdata(dev);
154 struct eth_sandbox_raw_priv *priv = dev_get_priv(dev);
158 pdata->iobase = dev_read_addr(dev);
160 ifname = dev_read_string(dev, "host-raw-interface");
162 strncpy(priv->host_ifname, ifname, IFNAMSIZ);
163 printf(": Using %s from DT\n", priv->host_ifname);
165 if (dev_read_u32(dev, "host-raw-interface-idx",
166 &priv->host_ifindex) < 0) {
167 priv->host_ifindex = 0;
169 ret = sandbox_eth_raw_os_idx_to_name(priv);
172 printf(": Using interface index %d from DT (%s)\n",
173 priv->host_ifindex, priv->host_ifname);
176 ret = sandbox_eth_raw_os_is_local(priv->host_ifname);
184 static const struct udevice_id sb_eth_raw_ids[] = {
185 { .compatible = "sandbox,eth-raw" },
189 U_BOOT_DRIVER(eth_sandbox_raw) = {
190 .name = "eth_sandbox_raw",
192 .of_match = sb_eth_raw_ids,
193 .ofdata_to_platdata = sb_eth_raw_ofdata_to_platdata,
194 .ops = &sb_eth_raw_ops,
195 .priv_auto_alloc_size = sizeof(struct eth_sandbox_raw_priv),
196 .platdata_auto_alloc_size = sizeof(struct eth_pdata),