[J-u-boot.git] / drivers / net / sandbox-raw.c

// SPDX-License-Identifier: GPL-2.0
/*
 * Copyright (c) 2015 National Instruments
 *
 * (C) Copyright 2015
 * Joe Hershberger <[email protected]>
 */

#include <log.h>
#include <asm/eth-raw-os.h>
#include <common.h>
#include <dm.h>
#include <env.h>
#include <malloc.h>
#include <net.h>
#include <asm/global_data.h>

DECLARE_GLOBAL_DATA_PTR;

static int reply_arp;
static struct in_addr arp_ip;

static int sb_eth_raw_start(struct udevice *dev)
{
	struct eth_sandbox_raw_priv *priv = dev_get_priv(dev);
	struct eth_pdata *pdata = dev_get_plat(dev);
	int ret;

	debug("eth_sandbox_raw: Start\n");

	ret = sandbox_eth_raw_os_start(priv, pdata->enetaddr);
	if (priv->local) {
		env_set("ipaddr", "127.0.0.1");
		env_set("serverip", "127.0.0.1");
		net_ip = string_to_ip("127.0.0.1");
		net_server_ip = net_ip;
	}
	return ret;
}

static int sb_eth_raw_send(struct udevice *dev, void *packet, int length)
{
	struct eth_sandbox_raw_priv *priv = dev_get_priv(dev);

	debug("eth_sandbox_raw: Send packet %d\n", length);

	if (priv->local) {
		struct ethernet_hdr *eth = packet;

		if (ntohs(eth->et_protlen) == PROT_ARP) {
			struct arp_hdr *arp = packet + ETHER_HDR_SIZE;

			/**
			 * localhost works on a higher-level API in Linux than
			 * ARP packets, so fake it
			 */
			arp_ip = net_read_ip(&arp->ar_tpa);
			reply_arp = 1;
			return 0;
		}
		packet += ETHER_HDR_SIZE;
		length -= ETHER_HDR_SIZE;
	}
	return sandbox_eth_raw_os_send(packet, length, priv);
}

static int sb_eth_raw_recv(struct udevice *dev, int flags, uchar **packetp)
{
	struct eth_pdata *pdata = dev_get_plat(dev);
	struct eth_sandbox_raw_priv *priv = dev_get_priv(dev);
	int retval = 0;
	int length;

	if (reply_arp) {
		struct arp_hdr *arp = (void *)net_rx_packets[0] +
			ETHER_HDR_SIZE;

		/*
		 * Fake an ARP response. The u-boot network stack is sending an
		 * ARP request (to find the MAC address to address the actual
		 * packet to) and requires an ARP response to continue. Since
		 * this is the localhost interface, there is no Etherent level
		 * traffic at all, so there is no way to send an ARP request or
		 * to get a response. For this reason we fake the response to
		 * make the u-boot network stack happy.
		 */
		arp->ar_hrd = htons(ARP_ETHER);
		arp->ar_pro = htons(PROT_IP);
		arp->ar_hln = ARP_HLEN;
		arp->ar_pln = ARP_PLEN;
		arp->ar_op = htons(ARPOP_REPLY);
		/* Any non-zero MAC address will work */
		memset(&arp->ar_sha, 0x01, ARP_HLEN);
		/* Use whatever IP we were looking for (always 127.0.0.1?) */
		net_write_ip(&arp->ar_spa, arp_ip);
		memcpy(&arp->ar_tha, pdata->enetaddr, ARP_HLEN);
		net_write_ip(&arp->ar_tpa, net_ip);
		length = ARP_HDR_SIZE;
	} else {
		/* If local, the Ethernet header won't be included; skip it */
		uchar *pktptr = priv->local ?
			net_rx_packets[0] + ETHER_HDR_SIZE : net_rx_packets[0];

		retval = sandbox_eth_raw_os_recv(pktptr, &length, priv);
	}

	if (!retval && length) {
		if (priv->local) {
			struct ethernet_hdr *eth = (void *)net_rx_packets[0];

			/* Fill in enough of the missing Ethernet header */
			memcpy(eth->et_dest, pdata->enetaddr, ARP_HLEN);
			memset(eth->et_src, 0x01, ARP_HLEN);
			eth->et_protlen = htons(reply_arp ? PROT_ARP : PROT_IP);
			reply_arp = 0;
			length += ETHER_HDR_SIZE;
		}

		debug("eth_sandbox_raw: received packet %d\n",
		      length);
		*packetp = net_rx_packets[0];
		return length;
	}
	return retval;
}

