uboot-phytec
Public
Source
committed 83d290c56fax
// SPDX-License-Identifier: GPL-2.0/* * Copyright (c) 2015 National Instruments * * (C) Copyright 2015 * Joe Hershberger <joe.hershberger@ni.com> */DECLARE_GLOBAL_DATA_PTR;/** * struct eth_sandbox_priv - memory for sandbox mock driver * * fake_host_hwaddr: MAC address of mocked machine * fake_host_ipaddr: IP address of mocked machine * recv_packet_buffer: buffer of the packet returned as received * recv_packet_length: length of the packet returned as received */struct eth_sandbox_priv { uchar fake_host_hwaddr[ARP_HLEN]; struct in_addr fake_host_ipaddr; uchar *recv_packet_buffer; int recv_packet_length;};static bool disabled[8] = {false};static bool skip_timeout;/* * sandbox_eth_disable_response() * * index - The alias index (also DM seq number) * disable - If non-zero, ignore sent packets and don't send mock response */void sandbox_eth_disable_response(int index, bool disable){ disabled[index] = disable;}/* * sandbox_eth_skip_timeout() * * When the first packet read is attempted, fast-forward time */void sandbox_eth_skip_timeout(void){ skip_timeout = true;}static int sb_eth_start(struct udevice *dev){ struct eth_sandbox_priv *priv = dev_get_priv(dev); debug("eth_sandbox: Start\n"); fdtdec_get_byte_array(gd->fdt_blob, dev_of_offset(dev), "fake-host-hwaddr", priv->fake_host_hwaddr, ARP_HLEN); priv->recv_packet_buffer = net_rx_packets[0]; return 0;}static int sb_eth_send(struct udevice *dev, void *packet, int length){ struct eth_sandbox_priv *priv = dev_get_priv(dev); struct ethernet_hdr *eth = packet; debug("eth_sandbox: Send packet %d\n", length); if (dev->seq >= 0 && dev->seq < ARRAY_SIZE(disabled) && disabled[dev->seq]) return 0; if (ntohs(eth->et_protlen) == PROT_ARP) { struct arp_hdr *arp = packet + ETHER_HDR_SIZE; if (ntohs(arp->ar_op) == ARPOP_REQUEST) { struct ethernet_hdr *eth_recv; struct arp_hdr *arp_recv; /* store this as the assumed IP of the fake host */ priv->fake_host_ipaddr = net_read_ip(&arp->ar_tpa); /* Formulate a fake response */ eth_recv = (void *)priv->recv_packet_buffer; memcpy(eth_recv->et_dest, eth->et_src, ARP_HLEN); memcpy(eth_recv->et_src, priv->fake_host_hwaddr,