Merge branch 'master' of git://git.denx.de/u-boot-net
This commit is contained in:
@@ -9,6 +9,7 @@
|
||||
#include <asm/io.h>
|
||||
#include <linux/errno.h>
|
||||
#include <asm/system.h>
|
||||
#include <fm_eth.h>
|
||||
#include <asm/armv8/mmu.h>
|
||||
#include <asm/io.h>
|
||||
#include <asm/arch/fsl_serdes.h>
|
||||
@@ -18,7 +19,6 @@
|
||||
#include <fsl_immap.h>
|
||||
#include <asm/arch/mp.h>
|
||||
#include <efi_loader.h>
|
||||
#include <fm_eth.h>
|
||||
#include <fsl-mc/fsl_mc.h>
|
||||
#ifdef CONFIG_FSL_ESDHC
|
||||
#include <fsl_esdhc.h>
|
||||
|
||||
@@ -1,9 +1,7 @@
|
||||
// SPDX-License-Identifier: GPL-2.0
|
||||
/*
|
||||
* Copyright (c) 2015 National Instruments
|
||||
*
|
||||
* (C) Copyright 2015
|
||||
* Joe Hershberger <joe.hershberger@ni.com>
|
||||
* Copyright (c) 2015-2018 National Instruments
|
||||
* Copyright (c) 2015-2018 Joe Hershberger <joe.hershberger@ni.com>
|
||||
*/
|
||||
|
||||
#include <asm/eth-raw-os.h>
|
||||
@@ -25,8 +23,46 @@
|
||||
#include <linux/if_ether.h>
|
||||
#include <linux/if_packet.h>
|
||||
|
||||
static int _raw_packet_start(const char *ifname, unsigned char *ethmac,
|
||||
struct eth_sandbox_raw_priv *priv)
|
||||
struct sandbox_eth_raw_if_nameindex *sandbox_eth_raw_if_nameindex(void)
|
||||
{
|
||||
return (struct sandbox_eth_raw_if_nameindex *)if_nameindex();
|
||||
}
|
||||
|
||||
void sandbox_eth_raw_if_freenameindex(struct sandbox_eth_raw_if_nameindex *ptr)
|
||||
{
|
||||
if_freenameindex((struct if_nameindex *)ptr);
|
||||
}
|
||||
|
||||
int sandbox_eth_raw_os_is_local(const char *ifname)
|
||||
{
|
||||
int fd = socket(AF_INET, SOCK_DGRAM, 0);
|
||||
struct ifreq ifr;
|
||||
int ret = 0;
|
||||
|
||||
if (fd < 0)
|
||||
return -errno;
|
||||
memset(&ifr, 0, sizeof(ifr));
|
||||
strncpy(ifr.ifr_name, ifname, IFNAMSIZ);
|
||||
ret = ioctl(fd, SIOCGIFFLAGS, &ifr);
|
||||
if (ret < 0) {
|
||||
ret = -errno;
|
||||
goto out;
|
||||
}
|
||||
ret = !!(ifr.ifr_flags & IFF_LOOPBACK);
|
||||
out:
|
||||
close(fd);
|
||||
return ret;
|
||||
}
|
||||
|
||||
int sandbox_eth_raw_os_idx_to_name(struct eth_sandbox_raw_priv *priv)
|
||||
{
|
||||
if (!if_indextoname(priv->host_ifindex, priv->host_ifname))
|
||||
return -errno;
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int _raw_packet_start(struct eth_sandbox_raw_priv *priv,
|
||||
unsigned char *ethmac)
|
||||
{
|
||||
struct sockaddr_ll *device;
|
||||
struct packet_mreq mr;
|
||||
@@ -34,12 +70,14 @@ static int _raw_packet_start(const char *ifname, unsigned char *ethmac,
|
||||
int flags;
|
||||
|
||||
/* Prepare device struct */
|
||||
priv->local_bind_sd = -1;
|
||||
priv->device = malloc(sizeof(struct sockaddr_ll));
|
||||
if (priv->device == NULL)
|
||||
return -ENOMEM;
|
||||
device = priv->device;
|
||||
memset(device, 0, sizeof(struct sockaddr_ll));
|
||||
device->sll_ifindex = if_nametoindex(ifname);
|
||||
device->sll_ifindex = if_nametoindex(priv->host_ifname);
|
||||
priv->host_ifindex = device->sll_ifindex;
|
||||
device->sll_family = AF_PACKET;
|
||||
memcpy(device->sll_addr, ethmac, 6);
|
||||
device->sll_halen = htons(6);
|
||||
@@ -52,11 +90,11 @@ static int _raw_packet_start(const char *ifname, unsigned char *ethmac,
|
||||
return -errno;
|
||||
}
|
||||
/* Bind to the specified interface */
|
||||
ret = setsockopt(priv->sd, SOL_SOCKET, SO_BINDTODEVICE, ifname,
|
||||
strlen(ifname) + 1);
|
||||
ret = setsockopt(priv->sd, SOL_SOCKET, SO_BINDTODEVICE,
|
||||
priv->host_ifname, strlen(priv->host_ifname) + 1);
|
||||
if (ret < 0) {
|
||||
printf("Failed to bind to '%s': %d %s\n", ifname, errno,
|
||||
strerror(errno));
|
||||
printf("Failed to bind to '%s': %d %s\n", priv->host_ifname,
|
||||
errno, strerror(errno));
|
||||
return -errno;
|
||||
}
|
||||
|
||||
@@ -75,11 +113,12 @@ static int _raw_packet_start(const char *ifname, unsigned char *ethmac,
|
||||
printf("Failed to set promiscuous mode: %d %s\n"
|
||||
"Falling back to the old \"flags\" way...\n",
|
||||
errno, strerror(errno));
|
||||
if (strlen(ifname) >= IFNAMSIZ) {
|
||||
printf("Interface name %s is too long.\n", ifname);
|
||||
if (strlen(priv->host_ifname) >= IFNAMSIZ) {
|
||||
printf("Interface name %s is too long.\n",
|
||||
priv->host_ifname);
|
||||
return -EINVAL;
|
||||
}
|
||||
strncpy(ifr.ifr_name, ifname, IFNAMSIZ);
|
||||
strncpy(ifr.ifr_name, priv->host_ifname, IFNAMSIZ);
|
||||
if (ioctl(priv->sd, SIOCGIFFLAGS, &ifr) < 0) {
|
||||
printf("Failed to read flags: %d %s\n", errno,
|
||||
strerror(errno));
|
||||
@@ -103,6 +142,8 @@ static int _local_inet_start(struct eth_sandbox_raw_priv *priv)
|
||||
int one = 1;
|
||||
|
||||
/* Prepare device struct */
|
||||
priv->local_bind_sd = -1;
|
||||
priv->local_bind_udp_port = 0;
|
||||
priv->device = malloc(sizeof(struct sockaddr_in));
|
||||
if (priv->device == NULL)
|
||||
return -ENOMEM;
|
||||
@@ -136,18 +177,16 @@ static int _local_inet_start(struct eth_sandbox_raw_priv *priv)
|
||||
strerror(errno));
|
||||
return -errno;
|
||||
}
|
||||
priv->local_bind_sd = -1;
|
||||
priv->local_bind_udp_port = 0;
|
||||
return 0;
|
||||
}
|
||||
|
||||
int sandbox_eth_raw_os_start(const char *ifname, unsigned char *ethmac,
|
||||
struct eth_sandbox_raw_priv *priv)
|
||||
int sandbox_eth_raw_os_start(struct eth_sandbox_raw_priv *priv,
|
||||
unsigned char *ethmac)
|
||||
{
|
||||
if (priv->local)
|
||||
return _local_inet_start(priv);
|
||||
else
|
||||
return _raw_packet_start(ifname, ethmac, priv);
|
||||
return _raw_packet_start(priv, ethmac);
|
||||
}
|
||||
|
||||
int sandbox_eth_raw_os_send(void *packet, int length,
|
||||
@@ -156,7 +195,7 @@ int sandbox_eth_raw_os_send(void *packet, int length,
|
||||
int retval;
|
||||
struct udphdr *udph = packet + sizeof(struct iphdr);
|
||||
|
||||
if (!priv->sd || !priv->device)
|
||||
if (priv->sd < 0 || !priv->device)
|
||||
return -EINVAL;
|
||||
|
||||
/*
|
||||
@@ -221,7 +260,7 @@ int sandbox_eth_raw_os_recv(void *packet, int *length,
|
||||
int retval;
|
||||
int saddr_size;
|
||||
|
||||
if (!priv->sd || !priv->device)
|
||||
if (priv->sd < 0 || !priv->device)
|
||||
return -EINVAL;
|
||||
saddr_size = sizeof(struct sockaddr);
|
||||
retval = recvfrom(priv->sd, packet, 1536, 0,
|
||||
|
||||
@@ -8,7 +8,6 @@
|
||||
model = "sandbox";
|
||||
|
||||
aliases {
|
||||
eth5 = "/eth@90000000";
|
||||
i2c0 = &i2c_0;
|
||||
pci0 = &pci;
|
||||
rtc0 = &rtc_0;
|
||||
@@ -47,24 +46,17 @@
|
||||
};
|
||||
};
|
||||
|
||||
ethrawbus {
|
||||
compatible = "sandbox,eth-raw-bus";
|
||||
skip-localhost = <0>;
|
||||
};
|
||||
|
||||
eth@10002000 {
|
||||
compatible = "sandbox,eth";
|
||||
reg = <0x10002000 0x1000>;
|
||||
fake-host-hwaddr = [00 00 66 44 22 00];
|
||||
};
|
||||
|
||||
eth@80000000 {
|
||||
compatible = "sandbox,eth-raw";
|
||||
reg = <0x80000000 0x1000>;
|
||||
host-raw-interface = "eth0";
|
||||
};
|
||||
|
||||
eth@90000000 {
|
||||
compatible = "sandbox,eth-raw";
|
||||
reg = <0x90000000 0x1000>;
|
||||
host-raw-interface = "lo";
|
||||
};
|
||||
|
||||
gpio_a: gpios@0 {
|
||||
gpio-controller;
|
||||
compatible = "sandbox,gpio";
|
||||
|
||||
@@ -8,7 +8,6 @@
|
||||
model = "sandbox";
|
||||
|
||||
aliases {
|
||||
eth5 = "/eth@90000000";
|
||||
i2c0 = &i2c_0;
|
||||
pci0 = &pci;
|
||||
rtc0 = &rtc_0;
|
||||
@@ -47,24 +46,17 @@
|
||||
};
|
||||
};
|
||||
|
||||
ethrawbus {
|
||||
compatible = "sandbox,eth-raw-bus";
|
||||
skip-localhost = <1>;
|
||||
};
|
||||
|
||||
eth@10002000 {
|
||||
compatible = "sandbox,eth";
|
||||
reg = <0x0 0x10002000 0x0 0x1000>;
|
||||
fake-host-hwaddr = [00 00 66 44 22 00];
|
||||
};
|
||||
|
||||
eth@80000000 {
|
||||
compatible = "sandbox,eth-raw";
|
||||
reg = <0x0 0x80000000 0x0 0x1000>;
|
||||
host-raw-interface = "eth0";
|
||||
};
|
||||
|
||||
eth@90000000 {
|
||||
compatible = "sandbox,eth-raw";
|
||||
reg = <0x0 0x90000000 0x0 0x1000>;
|
||||
host-raw-interface = "lo";
|
||||
};
|
||||
|
||||
gpio_a: gpios@0 {
|
||||
gpio-controller;
|
||||
compatible = "sandbox,gpio";
|
||||
|
||||
@@ -155,25 +155,25 @@
|
||||
eth@10002000 {
|
||||
compatible = "sandbox,eth";
|
||||
reg = <0x10002000 0x1000>;
|
||||
fake-host-hwaddr = <0x00 0x00 0x66 0x44 0x22 0x00>;
|
||||
fake-host-hwaddr = [00 00 66 44 22 00];
|
||||
};
|
||||
|
||||
eth_5: eth@10003000 {
|
||||
compatible = "sandbox,eth";
|
||||
reg = <0x10003000 0x1000>;
|
||||
fake-host-hwaddr = <0x00 0x00 0x66 0x44 0x22 0x11>;
|
||||
fake-host-hwaddr = [00 00 66 44 22 11];
|
||||
};
|
||||
|
||||
eth_3: sbe5 {
|
||||
compatible = "sandbox,eth";
|
||||
reg = <0x10005000 0x1000>;
|
||||
fake-host-hwaddr = <0x00 0x00 0x66 0x44 0x22 0x33>;
|
||||
fake-host-hwaddr = [00 00 66 44 22 33];
|
||||
};
|
||||
|
||||
eth@10004000 {
|
||||
compatible = "sandbox,eth";
|
||||
reg = <0x10004000 0x1000>;
|
||||
fake-host-hwaddr = <0x00 0x00 0x66 0x44 0x22 0x22>;
|
||||
fake-host-hwaddr = [00 00 66 44 22 22];
|
||||
};
|
||||
|
||||
gpio_a: base-gpios {
|
||||
|
||||
@@ -9,10 +9,14 @@
|
||||
#ifndef __ETH_RAW_OS_H
|
||||
#define __ETH_RAW_OS_H
|
||||
|
||||
#define IFNAMSIZ 16
|
||||
|
||||
/**
|
||||
* struct eth_sandbox_raw_priv - raw socket session
|
||||
*
|
||||
* sd: socket descriptor - the open socket during a session
|
||||
* host_ifname: interface name on the host to use for sending our packets
|
||||
* host_ifindex: interface index number on the host
|
||||
* device: struct sockaddr_ll - the host interface packets move to/from
|
||||
* local: 1 or 0 to select the local interface ('lo') or not
|
||||
* local_bindsd: socket descriptor to prevent the kernel from sending
|
||||
@@ -22,14 +26,44 @@
|
||||
*/
|
||||
struct eth_sandbox_raw_priv {
|
||||
int sd;
|
||||
char host_ifname[IFNAMSIZ];
|
||||
unsigned int host_ifindex;
|
||||
void *device;
|
||||
int local;
|
||||
int local_bind_sd;
|
||||
unsigned short local_bind_udp_port;
|
||||
};
|
||||
|
||||
int sandbox_eth_raw_os_start(const char *ifname, unsigned char *ethmac,
|
||||
struct eth_sandbox_raw_priv *priv);
|
||||
/* A struct to mimic if_nameindex but that does not depend on Linux headers */
|
||||
struct sandbox_eth_raw_if_nameindex {
|
||||
unsigned int if_index; /* Index of interface (1, 2, ...) */
|
||||
char *if_name; /* Null-terminated name ("eth0", etc.) */
|
||||
};
|
||||
|
||||
/* Enumerate host network interfaces */
|
||||
struct sandbox_eth_raw_if_nameindex *sandbox_eth_raw_if_nameindex(void);
|
||||
/* Free the data structure of enumerated network interfaces */
|
||||
void sandbox_eth_raw_if_freenameindex(struct sandbox_eth_raw_if_nameindex *ptr);
|
||||
|
||||
/*
|
||||
* Check if the interface named "ifname" is a localhost interface or not.
|
||||
* ifname - the interface name on the host to check
|
||||
*
|
||||
* returns - 0 if real interface, 1 if local, negative if error
|
||||
*/
|
||||
int sandbox_eth_raw_os_is_local(const char *ifname);
|
||||
|
||||
/*
|
||||
* Look up the name of the interface based on the ifindex populated in priv.
|
||||
*
|
||||
* Overwrite the host_ifname member in priv based on looking up host_ifindex
|
||||
*
|
||||
* returns - 0 if success, negative if error
|
||||
*/
|
||||
int sandbox_eth_raw_os_idx_to_name(struct eth_sandbox_raw_priv *priv);
|
||||
|
||||
int sandbox_eth_raw_os_start(struct eth_sandbox_raw_priv *priv,
|
||||
unsigned char *ethmac);
|
||||
int sandbox_eth_raw_os_send(void *packet, int length,
|
||||
struct eth_sandbox_raw_priv *priv);
|
||||
int sandbox_eth_raw_os_recv(void *packet, int *length,
|
||||
|
||||
Reference in New Issue
Block a user