static void sb_eth_raw_stop(struct udevice *dev)
{
	struct eth_sandbox_raw_priv *priv = dev_get_priv(dev);

	debug("eth_sandbox_raw: Stop\n");

	sandbox_eth_raw_os_stop(priv);
}

static int sb_eth_raw_read_rom_hwaddr(struct udevice *dev)
{
	struct eth_pdata *pdata = dev_get_plat(dev);

	net_random_ethaddr(pdata->enetaddr);

	return 0;
}

static const struct eth_ops sb_eth_raw_ops = {
	.start			= sb_eth_raw_start,
	.send			= sb_eth_raw_send,
	.recv			= sb_eth_raw_recv,
	.stop			= sb_eth_raw_stop,
	.read_rom_hwaddr	= sb_eth_raw_read_rom_hwaddr,
};

static int sb_eth_raw_of_to_plat(struct udevice *dev)
{
	struct eth_pdata *pdata = dev_get_plat(dev);
	struct eth_sandbox_raw_priv *priv = dev_get_priv(dev);
	const char *ifname;
	int ret;

	pdata->iobase = dev_read_addr(dev);

	ifname = dev_read_string(dev, "host-raw-interface");
	if (ifname) {
		strncpy(priv->host_ifname, ifname, IFNAMSIZ);
		printf(": Using %s from DT\n", priv->host_ifname);
	}
	if (dev_read_u32(dev, "host-raw-interface-idx",
			 &priv->host_ifindex) < 0) {
		priv->host_ifindex = 0;
	} else {
		ret = sandbox_eth_raw_os_idx_to_name(priv);
		if (ret < 0)
			return ret;
		printf(": Using interface index %d from DT (%s)\n",
		       priv->host_ifindex, priv->host_ifname);
	}

	ret = sandbox_eth_raw_os_is_local(priv->host_ifname);
	if (ret < 0)
		return ret;
	priv->local = ret;

	return 0;
}

static const struct udevice_id sb_eth_raw_ids[] = {
	{ .compatible = "sandbox,eth-raw" },
	{ }
};

U_BOOT_DRIVER(eth_sandbox_raw) = {
	.name	= "eth_sandbox_raw",
	.id	= UCLASS_ETH,
	.of_match = sb_eth_raw_ids,
	.of_to_plat = sb_eth_raw_of_to_plat,
	.ops	= &sb_eth_raw_ops,
	.priv_auto	= sizeof(struct eth_sandbox_raw_priv),
	.plat_auto	= sizeof(struct eth_pdata),
};
Commit	Line	Data
83d290c5	1	// SPDX-License-Identifier: GPL-2.0
a346ca79 JH	2	/*
	3	* Copyright (c) 2015 National Instruments
	4	*
	5	* (C) Copyright 2015
	6	* Joe Hershberger <[email protected]>
a346ca79 JH	7	*/
a346ca79 JH	8
f7ae49fc	9	#include <log.h>
a346ca79 JH	10	#include <asm/eth-raw-os.h>
	11	#include <common.h>
	12	#include <dm.h>
9fb625ce	13	#include <env.h>
a346ca79 JH	14	#include <malloc.h>
a346ca79 JH	15	#include <net.h>
401d1c4f	16	#include <asm/global_data.h>
a346ca79 JH	17
	18	DECLARE_GLOBAL_DATA_PTR;
	19
