mirror of
https://source.denx.de/u-boot/u-boot.git
synced 2025-08-10 17:26:59 +02:00
d678a59d2d
When bringing in the series 'arm: dts: am62-beagleplay: Fix Beagleplay Ethernet"' I failed to notice that b4 noticed it was based on next and so took that as the base commit and merged that part of next to master. This reverts commitc8ffd1356d, reversing changes made to2ee6f3a5f7. Reported-by: Jonas Karlman <jonas@kwiboo.se> Signed-off-by: Tom Rini <trini@konsulko.com>
207 lines
5.7 KiB
C
207 lines
5.7 KiB
C
// SPDX-License-Identifier: GPL-2.0
|
|
/*
|
|
* Copyright (c) 2022 Linaro
|
|
*
|
|
* (C) Copyright 2022
|
|
* Ying-Chun Liu (PaulLiu) <paul.liu@linaro.org>
|
|
*/
|
|
|
|
#include <common.h>
|
|
#include <command.h>
|
|
#include <dm.h>
|
|
#include <env.h>
|
|
#include <fdtdec.h>
|
|
#include <log.h>
|
|
#include <malloc.h>
|
|
#include <net.h>
|
|
#include <net/tcp.h>
|
|
#include <net/wget.h>
|
|
#include <asm/eth.h>
|
|
#include <dm/test.h>
|
|
#include <dm/device-internal.h>
|
|
#include <dm/uclass-internal.h>
|
|
#include <test/lib.h>
|
|
#include <test/test.h>
|
|
#include <test/ut.h>
|
|
|
|
#define SHIFT_TO_TCPHDRLEN_FIELD(x) ((x) << 4)
|
|
#define LEN_B_TO_DW(x) ((x) >> 2)
|
|
|
|
static int sb_arp_handler(struct udevice *dev, void *packet,
|
|
unsigned int len)
|
|
{
|
|
struct eth_sandbox_priv *priv = dev_get_priv(dev);
|
|
struct arp_hdr *arp = packet + ETHER_HDR_SIZE;
|
|
int ret = 0;
|
|
|
|
if (ntohs(arp->ar_op) == ARPOP_REQUEST) {
|
|
priv->fake_host_ipaddr = net_read_ip(&arp->ar_spa);
|
|
|
|
ret = sandbox_eth_recv_arp_req(dev);
|
|
if (ret)
|
|
return ret;
|
|
ret = sandbox_eth_arp_req_to_reply(dev, packet, len);
|
|
return ret;
|
|
}
|
|
|
|
return -EPROTONOSUPPORT;
|
|
}
|
|
|
|
static int sb_syn_handler(struct udevice *dev, void *packet,
|
|
unsigned int len)
|
|
{
|
|
struct eth_sandbox_priv *priv = dev_get_priv(dev);
|
|
struct ethernet_hdr *eth = packet;
|
|
struct ip_tcp_hdr *tcp = packet + ETHER_HDR_SIZE;
|
|
struct ethernet_hdr *eth_send;
|
|
struct ip_tcp_hdr *tcp_send;
|
|
|
|
/* Don't allow the buffer to overrun */
|
|
if (priv->recv_packets >= PKTBUFSRX)
|
|
return 0;
|
|
|
|
eth_send = (void *)priv->recv_packet_buffer[priv->recv_packets];
|
|
memcpy(eth_send->et_dest, eth->et_src, ARP_HLEN);
|
|
memcpy(eth_send->et_src, priv->fake_host_hwaddr, ARP_HLEN);
|
|
eth_send->et_protlen = htons(PROT_IP);
|
|
tcp_send = (void *)eth_send + ETHER_HDR_SIZE;
|
|
tcp_send->tcp_src = tcp->tcp_dst;
|
|
tcp_send->tcp_dst = tcp->tcp_src;
|
|
tcp_send->tcp_seq = htonl(0);
|
|
tcp_send->tcp_ack = htonl(ntohl(tcp->tcp_seq) + 1);
|
|
tcp_send->tcp_hlen = SHIFT_TO_TCPHDRLEN_FIELD(LEN_B_TO_DW(TCP_HDR_SIZE));
|
|
tcp_send->tcp_flags = TCP_SYN | TCP_ACK;
|
|
tcp_send->tcp_win = htons(PKTBUFSRX * TCP_MSS >> TCP_SCALE);
|
|
tcp_send->tcp_xsum = 0;
|
|
tcp_send->tcp_ugr = 0;
|
|
tcp_send->tcp_xsum = tcp_set_pseudo_header((uchar *)tcp_send,
|
|
tcp->ip_src,
|
|
tcp->ip_dst,
|
|
TCP_HDR_SIZE,
|
|
IP_TCP_HDR_SIZE);
|
|
net_set_ip_header((uchar *)tcp_send,
|
|
tcp->ip_src,
|
|
tcp->ip_dst,
|
|
IP_TCP_HDR_SIZE,
|
|
IPPROTO_TCP);
|
|
|
|
priv->recv_packet_length[priv->recv_packets] =
|
|
ETHER_HDR_SIZE + IP_TCP_HDR_SIZE;
|
|
++priv->recv_packets;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int sb_ack_handler(struct udevice *dev, void *packet,
|
|
unsigned int len)
|
|
{
|
|
struct eth_sandbox_priv *priv = dev_get_priv(dev);
|
|
struct ethernet_hdr *eth = packet;
|
|
struct ip_tcp_hdr *tcp = packet + ETHER_HDR_SIZE;
|
|
struct ethernet_hdr *eth_send;
|
|
struct ip_tcp_hdr *tcp_send;
|
|
void *data;
|
|
int pkt_len;
|
|
int payload_len = 0;
|
|
const char *payload1 = "HTTP/1.1 200 OK\r\n"
|
|
"Content-Length: 30\r\n\r\n\r\n"
|
|
"<html><body>Hi</body></html>\r\n";
|
|
|
|
/* Don't allow the buffer to overrun */
|
|
if (priv->recv_packets >= PKTBUFSRX)
|
|
return 0;
|
|
|
|
eth_send = (void *)priv->recv_packet_buffer[priv->recv_packets];
|
|
memcpy(eth_send->et_dest, eth->et_src, ARP_HLEN);
|
|
memcpy(eth_send->et_src, priv->fake_host_hwaddr, ARP_HLEN);
|
|
eth_send->et_protlen = htons(PROT_IP);
|
|
tcp_send = (void *)eth_send + ETHER_HDR_SIZE;
|
|
tcp_send->tcp_src = tcp->tcp_dst;
|
|
tcp_send->tcp_dst = tcp->tcp_src;
|
|
data = (void *)tcp_send + IP_TCP_HDR_SIZE;
|
|
|
|
if (ntohl(tcp->tcp_seq) == 1 && ntohl(tcp->tcp_ack) == 1) {
|
|
tcp_send->tcp_seq = htonl(ntohl(tcp->tcp_ack));
|
|
tcp_send->tcp_ack = htonl(ntohl(tcp->tcp_seq) + 1);
|
|
payload_len = strlen(payload1);
|
|
memcpy(data, payload1, payload_len);
|
|
tcp_send->tcp_flags = TCP_ACK;
|
|
} else if (ntohl(tcp->tcp_seq) == 2) {
|
|
tcp_send->tcp_seq = htonl(ntohl(tcp->tcp_ack));
|
|
tcp_send->tcp_ack = htonl(ntohl(tcp->tcp_seq) + 1);
|
|
payload_len = 0;
|
|
tcp_send->tcp_flags = TCP_ACK | TCP_FIN;
|
|
}
|
|
|
|
tcp_send->tcp_hlen = SHIFT_TO_TCPHDRLEN_FIELD(LEN_B_TO_DW(TCP_HDR_SIZE));
|
|
tcp_send->tcp_win = htons(PKTBUFSRX * TCP_MSS >> TCP_SCALE);
|
|
tcp_send->tcp_xsum = 0;
|
|
tcp_send->tcp_ugr = 0;
|
|
pkt_len = IP_TCP_HDR_SIZE + payload_len;
|
|
tcp_send->tcp_xsum = tcp_set_pseudo_header((uchar *)tcp_send,
|
|
tcp->ip_src,
|
|
tcp->ip_dst,
|
|
pkt_len - IP_HDR_SIZE,
|
|
pkt_len);
|
|
net_set_ip_header((uchar *)tcp_send,
|
|
tcp->ip_src,
|
|
tcp->ip_dst,
|
|
pkt_len,
|
|
IPPROTO_TCP);
|
|
|
|
if (ntohl(tcp->tcp_seq) == 1 || ntohl(tcp->tcp_seq) == 2) {
|
|
priv->recv_packet_length[priv->recv_packets] =
|
|
ETHER_HDR_SIZE + IP_TCP_HDR_SIZE + payload_len;
|
|
++priv->recv_packets;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int sb_http_handler(struct udevice *dev, void *packet,
|
|
unsigned int len)
|
|
{
|
|
struct ethernet_hdr *eth = packet;
|
|
struct ip_hdr *ip;
|
|
struct ip_tcp_hdr *tcp;
|
|
|
|
if (ntohs(eth->et_protlen) == PROT_ARP) {
|
|
return sb_arp_handler(dev, packet, len);
|
|
} else if (ntohs(eth->et_protlen) == PROT_IP) {
|
|
ip = packet + ETHER_HDR_SIZE;
|
|
if (ip->ip_p == IPPROTO_TCP) {
|
|
tcp = packet + ETHER_HDR_SIZE;
|
|
if (tcp->tcp_flags == TCP_SYN)
|
|
return sb_syn_handler(dev, packet, len);
|
|
else if (tcp->tcp_flags & TCP_ACK && !(tcp->tcp_flags & TCP_SYN))
|
|
return sb_ack_handler(dev, packet, len);
|
|
return 0;
|
|
}
|
|
return -EPROTONOSUPPORT;
|
|
}
|
|
|
|
return -EPROTONOSUPPORT;
|
|
}
|
|
|
|
static int net_test_wget(struct unit_test_state *uts)
|
|
{
|
|
sandbox_eth_set_tx_handler(0, sb_http_handler);
|
|
sandbox_eth_set_priv(0, uts);
|
|
|
|
env_set("ethact", "eth@10002000");
|
|
env_set("ethrotate", "no");
|
|
env_set("loadaddr", "0x20000");
|
|
ut_assertok(run_command("wget ${loadaddr} 1.1.2.2:/index.html", 0));
|
|
|
|
sandbox_eth_set_tx_handler(0, NULL);
|
|
|
|
ut_assertok(console_record_reset_enable());
|
|
run_command("md5sum ${loadaddr} ${filesize}", 0);
|
|
ut_assert_nextline("md5 for 00020000 ... 0002001f ==> 234af48e94b0085060249ecb5942ab57");
|
|
ut_assertok(ut_check_console_end(uts));
|
|
|
|
return 0;
|
|
}
|
|
|
|
LIB_TEST(net_test_wget, 0);
|