22f68524	20	static int reply_arp;
049a95a7	21	static struct in_addr arp_ip;
a346ca79 JH	22
	23	static int sb_eth_raw_start(struct udevice *dev)
	24	{
	25	struct eth_sandbox_raw_priv *priv = dev_get_priv(dev);
c69cda25	26	struct eth_pdata *pdata = dev_get_plat(dev);
8c7988b6	27	int ret;
a346ca79 JH	28
	29	debug("eth_sandbox_raw: Start\n");
	30
8c7988b6 JH	31	ret = sandbox_eth_raw_os_start(priv, pdata->enetaddr);
8c7988b6 JH	32	if (priv->local) {
382bee57 SG	33	env_set("ipaddr", "127.0.0.1");
382bee57 SG	34	env_set("serverip", "127.0.0.1");
ac13270b JH	35	net_ip = string_to_ip("127.0.0.1");
ac13270b JH	36	net_server_ip = net_ip;
22f68524	37	}
8c7988b6	38	return ret;
a346ca79 JH	39	}
	40
	41	static int sb_eth_raw_send(struct udevice dev, void packet, int length)
	42	{
	43	struct eth_sandbox_raw_priv *priv = dev_get_priv(dev);
	44
	45	debug("eth_sandbox_raw: Send packet %d\n", length);
	46
22f68524 JH	47	if (priv->local) {
	48	struct ethernet_hdr *eth = packet;
	49
	50	if (ntohs(eth->et_protlen) == PROT_ARP) {
	51	struct arp_hdr *arp = packet + ETHER_HDR_SIZE;
	52
	53	/**
	54	* localhost works on a higher-level API in Linux than
	55	* ARP packets, so fake it
	56	*/
049a95a7	57	arp_ip = net_read_ip(&arp->ar_tpa);
22f68524 JH	58	reply_arp = 1;
	59	return 0;
	60	}
	61	packet += ETHER_HDR_SIZE;
	62	length -= ETHER_HDR_SIZE;
	63	}
a346ca79 JH	64	return sandbox_eth_raw_os_send(packet, length, priv);
	65	}
	66
a1ca92ea	67	static int sb_eth_raw_recv(struct udevice dev, int flags, uchar *packetp)
a346ca79	68	{
c69cda25	69	struct eth_pdata *pdata = dev_get_plat(dev);
a346ca79	70	struct eth_sandbox_raw_priv *priv = dev_get_priv(dev);
22f68524	71	int retval = 0;
a346ca79 JH	72	int length;
a346ca79 JH	73
22f68524 JH	74	if (reply_arp) {
	75	struct arp_hdr arp = (void )net_rx_packets[0] +
	76	ETHER_HDR_SIZE;
	77
	78	/*
	79	* Fake an ARP response. The u-boot network stack is sending an
	80	* ARP request (to find the MAC address to address the actual
	81	* packet to) and requires an ARP response to continue. Since
	82	* this is the localhost interface, there is no Etherent level
	83	* traffic at all, so there is no way to send an ARP request or
	84	* to get a response. For this reason we fake the response to
	85	* make the u-boot network stack happy.
	86	*/
	87	arp->ar_hrd = htons(ARP_ETHER);
	88	arp->ar_pro = htons(PROT_IP);
	89	arp->ar_hln = ARP_HLEN;
	90	arp->ar_pln = ARP_PLEN;
	91	arp->ar_op = htons(ARPOP_REPLY);
	92	/* Any non-zero MAC address will work */
	93	memset(&arp->ar_sha, 0x01, ARP_HLEN);
	94	/* Use whatever IP we were looking for (always 127.0.0.1?) */
049a95a7	95	net_write_ip(&arp->ar_spa, arp_ip);
22f68524	96	memcpy(&arp->ar_tha, pdata->enetaddr, ARP_HLEN);
049a95a7	97	net_write_ip(&arp->ar_tpa, net_ip);
22f68524 JH	98	length = ARP_HDR_SIZE;
	99	} else {
	100	/* If local, the Ethernet header won't be included; skip it */
	101	uchar *pktptr = priv->local ?
	102	net_rx_packets[0] + ETHER_HDR_SIZE : net_rx_packets[0];
	103
	104	retval = sandbox_eth_raw_os_recv(pktptr, &length, priv);
	105	}
a346ca79 JH	106
a346ca79 JH	107	if (!retval && length) {
22f68524 JH	108	if (priv->local) {
	109	struct ethernet_hdr eth = (void )net_rx_packets[0];
	110
	111	/* Fill in enough of the missing Ethernet header */
	112	memcpy(eth->et_dest, pdata->enetaddr, ARP_HLEN);
	113	memset(eth->et_src, 0x01, ARP_HLEN);
	114	eth->et_protlen = htons(reply_arp ? PROT_ARP : PROT_IP);
	115	reply_arp = 0;
	116	length += ETHER_HDR_SIZE;
	117	}
	118
a346ca79 JH	119	debug("eth_sandbox_raw: received packet %d\n",
	120	length);
	121	*packetp = net_rx_packets[0];
	122	return length;
	123	}
	124	return retval;
	125	}
	126
	127	static void sb_eth_raw_stop(struct udevice *dev)
	128	{
	129	struct eth_sandbox_raw_priv *priv = dev_get_priv(dev);
	130
	131	debug("eth_sandbox_raw: Stop\n");
	132
	133	sandbox_eth_raw_os_stop(priv);
	134	}
	135
b96ced9c JH	136	static int sb_eth_raw_read_rom_hwaddr(struct udevice *dev)
b96ced9c JH	137	{
c69cda25	138	struct eth_pdata *pdata = dev_get_plat(dev);
b96ced9c JH	139
	140	net_random_ethaddr(pdata->enetaddr);
	141
	142	return 0;
	143	}
	144
a346ca79 JH	145	static const struct eth_ops sb_eth_raw_ops = {
	146	.start = sb_eth_raw_start,
	147	.send = sb_eth_raw_send,
	148	.recv = sb_eth_raw_recv,
	149	.stop = sb_eth_raw_stop,
b96ced9c	150	.read_rom_hwaddr = sb_eth_raw_read_rom_hwaddr,
a346ca79 JH	151	};
a346ca79 JH	152
d1998a9f	153	static int sb_eth_raw_of_to_plat(struct udevice *dev)
a346ca79	154	{
c69cda25	155	struct eth_pdata *pdata = dev_get_plat(dev);
8c7988b6 JH	156	struct eth_sandbox_raw_priv *priv = dev_get_priv(dev);
8c7988b6 JH	157	const char *ifname;
c9e2caff	158	int ret;
8c7988b6 JH	159
	160	pdata->iobase = dev_read_addr(dev);
	161
	162	ifname = dev_read_string(dev, "host-raw-interface");
	163	if (ifname) {
	164	strncpy(priv->host_ifname, ifname, IFNAMSIZ);
	165	printf(": Using %s from DT\n", priv->host_ifname);
8c7988b6	166	}
c9e2caff JH	167	if (dev_read_u32(dev, "host-raw-interface-idx",
	168	&priv->host_ifindex) < 0) {
	169	priv->host_ifindex = 0;
	170	} else {
	171	ret = sandbox_eth_raw_os_idx_to_name(priv);
	172	if (ret < 0)
	173	return ret;
	174	printf(": Using interface index %d from DT (%s)\n",
	175	priv->host_ifindex, priv->host_ifname);
	176	}
a346ca79	177
8405452e SG	178	ret = sandbox_eth_raw_os_is_local(priv->host_ifname);
	179	if (ret < 0)
	180	return ret;
	181	priv->local = ret;
ac13270b	182
a346ca79 JH	183	return 0;
	184	}
	185
	186	static const struct udevice_id sb_eth_raw_ids[] = {
	187	{ .compatible = "sandbox,eth-raw" },
	188	{ }
	189	};
	190
	191	U_BOOT_DRIVER(eth_sandbox_raw) = {
	192	.name = "eth_sandbox_raw",
	193	.id = UCLASS_ETH,
	194	.of_match = sb_eth_raw_ids,
d1998a9f	195	.of_to_plat = sb_eth_raw_of_to_plat,
a346ca79	196	.ops = &sb_eth_raw_ops,
41575d8e	197	.priv_auto = sizeof(struct eth_sandbox_raw_priv),
caa4daa2	198	.plat_auto = sizeof(struct eth_pdata),
a346ca79	199	};